xref: /openbmc/u-boot/lib/string.c (revision 713cb680)
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 /**
25  * strncasecmp - Case insensitive, length-limited string comparison
26  * @s1: One string
27  * @s2: The other string
28  * @len: the maximum number of characters to compare
29  */
30 int strncasecmp(const char *s1, const char *s2, size_t len)
31 {
32 	/* Yes, Virginia, it had better be unsigned */
33 	unsigned char c1, c2;
34 
35 	c1 = 0;	c2 = 0;
36 	if (len) {
37 		do {
38 			c1 = *s1; c2 = *s2;
39 			s1++; s2++;
40 			if (!c1)
41 				break;
42 			if (!c2)
43 				break;
44 			if (c1 == c2)
45 				continue;
46 			c1 = tolower(c1);
47 			c2 = tolower(c2);
48 			if (c1 != c2)
49 				break;
50 		} while (--len);
51 	}
52 	return (int)c1 - (int)c2;
53 }
54 
55 /**
56  * strcasecmp - Case insensitive string comparison
57  * @s1: One string
58  * @s2: The other string
59  */
60 int strcasecmp(const char *s1, const char *s2)
61 {
62 	return strncasecmp(s1, s2, -1U);
63 }
64 
65 char * ___strtok;
66 
67 #ifndef __HAVE_ARCH_STRCPY
68 /**
69  * strcpy - Copy a %NUL terminated string
70  * @dest: Where to copy the string to
71  * @src: Where to copy the string from
72  */
73 char * strcpy(char * dest,const char *src)
74 {
75 	char *tmp = dest;
76 
77 	while ((*dest++ = *src++) != '\0')
78 		/* nothing */;
79 	return tmp;
80 }
81 #endif
82 
83 #ifndef __HAVE_ARCH_STRNCPY
84 /**
85  * strncpy - Copy a length-limited, %NUL-terminated string
86  * @dest: Where to copy the string to
87  * @src: Where to copy the string from
88  * @count: The maximum number of bytes to copy
89  *
90  * Note that unlike userspace strncpy, this does not %NUL-pad the buffer.
91  * However, the result is not %NUL-terminated if the source exceeds
92  * @count bytes.
93  */
94 char * strncpy(char * dest,const char *src,size_t count)
95 {
96 	char *tmp = dest;
97 
98 	while (count-- && (*dest++ = *src++) != '\0')
99 		/* nothing */;
100 
101 	return tmp;
102 }
103 #endif
104 
105 #ifndef __HAVE_ARCH_STRCAT
106 /**
107  * strcat - Append one %NUL-terminated string to another
108  * @dest: The string to be appended to
109  * @src: The string to append to it
110  */
111 char * strcat(char * dest, const char * src)
112 {
113 	char *tmp = dest;
114 
115 	while (*dest)
116 		dest++;
117 	while ((*dest++ = *src++) != '\0')
118 		;
119 
120 	return tmp;
121 }
122 #endif
123 
124 #ifndef __HAVE_ARCH_STRNCAT
125 /**
126  * strncat - Append a length-limited, %NUL-terminated string to another
127  * @dest: The string to be appended to
128  * @src: The string to append to it
129  * @count: The maximum numbers of bytes to copy
130  *
131  * Note that in contrast to strncpy, strncat ensures the result is
132  * terminated.
133  */
134 char * strncat(char *dest, const char *src, size_t count)
135 {
136 	char *tmp = dest;
137 
138 	if (count) {
139 		while (*dest)
140 			dest++;
141 		while ((*dest++ = *src++)) {
142 			if (--count == 0) {
143 				*dest = '\0';
144 				break;
145 			}
146 		}
147 	}
148 
149 	return tmp;
150 }
151 #endif
152 
153 #ifndef __HAVE_ARCH_STRCMP
154 /**
155  * strcmp - Compare two strings
156  * @cs: One string
157  * @ct: Another string
158  */
159 int strcmp(const char * cs,const char * ct)
160 {
161 	register signed char __res;
162 
163 	while (1) {
164 		if ((__res = *cs - *ct++) != 0 || !*cs++)
165 			break;
166 	}
167 
168 	return __res;
169 }
170 #endif
171 
172 #ifndef __HAVE_ARCH_STRNCMP
173 /**
174  * strncmp - Compare two length-limited strings
175  * @cs: One string
176  * @ct: Another string
177  * @count: The maximum number of bytes to compare
178  */
179 int strncmp(const char * cs,const char * ct,size_t count)
180 {
181 	register signed char __res = 0;
182 
183 	while (count) {
184 		if ((__res = *cs - *ct++) != 0 || !*cs++)
185 			break;
186 		count--;
187 	}
188 
189 	return __res;
190 }
191 #endif
192 
193 #ifndef __HAVE_ARCH_STRCHR
194 /**
195  * strchr - Find the first occurrence of a character in a string
196  * @s: The string to be searched
197  * @c: The character to search for
198  */
199 char * strchr(const char * s, int c)
200 {
201 	for(; *s != (char) c; ++s)
202 		if (*s == '\0')
203 			return NULL;
204 	return (char *) s;
205 }
206 #endif
207 
208 #ifndef __HAVE_ARCH_STRRCHR
209 /**
210  * strrchr - Find the last occurrence of a character in a string
211  * @s: The string to be searched
212  * @c: The character to search for
213  */
214 char * strrchr(const char * s, int c)
215 {
216        const char *p = s + strlen(s);
217        do {
218 	   if (*p == (char)c)
219 	       return (char *)p;
220        } while (--p >= s);
221        return NULL;
222 }
223 #endif
224 
225 #ifndef __HAVE_ARCH_STRLEN
226 /**
227  * strlen - Find the length of a string
228  * @s: The string to be sized
229  */
230 size_t strlen(const char * s)
231 {
232 	const char *sc;
233 
234 	for (sc = s; *sc != '\0'; ++sc)
235 		/* nothing */;
236 	return sc - s;
237 }
238 #endif
239 
240 #ifndef __HAVE_ARCH_STRNLEN
241 /**
242  * strnlen - Find the length of a length-limited string
243  * @s: The string to be sized
244  * @count: The maximum number of bytes to search
245  */
246 size_t strnlen(const char * s, size_t count)
247 {
248 	const char *sc;
249 
250 	for (sc = s; count-- && *sc != '\0'; ++sc)
251 		/* nothing */;
252 	return sc - s;
253 }
254 #endif
255 
256 #ifndef __HAVE_ARCH_STRDUP
257 char * strdup(const char *s)
258 {
259 	char *new;
260 
261 	if ((s == NULL)	||
262 	    ((new = malloc (strlen(s) + 1)) == NULL) ) {
263 		return NULL;
264 	}
265 
266 	strcpy (new, s);
267 	return new;
268 }
269 #endif
270 
271 #ifndef __HAVE_ARCH_STRSPN
272 /**
273  * strspn - Calculate the length of the initial substring of @s which only
274  *	contain letters in @accept
275  * @s: The string to be searched
276  * @accept: The string to search for
277  */
278 size_t strspn(const char *s, const char *accept)
279 {
280 	const char *p;
281 	const char *a;
282 	size_t count = 0;
283 
284 	for (p = s; *p != '\0'; ++p) {
285 		for (a = accept; *a != '\0'; ++a) {
286 			if (*p == *a)
287 				break;
288 		}
289 		if (*a == '\0')
290 			return count;
291 		++count;
292 	}
293 
294 	return count;
295 }
296 #endif
297 
298 #ifndef __HAVE_ARCH_STRPBRK
299 /**
300  * strpbrk - Find the first occurrence of a set of characters
301  * @cs: The string to be searched
302  * @ct: The characters to search for
303  */
304 char * strpbrk(const char * cs,const char * ct)
305 {
306 	const char *sc1,*sc2;
307 
308 	for( sc1 = cs; *sc1 != '\0'; ++sc1) {
309 		for( sc2 = ct; *sc2 != '\0'; ++sc2) {
310 			if (*sc1 == *sc2)
311 				return (char *) sc1;
312 		}
313 	}
314 	return NULL;
315 }
316 #endif
317 
318 #ifndef __HAVE_ARCH_STRTOK
319 /**
320  * strtok - Split a string into tokens
321  * @s: The string to be searched
322  * @ct: The characters to search for
323  *
324  * WARNING: strtok is deprecated, use strsep instead.
325  */
326 char * strtok(char * s,const char * ct)
327 {
328 	char *sbegin, *send;
329 
330 	sbegin  = s ? s : ___strtok;
331 	if (!sbegin) {
332 		return NULL;
333 	}
334 	sbegin += strspn(sbegin,ct);
335 	if (*sbegin == '\0') {
336 		___strtok = NULL;
337 		return( NULL );
338 	}
339 	send = strpbrk( sbegin, ct);
340 	if (send && *send != '\0')
341 		*send++ = '\0';
342 	___strtok = send;
343 	return (sbegin);
344 }
345 #endif
346 
347 #ifndef __HAVE_ARCH_STRSEP
348 /**
349  * strsep - Split a string into tokens
350  * @s: The string to be searched
351  * @ct: The characters to search for
352  *
353  * strsep() updates @s to point after the token, ready for the next call.
354  *
355  * It returns empty tokens, too, behaving exactly like the libc function
356  * of that name. In fact, it was stolen from glibc2 and de-fancy-fied.
357  * Same semantics, slimmer shape. ;)
358  */
359 char * strsep(char **s, const char *ct)
360 {
361 	char *sbegin = *s, *end;
362 
363 	if (sbegin == NULL)
364 		return NULL;
365 
366 	end = strpbrk(sbegin, ct);
367 	if (end)
368 		*end++ = '\0';
369 	*s = end;
370 
371 	return sbegin;
372 }
373 #endif
374 
375 #ifndef __HAVE_ARCH_STRSWAB
376 /**
377  * strswab - swap adjacent even and odd bytes in %NUL-terminated string
378  * s: address of the string
379  *
380  * returns the address of the swapped string or NULL on error. If
381  * string length is odd, last byte is untouched.
382  */
383 char *strswab(const char *s)
384 {
385 	char *p, *q;
386 
387 	if ((NULL == s) || ('\0' == *s)) {
388 		return (NULL);
389 	}
390 
391 	for (p=(char *)s, q=p+1; (*p != '\0') && (*q != '\0'); p+=2, q+=2) {
392 		char  tmp;
393 
394 		tmp = *p;
395 		*p  = *q;
396 		*q  = tmp;
397 	}
398 
399 	return (char *) s;
400 }
401 #endif
402 
403 #ifndef __HAVE_ARCH_MEMSET
404 /**
405  * memset - Fill a region of memory with the given value
406  * @s: Pointer to the start of the area.
407  * @c: The byte to fill the area with
408  * @count: The size of the area.
409  *
410  * Do not use memset() to access IO space, use memset_io() instead.
411  */
412 void * memset(void * s,int c,size_t count)
413 {
414 	unsigned long *sl = (unsigned long *) s;
415 	unsigned long cl = 0;
416 	char *s8;
417 	int i;
418 
419 	/* do it one word at a time (32 bits or 64 bits) while possible */
420 	if ( ((ulong)s & (sizeof(*sl) - 1)) == 0) {
421 		for (i = 0; i < sizeof(*sl); i++) {
422 			cl <<= 8;
423 			cl |= c & 0xff;
424 		}
425 		while (count >= sizeof(*sl)) {
426 			*sl++ = cl;
427 			count -= sizeof(*sl);
428 		}
429 	}
430 	/* fill 8 bits at a time */
431 	s8 = (char *)sl;
432 	while (count--)
433 		*s8++ = c;
434 
435 	return s;
436 }
437 #endif
438 
439 #ifndef __HAVE_ARCH_BCOPY
440 /**
441  * bcopy - Copy one area of memory to another
442  * @src: Where to copy from
443  * @dest: Where to copy to
444  * @count: The size of the area.
445  *
446  * Note that this is the same as memcpy(), with the arguments reversed.
447  * memcpy() is the standard, bcopy() is a legacy BSD function.
448  *
449  * You should not use this function to access IO space, use memcpy_toio()
450  * or memcpy_fromio() instead.
451  */
452 char * bcopy(const char * src, char * dest, int count)
453 {
454 	char *tmp = dest;
455 
456 	while (count--)
457 		*tmp++ = *src++;
458 
459 	return dest;
460 }
461 #endif
462 
463 #ifndef __HAVE_ARCH_MEMCPY
464 /**
465  * memcpy - Copy one area of memory to another
466  * @dest: Where to copy to
467  * @src: Where to copy from
468  * @count: The size of the area.
469  *
470  * You should not use this function to access IO space, use memcpy_toio()
471  * or memcpy_fromio() instead.
472  */
473 void * memcpy(void *dest, const void *src, size_t count)
474 {
475 	unsigned long *dl = (unsigned long *)dest, *sl = (unsigned long *)src;
476 	char *d8, *s8;
477 
478 	if (src == dest)
479 		return dest;
480 
481 	/* while all data is aligned (common case), copy a word at a time */
482 	if ( (((ulong)dest | (ulong)src) & (sizeof(*dl) - 1)) == 0) {
483 		while (count >= sizeof(*dl)) {
484 			*dl++ = *sl++;
485 			count -= sizeof(*dl);
486 		}
487 	}
488 	/* copy the reset one byte at a time */
489 	d8 = (char *)dl;
490 	s8 = (char *)sl;
491 	while (count--)
492 		*d8++ = *s8++;
493 
494 	return dest;
495 }
496 #endif
497 
498 #ifndef __HAVE_ARCH_MEMMOVE
499 /**
500  * memmove - Copy one area of memory to another
501  * @dest: Where to copy to
502  * @src: Where to copy from
503  * @count: The size of the area.
504  *
505  * Unlike memcpy(), memmove() copes with overlapping areas.
506  */
507 void * memmove(void * dest,const void *src,size_t count)
508 {
509 	char *tmp, *s;
510 
511 	if (src == dest)
512 		return dest;
513 
514 	if (dest <= src) {
515 		tmp = (char *) dest;
516 		s = (char *) src;
517 		while (count--)
518 			*tmp++ = *s++;
519 		}
520 	else {
521 		tmp = (char *) dest + count;
522 		s = (char *) src + count;
523 		while (count--)
524 			*--tmp = *--s;
525 		}
526 
527 	return dest;
528 }
529 #endif
530 
531 #ifndef __HAVE_ARCH_MEMCMP
532 /**
533  * memcmp - Compare two areas of memory
534  * @cs: One area of memory
535  * @ct: Another area of memory
536  * @count: The size of the area.
537  */
538 int memcmp(const void * cs,const void * ct,size_t count)
539 {
540 	const unsigned char *su1, *su2;
541 	int res = 0;
542 
543 	for( su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
544 		if ((res = *su1 - *su2) != 0)
545 			break;
546 	return res;
547 }
548 #endif
549 
550 #ifndef __HAVE_ARCH_MEMSCAN
551 /**
552  * memscan - Find a character in an area of memory.
553  * @addr: The memory area
554  * @c: The byte to search for
555  * @size: The size of the area.
556  *
557  * returns the address of the first occurrence of @c, or 1 byte past
558  * the area if @c is not found
559  */
560 void * memscan(void * addr, int c, size_t size)
561 {
562 	unsigned char * p = (unsigned char *) addr;
563 
564 	while (size) {
565 		if (*p == c)
566 			return (void *) p;
567 		p++;
568 		size--;
569 	}
570 	return (void *) p;
571 }
572 #endif
573 
574 #ifndef __HAVE_ARCH_STRSTR
575 /**
576  * strstr - Find the first substring in a %NUL terminated string
577  * @s1: The string to be searched
578  * @s2: The string to search for
579  */
580 char * strstr(const char * s1,const char * s2)
581 {
582 	int l1, l2;
583 
584 	l2 = strlen(s2);
585 	if (!l2)
586 		return (char *) s1;
587 	l1 = strlen(s1);
588 	while (l1 >= l2) {
589 		l1--;
590 		if (!memcmp(s1,s2,l2))
591 			return (char *) s1;
592 		s1++;
593 	}
594 	return NULL;
595 }
596 #endif
597 
598 #ifndef __HAVE_ARCH_MEMCHR
599 /**
600  * memchr - Find a character in an area of memory.
601  * @s: The memory area
602  * @c: The byte to search for
603  * @n: The size of the area.
604  *
605  * returns the address of the first occurrence of @c, or %NULL
606  * if @c is not found
607  */
608 void *memchr(const void *s, int c, size_t n)
609 {
610 	const unsigned char *p = s;
611 	while (n-- != 0) {
612 		if ((unsigned char)c == *p++) {
613 			return (void *)(p-1);
614 		}
615 	}
616 	return NULL;
617 }
618 
619 #endif
620 #ifndef __HAVE_ARCH_MEMCHR_INV
621 static void *check_bytes8(const u8 *start, u8 value, unsigned int bytes)
622 {
623 	while (bytes) {
624 		if (*start != value)
625 			return (void *)start;
626 		start++;
627 		bytes--;
628 	}
629 	return NULL;
630 }
631 /**
632  * memchr_inv - Find an unmatching character in an area of memory.
633  * @start: The memory area
634  * @c: Find a character other than c
635  * @bytes: The size of the area.
636  *
637  * returns the address of the first character other than @c, or %NULL
638  * if the whole buffer contains just @c.
639  */
640 void *memchr_inv(const void *start, int c, size_t bytes)
641 {
642 	u8 value = c;
643 	u64 value64;
644 	unsigned int words, prefix;
645 
646 	if (bytes <= 16)
647 		return check_bytes8(start, value, bytes);
648 
649 	value64 = value;
650 	value64 |= value64 << 8;
651 	value64 |= value64 << 16;
652 	value64 |= value64 << 32;
653 
654 	prefix = (unsigned long)start % 8;
655 	if (prefix) {
656 		u8 *r;
657 
658 		prefix = 8 - prefix;
659 		r = check_bytes8(start, value, prefix);
660 		if (r)
661 			return r;
662 		start += prefix;
663 		bytes -= prefix;
664 	}
665 
666 	words = bytes / 8;
667 
668 	while (words) {
669 		if (*(u64 *)start != value64)
670 			return check_bytes8(start, value, 8);
671 		start += 8;
672 		words--;
673 	}
674 
675 	return check_bytes8(start, value, bytes % 8);
676 }
677 #endif
678 
679