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