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