040a77859a2edaaeb9f7a677a489265ac18a1f62
[people/holger/gpxe.git] / src / core / string.c
1 /*
2  *  Copyright (C) 1991, 1992  Linus Torvalds
3  *  Copyright (C) 2004 Tobias Lorenz
4  *
5  *  string handling functions
6  *  based on linux/lib/string.c
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 /*
14  * stupid library routines.. The optimized versions should generally be found
15  * as inline code in <asm-xx/string.h>
16  *
17  * These are buggy as well..
18  *
19  * * Fri Jun 25 1999, Ingo Oeser <ioe@informatik.tu-chemnitz.de>
20  * -  Added strsep() which will replace strtok() soon (because strsep() is
21  *    reentrant and should be faster). Use only strsep() in new code, please.
22  */
23  
24 #include <stdint.h>
25 #include <stdlib.h>
26 #include <string.h>
27 #include <ctype.h>
28
29 /* *** FROM string.c *** */
30
31 #ifndef __HAVE_ARCH_STRNICMP
32 /**
33  * strnicmp - Case insensitive, length-limited string comparison
34  * @s1: One string
35  * @s2: The other string
36  * @len: the maximum number of characters to compare
37  */
38 int strnicmp(const char *s1, const char *s2, size_t len)
39 {
40         /* Yes, Virginia, it had better be unsigned */
41         unsigned char c1, c2;
42
43         c1 = 0; c2 = 0;
44         if (len) {
45                 do {
46                         c1 = *s1; c2 = *s2;
47                         s1++; s2++;
48                         if (!c1)
49                                 break;
50                         if (!c2)
51                                 break;
52                         if (c1 == c2)
53                                 continue;
54                         c1 = tolower(c1);
55                         c2 = tolower(c2);
56                         if (c1 != c2)
57                                 break;
58                 } while (--len);
59         }
60         return (int)c1 - (int)c2;
61 }
62 #endif
63
64 char * ___strtok;
65
66 #ifndef __HAVE_ARCH_STRCPY
67 /**
68  * strcpy - Copy a %NUL terminated string
69  * @dest: Where to copy the string to
70  * @src: Where to copy the string from
71  */
72 char * strcpy(char * dest,const char *src)
73 {
74         char *tmp = dest;
75
76         while ((*dest++ = *src++) != '\0')
77                 /* nothing */;
78         return tmp;
79 }
80 #endif
81
82 #ifndef __HAVE_ARCH_STRNCPY
83 /**
84  * strncpy - Copy a length-limited, %NUL-terminated string
85  * @dest: Where to copy the string to
86  * @src: Where to copy the string from
87  * @count: The maximum number of bytes to copy
88  *
89  * Note that unlike userspace strncpy, this does not %NUL-pad the buffer.
90  * However, the result is not %NUL-terminated if the source exceeds
91  * @count bytes.
92  */
93 char * strncpy(char * dest,const char *src,size_t count)
94 {
95         char *tmp = dest;
96
97         while (count-- && (*dest++ = *src++) != '\0')
98                 /* nothing */;
99
100         return tmp;
101 }
102 #endif
103
104 #ifndef __HAVE_ARCH_STRCAT
105 /**
106  * strcat - Append one %NUL-terminated string to another
107  * @dest: The string to be appended to
108  * @src: The string to append to it
109  */
110 char * strcat(char * dest, const char * src)
111 {
112         char *tmp = dest;
113
114         while (*dest)
115                 dest++;
116         while ((*dest++ = *src++) != '\0')
117                 ;
118
119         return tmp;
120 }
121 #endif
122
123 #ifndef __HAVE_ARCH_STRNCAT
124 /**
125  * strncat - Append a length-limited, %NUL-terminated string to another
126  * @dest: The string to be appended to
127  * @src: The string to append to it
128  * @count: The maximum numbers of bytes to copy
129  *
130  * Note that in contrast to strncpy, strncat ensures the result is
131  * terminated.
132  */
133 char * strncat(char *dest, const char *src, size_t count)
134 {
135         char *tmp = dest;
136
137         if (count) {
138                 while (*dest)
139                         dest++;
140                 while ((*dest++ = *src++)) {
141                         if (--count == 0) {
142                                 *dest = '\0';
143                                 break;
144                         }
145                 }
146         }
147
148         return tmp;
149 }
150 #endif
151
152 #ifndef __HAVE_ARCH_STRCMP
153 /**
154  * strcmp - Compare two strings
155  * @cs: One string
156  * @ct: Another string
157  */
158 int strcmp(const char * cs,const char * ct)
159 {
160         register signed char __res;
161
162         while (1) {
163                 if ((__res = *cs - *ct++) != 0 || !*cs++)
164                         break;
165         }
166
167         return __res;
168 }
169 #endif
170
171 #ifndef __HAVE_ARCH_STRNCMP
172 /**
173  * strncmp - Compare two length-limited strings
174  * @cs: One string
175  * @ct: Another string
176  * @count: The maximum number of bytes to compare
177  */
178 int strncmp(const char * cs,const char * ct,size_t count)
179 {
180         register signed char __res = 0;
181
182         while (count) {
183                 if ((__res = *cs - *ct++) != 0 || !*cs++)
184                         break;
185                 count--;
186         }
187
188         return __res;
189 }
190 #endif
191
192 #ifndef __HAVE_ARCH_STRCASECMP
193 int strcasecmp(const char *a, const char *b)
194 {
195         while (*a && *b && (*a & ~0x20) == (*b & ~0x20)) {a++; b++; }
196         return((*a & ~0x20) - (*b & ~0x20));
197 }
198 #endif
199
200 #ifndef __HAVE_ARCH_STRCHR
201 /**
202  * strchr - Find the first occurrence of a character in a string
203  * @s: The string to be searched
204  * @c: The character to search for
205  */
206 char * strchr(const char * s, int c)
207 {
208         for(; *s != (char) c; ++s)
209                 if (*s == '\0')
210                         return NULL;
211         return (char *) s;
212 }
213 #endif
214
215 #ifndef __HAVE_ARCH_STRRCHR
216 /**
217  * strrchr - Find the last occurrence of a character in a string
218  * @s: The string to be searched
219  * @c: The character to search for
220  */
221 char * strrchr(const char * s, int c)
222 {
223        const char *p = s + strlen(s);
224        do {
225            if (*p == (char)c)
226                return (char *)p;
227        } while (--p >= s);
228        return NULL;
229 }
230 #endif
231
232 #ifndef __HAVE_ARCH_STRLEN
233 /**
234  * strlen - Find the length of a string
235  * @s: The string to be sized
236  */
237 size_t strlen(const char * s)
238 {
239         const char *sc;
240
241         for (sc = s; *sc != '\0'; ++sc)
242                 /* nothing */;
243         return sc - s;
244 }
245 #endif
246
247 #ifndef __HAVE_ARCH_STRNLEN
248 /**
249  * strnlen - Find the length of a length-limited string
250  * @s: The string to be sized
251  * @count: The maximum number of bytes to search
252  */
253 size_t strnlen(const char * s, size_t count)
254 {
255         const char *sc;
256
257         for (sc = s; count-- && *sc != '\0'; ++sc)
258                 /* nothing */;
259         return sc - s;
260 }
261 #endif
262
263 #ifndef __HAVE_ARCH_STRSPN
264 /**
265  * strspn - Calculate the length of the initial substring of @s which only
266  *      contain letters in @accept
267  * @s: The string to be searched
268  * @accept: The string to search for
269  */
270 size_t strspn(const char *s, const char *accept)
271 {
272         const char *p;
273         const char *a;
274         size_t count = 0;
275
276         for (p = s; *p != '\0'; ++p) {
277                 for (a = accept; *a != '\0'; ++a) {
278                         if (*p == *a)
279                                 break;
280                 }
281                 if (*a == '\0')
282                         return count;
283                 ++count;
284         }
285
286         return count;
287 }
288 #endif
289
290 #ifndef __HAVE_ARCH_STRCSPN
291 /**
292  * strcspn - Calculate the length of the initial substring of @s which only
293  *      contain letters not in @reject
294  * @s: The string to be searched
295  * @accept: The string to search for
296  */
297 size_t strcspn(const char *s, const char *reject)
298 {
299         const char *p;
300         const char *r;
301         size_t count = 0;
302
303         for (p = s; *p != '\0'; ++p) {
304                 for (r = reject; *r != '\0'; ++r) {
305                         if (*p == *r)
306                                 return count;
307                 }
308                 ++count;
309         }
310
311         return count;
312 }
313 #endif
314
315 #ifndef __HAVE_ARCH_STRPBRK
316 /**
317  * strpbrk - Find the first occurrence of a set of characters
318  * @cs: The string to be searched
319  * @ct: The characters to search for
320  */
321 char * strpbrk(const char * cs,const char * ct)
322 {
323         const char *sc1,*sc2;
324
325         for( sc1 = cs; *sc1 != '\0'; ++sc1) {
326                 for( sc2 = ct; *sc2 != '\0'; ++sc2) {
327                         if (*sc1 == *sc2)
328                                 return (char *) sc1;
329                 }
330         }
331         return NULL;
332 }
333 #endif
334
335 #ifndef __HAVE_ARCH_STRTOK
336 /**
337  * strtok - Split a string into tokens
338  * @s: The string to be searched
339  * @ct: The characters to search for
340  *
341  * WARNING: strtok is deprecated, use strsep instead.
342  */
343 char * strtok(char * s,const char * ct)
344 {
345         char *sbegin, *send;
346
347         sbegin  = s ? s : ___strtok;
348         if (!sbegin) {
349                 return NULL;
350         }
351         sbegin += strspn(sbegin,ct);
352         if (*sbegin == '\0') {
353                 ___strtok = NULL;
354                 return( NULL );
355         }
356         send = strpbrk( sbegin, ct);
357         if (send && *send != '\0')
358                 *send++ = '\0';
359         ___strtok = send;
360         return (sbegin);
361 }
362 #endif
363
364 #ifndef __HAVE_ARCH_STRSEP
365 /**
366  * strsep - Split a string into tokens
367  * @s: The string to be searched
368  * @ct: The characters to search for
369  *
370  * strsep() updates @s to point after the token, ready for the next call.
371  *
372  * It returns empty tokens, too, behaving exactly like the libc function
373  * of that name. In fact, it was stolen from glibc2 and de-fancy-fied.
374  * Same semantics, slimmer shape. ;)
375  */
376 char * strsep(char **s, const char *ct)
377 {
378         char *sbegin = *s, *end;
379
380         if (sbegin == NULL)
381                 return NULL;
382
383         end = strpbrk(sbegin, ct);
384         if (end)
385                 *end++ = '\0';
386         *s = end;
387
388         return sbegin;
389 }
390 #endif
391
392 #ifndef __HAVE_ARCH_MEMSET
393 /**
394  * memset - Fill a region of memory with the given value
395  * @s: Pointer to the start of the area.
396  * @c: The byte to fill the area with
397  * @count: The size of the area.
398  *
399  * Do not use memset() to access IO space, use memset_io() instead.
400  */
401 void * memset(void * s,int c,size_t count)
402 {
403         char *xs = (char *) s;
404
405         while (count--)
406                 *xs++ = c;
407
408         return s;
409 }
410 #endif
411
412 #ifndef __HAVE_ARCH_BCOPY
413 /**
414  * bcopy - Copy one area of memory to another
415  * @src: Where to copy from
416  * @dest: Where to copy to
417  * @count: The size of the area.
418  *
419  * Note that this is the same as memcpy(), with the arguments reversed.
420  * memcpy() is the standard, bcopy() is a legacy BSD function.
421  *
422  * You should not use this function to access IO space, use memcpy_toio()
423  * or memcpy_fromio() instead.
424  */
425 char * bcopy(const char * src, char * dest, int count)
426 {
427         char *tmp = dest;
428
429         while (count--)
430                 *tmp++ = *src++;
431
432         return dest;
433 }
434 #endif
435
436 #ifndef __HAVE_ARCH_MEMCPY
437 /**
438  * memcpy - Copy one area of memory to another
439  * @dest: Where to copy to
440  * @src: Where to copy from
441  * @count: The size of the area.
442  *
443  * You should not use this function to access IO space, use memcpy_toio()
444  * or memcpy_fromio() instead.
445  */
446 void * memcpy(void * dest,const void *src,size_t count)
447 {
448         char *tmp = (char *) dest, *s = (char *) src;
449
450         while (count--)
451                 *tmp++ = *s++;
452
453         return dest;
454 }
455 #endif
456
457 #ifndef __HAVE_ARCH_MEMMOVE
458 /**
459  * memmove - Copy one area of memory to another
460  * @dest: Where to copy to
461  * @src: Where to copy from
462  * @count: The size of the area.
463  *
464  * Unlike memcpy(), memmove() copes with overlapping areas.
465  */
466 void * memmove(void * dest,const void *src,size_t count)
467 {
468         char *tmp, *s;
469
470         if (dest <= src) {
471                 tmp = (char *) dest;
472                 s = (char *) src;
473                 while (count--)
474                         *tmp++ = *s++;
475                 }
476         else {
477                 tmp = (char *) dest + count;
478                 s = (char *) src + count;
479                 while (count--)
480                         *--tmp = *--s;
481                 }
482
483         return dest;
484 }
485 #endif
486
487 #ifndef __HAVE_ARCH_MEMCMP
488 /**
489  * memcmp - Compare two areas of memory
490  * @cs: One area of memory
491  * @ct: Another area of memory
492  * @count: The size of the area.
493  */
494 int memcmp(const void * cs,const void * ct,size_t count)
495 {
496         const unsigned char *su1, *su2;
497         int res = 0;
498
499         for( su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
500                 if ((res = *su1 - *su2) != 0)
501                         break;
502         return res;
503 }
504 #endif
505
506 #ifndef __HAVE_ARCH_MEMSCAN
507 /**
508  * memscan - Find a character in an area of memory.
509  * @addr: The memory area
510  * @c: The byte to search for
511  * @size: The size of the area.
512  *
513  * returns the address of the first occurrence of @c, or 1 byte past
514  * the area if @c is not found
515  */
516 void * memscan(void * addr, int c, size_t size)
517 {
518         unsigned char * p = (unsigned char *) addr;
519
520         while (size) {
521                 if (*p == c)
522                         return (void *) p;
523                 p++;
524                 size--;
525         }
526         return (void *) p;
527 }
528 #endif
529
530 #ifndef __HAVE_ARCH_STRSTR
531 /**
532  * strstr - Find the first substring in a %NUL terminated string
533  * @s1: The string to be searched
534  * @s2: The string to search for
535  */
536 char * strstr(const char * s1,const char * s2)
537 {
538         int l1, l2;
539
540         l2 = strlen(s2);
541         if (!l2)
542                 return (char *) s1;
543         l1 = strlen(s1);
544         while (l1 >= l2) {
545                 l1--;
546                 if (!memcmp(s1,s2,l2))
547                         return (char *) s1;
548                 s1++;
549         }
550         return NULL;
551 }
552 #endif
553
554 #ifndef __HAVE_ARCH_MEMCHR
555 /**
556  * memchr - Find a character in an area of memory.
557  * @s: The memory area
558  * @c: The byte to search for
559  * @n: The size of the area.
560  *
561  * returns the address of the first occurrence of @c, or %NULL
562  * if @c is not found
563  */
564 void * memchr(const void *s, int c, size_t n)
565 {
566         const unsigned char *p = s;
567         while (n-- != 0) {
568                 if ((unsigned char)c == *p++) {
569                         return (void *)(p-1);
570                 }
571         }
572         return NULL;
573 }
574
575 #endif
576
577 char * strndup(const char *s, size_t n)
578 {
579         size_t len = strlen(s);
580         char *new;
581
582         if (len>n)
583                 len = n;
584         new = malloc(len+1);
585         if (new) {
586                 new[len] = '\0';
587                 memcpy(new,s,len);
588         }
589         return new;
590 }
591
592 char * strdup(const char *s) {
593         return strndup(s, ~((size_t)0));
594 }