1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * linux/lib/string.c
4 *
5 * Copyright (C) 1991, 1992 Linus Torvalds
6 */
7
8 /*
9 * This file should be used only for "library" routines that may have
10 * alternative implementations on specific architectures (generally
11 * found in <asm-xx/string.h>), or get overloaded by FORTIFY_SOURCE.
12 * (Specifically, this file is built with __NO_FORTIFY.)
13 *
14 * Other helper functions should live in string_helpers.c.
15 */
16
17 #define __NO_FORTIFY
18 #include <linux/bits.h>
19 #include <linux/bug.h>
20 #include <linux/ctype.h>
21 #include <linux/errno.h>
22 #include <linux/limits.h>
23 #include <linux/linkage.h>
24 #include <linux/stddef.h>
25 #include <linux/string.h>
26 #include <linux/types.h>
27
28 #include <asm/page.h>
29 #include <asm/rwonce.h>
30 #include <linux/unaligned.h>
31 #include <asm/word-at-a-time.h>
32
33 #ifndef __HAVE_ARCH_STRNCASECMP
34 /**
35 * strncasecmp - Case insensitive, length-limited string comparison
36 * @s1: One string
37 * @s2: The other string
38 * @len: the maximum number of characters to compare
39 */
strncasecmp(const char * s1,const char * s2,size_t len)40 int strncasecmp(const char *s1, const char *s2, size_t len)
41 {
42 /* Yes, Virginia, it had better be unsigned */
43 unsigned char c1, c2;
44
45 if (!len)
46 return 0;
47
48 do {
49 c1 = *s1++;
50 c2 = *s2++;
51 if (!c1 || !c2)
52 break;
53 if (c1 == c2)
54 continue;
55 c1 = tolower(c1);
56 c2 = tolower(c2);
57 if (c1 != c2)
58 break;
59 } while (--len);
60 return (int)c1 - (int)c2;
61 }
62 EXPORT_SYMBOL(strncasecmp);
63 #endif
64
65 #ifndef __HAVE_ARCH_STRCASECMP
strcasecmp(const char * s1,const char * s2)66 int strcasecmp(const char *s1, const char *s2)
67 {
68 int c1, c2;
69
70 do {
71 c1 = tolower(*s1++);
72 c2 = tolower(*s2++);
73 } while (c1 == c2 && c1 != 0);
74 return c1 - c2;
75 }
76 EXPORT_SYMBOL(strcasecmp);
77 #endif
78
79 #ifndef __HAVE_ARCH_STRCPY
strcpy(char * dest,const char * src)80 char *strcpy(char *dest, const char *src)
81 {
82 char *tmp = dest;
83
84 while ((*dest++ = *src++) != '\0')
85 /* nothing */;
86 return tmp;
87 }
88 EXPORT_SYMBOL(strcpy);
89 #endif
90
91 #ifndef __HAVE_ARCH_STRNCPY
strncpy(char * dest,const char * src,size_t count)92 char *strncpy(char *dest, const char *src, size_t count)
93 {
94 char *tmp = dest;
95
96 while (count) {
97 if ((*tmp = *src) != 0)
98 src++;
99 tmp++;
100 count--;
101 }
102 return dest;
103 }
104 EXPORT_SYMBOL(strncpy);
105 #endif
106
107 #ifdef __BIG_ENDIAN
108 # define ALLBUTLAST_BYTE_MASK (~255ul)
109 #else
110 # define ALLBUTLAST_BYTE_MASK (~0ul >> 8)
111 #endif
112
sized_strscpy(char * dest,const char * src,size_t count)113 ssize_t sized_strscpy(char *dest, const char *src, size_t count)
114 {
115 const struct word_at_a_time constants = WORD_AT_A_TIME_CONSTANTS;
116 size_t max = count;
117 long res = 0;
118
119 if (count == 0 || WARN_ON_ONCE(count > INT_MAX))
120 return -E2BIG;
121
122 #ifndef CONFIG_DCACHE_WORD_ACCESS
123 #ifdef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
124 /*
125 * If src is unaligned, don't cross a page boundary,
126 * since we don't know if the next page is mapped.
127 */
128 if ((long)src & (sizeof(long) - 1)) {
129 size_t limit = PAGE_SIZE - ((long)src & (PAGE_SIZE - 1));
130 if (limit < max)
131 max = limit;
132 }
133 #else
134 /* If src or dest is unaligned, don't do word-at-a-time. */
135 if (((long) dest | (long) src) & (sizeof(long) - 1))
136 max = 0;
137 #endif
138 #endif
139
140 /*
141 * load_unaligned_zeropad() or read_word_at_a_time() below may read
142 * uninitialized bytes after the trailing zero and use them in
143 * comparisons. Disable this optimization under KMSAN to prevent
144 * false positive reports.
145 */
146 if (IS_ENABLED(CONFIG_KMSAN))
147 max = 0;
148
149 while (max >= sizeof(unsigned long)) {
150 unsigned long c, data;
151
152 #ifdef CONFIG_DCACHE_WORD_ACCESS
153 c = load_unaligned_zeropad(src+res);
154 #else
155 c = read_word_at_a_time(src+res);
156 #endif
157 if (has_zero(c, &data, &constants)) {
158 data = prep_zero_mask(c, data, &constants);
159 data = create_zero_mask(data);
160 *(unsigned long *)(dest+res) = c & zero_bytemask(data);
161 return res + find_zero(data);
162 }
163 count -= sizeof(unsigned long);
164 if (unlikely(!count)) {
165 c &= ALLBUTLAST_BYTE_MASK;
166 *(unsigned long *)(dest+res) = c;
167 return -E2BIG;
168 }
169 *(unsigned long *)(dest+res) = c;
170 res += sizeof(unsigned long);
171 max -= sizeof(unsigned long);
172 }
173
174 while (count > 1) {
175 char c;
176
177 c = src[res];
178 dest[res] = c;
179 if (!c)
180 return res;
181 res++;
182 count--;
183 }
184
185 /* Force NUL-termination. */
186 dest[res] = '\0';
187
188 /* Return E2BIG if the source didn't stop */
189 return src[res] ? -E2BIG : res;
190 }
191 EXPORT_SYMBOL(sized_strscpy);
192
193 /**
194 * stpcpy - copy a string from src to dest returning a pointer to the new end
195 * of dest, including src's %NUL-terminator. May overrun dest.
196 * @dest: pointer to end of string being copied into. Must be large enough
197 * to receive copy.
198 * @src: pointer to the beginning of string being copied from. Must not overlap
199 * dest.
200 *
201 * stpcpy differs from strcpy in a key way: the return value is a pointer
202 * to the new %NUL-terminating character in @dest. (For strcpy, the return
203 * value is a pointer to the start of @dest). This interface is considered
204 * unsafe as it doesn't perform bounds checking of the inputs. As such it's
205 * not recommended for usage. Instead, its definition is provided in case
206 * the compiler lowers other libcalls to stpcpy.
207 */
208 char *stpcpy(char *__restrict__ dest, const char *__restrict__ src);
stpcpy(char * __restrict__ dest,const char * __restrict__ src)209 char *stpcpy(char *__restrict__ dest, const char *__restrict__ src)
210 {
211 while ((*dest++ = *src++) != '\0')
212 /* nothing */;
213 return --dest;
214 }
215 EXPORT_SYMBOL(stpcpy);
216
217 #ifndef __HAVE_ARCH_STRCAT
strcat(char * dest,const char * src)218 char *strcat(char *dest, const char *src)
219 {
220 char *tmp = dest;
221
222 while (*dest)
223 dest++;
224 while ((*dest++ = *src++) != '\0')
225 ;
226 return tmp;
227 }
228 EXPORT_SYMBOL(strcat);
229 #endif
230
231 #ifndef __HAVE_ARCH_STRNCAT
strncat(char * dest,const char * src,size_t count)232 char *strncat(char *dest, const char *src, size_t count)
233 {
234 char *tmp = dest;
235
236 if (count) {
237 while (*dest)
238 dest++;
239 while ((*dest++ = *src++) != 0) {
240 if (--count == 0) {
241 *dest = '\0';
242 break;
243 }
244 }
245 }
246 return tmp;
247 }
248 EXPORT_SYMBOL(strncat);
249 #endif
250
251 #ifndef __HAVE_ARCH_STRLCAT
strlcat(char * dest,const char * src,size_t count)252 size_t strlcat(char *dest, const char *src, size_t count)
253 {
254 size_t dsize = strlen(dest);
255 size_t len = strlen(src);
256 size_t res = dsize + len;
257
258 /* This would be a bug */
259 BUG_ON(dsize >= count);
260
261 dest += dsize;
262 count -= dsize;
263 if (len >= count)
264 len = count-1;
265 __builtin_memcpy(dest, src, len);
266 dest[len] = 0;
267 return res;
268 }
269 EXPORT_SYMBOL(strlcat);
270 #endif
271
272 #ifndef __HAVE_ARCH_STRCMP
273 /**
274 * strcmp - Compare two strings
275 * @cs: One string
276 * @ct: Another string
277 */
strcmp(const char * cs,const char * ct)278 int strcmp(const char *cs, const char *ct)
279 {
280 unsigned char c1, c2;
281
282 while (1) {
283 c1 = *cs++;
284 c2 = *ct++;
285 if (c1 != c2)
286 return c1 < c2 ? -1 : 1;
287 if (!c1)
288 break;
289 }
290 return 0;
291 }
292 EXPORT_SYMBOL(strcmp);
293 #endif
294
295 #ifndef __HAVE_ARCH_STRNCMP
296 /**
297 * strncmp - Compare two length-limited strings
298 * @cs: One string
299 * @ct: Another string
300 * @count: The maximum number of bytes to compare
301 */
strncmp(const char * cs,const char * ct,size_t count)302 int strncmp(const char *cs, const char *ct, size_t count)
303 {
304 unsigned char c1, c2;
305
306 while (count) {
307 c1 = *cs++;
308 c2 = *ct++;
309 if (c1 != c2)
310 return c1 < c2 ? -1 : 1;
311 if (!c1)
312 break;
313 count--;
314 }
315 return 0;
316 }
317 EXPORT_SYMBOL(strncmp);
318 #endif
319
320 #ifndef __HAVE_ARCH_STRCHR
321 /**
322 * strchr - Find the first occurrence of a character in a string
323 * @s: The string to be searched
324 * @c: The character to search for
325 *
326 * Note that the %NUL-terminator is considered part of the string, and can
327 * be searched for.
328 */
strchr(const char * s,int c)329 char *strchr(const char *s, int c)
330 {
331 for (; *s != (char)c; ++s)
332 if (*s == '\0')
333 return NULL;
334 return (char *)s;
335 }
336 EXPORT_SYMBOL(strchr);
337 #endif
338
339 #ifndef __HAVE_ARCH_STRCHRNUL
340 /**
341 * strchrnul - Find and return a character in a string, or end of string
342 * @s: The string to be searched
343 * @c: The character to search for
344 *
345 * Returns pointer to first occurrence of 'c' in s. If c is not found, then
346 * return a pointer to the null byte at the end of s.
347 */
strchrnul(const char * s,int c)348 char *strchrnul(const char *s, int c)
349 {
350 while (*s && *s != (char)c)
351 s++;
352 return (char *)s;
353 }
354 EXPORT_SYMBOL(strchrnul);
355 #endif
356
357 /**
358 * strnchrnul - Find and return a character in a length limited string,
359 * or end of string
360 * @s: The string to be searched
361 * @count: The number of characters to be searched
362 * @c: The character to search for
363 *
364 * Returns pointer to the first occurrence of 'c' in s. If c is not found,
365 * then return a pointer to the last character of the string.
366 */
strnchrnul(const char * s,size_t count,int c)367 char *strnchrnul(const char *s, size_t count, int c)
368 {
369 while (count-- && *s && *s != (char)c)
370 s++;
371 return (char *)s;
372 }
373
374 #ifndef __HAVE_ARCH_STRRCHR
375 /**
376 * strrchr - Find the last occurrence of a character in a string
377 * @s: The string to be searched
378 * @c: The character to search for
379 */
strrchr(const char * s,int c)380 char *strrchr(const char *s, int c)
381 {
382 const char *last = NULL;
383 do {
384 if (*s == (char)c)
385 last = s;
386 } while (*s++);
387 return (char *)last;
388 }
389 EXPORT_SYMBOL(strrchr);
390 #endif
391
392 #ifndef __HAVE_ARCH_STRNCHR
393 /**
394 * strnchr - Find a character in a length limited string
395 * @s: The string to be searched
396 * @count: The number of characters to be searched
397 * @c: The character to search for
398 *
399 * Note that the %NUL-terminator is considered part of the string, and can
400 * be searched for.
401 */
strnchr(const char * s,size_t count,int c)402 char *strnchr(const char *s, size_t count, int c)
403 {
404 while (count--) {
405 if (*s == (char)c)
406 return (char *)s;
407 if (*s++ == '\0')
408 break;
409 }
410 return NULL;
411 }
412 EXPORT_SYMBOL(strnchr);
413 #endif
414
415 #ifndef __HAVE_ARCH_STRLEN
strlen(const char * s)416 size_t strlen(const char *s)
417 {
418 const char *sc;
419
420 for (sc = s; *sc != '\0'; ++sc)
421 /* nothing */;
422 return sc - s;
423 }
424 EXPORT_SYMBOL(strlen);
425 #endif
426
427 #ifndef __HAVE_ARCH_STRNLEN
strnlen(const char * s,size_t count)428 size_t strnlen(const char *s, size_t count)
429 {
430 const char *sc;
431
432 for (sc = s; count-- && *sc != '\0'; ++sc)
433 /* nothing */;
434 return sc - s;
435 }
436 EXPORT_SYMBOL(strnlen);
437 #endif
438
439 #ifndef __HAVE_ARCH_STRSPN
440 /**
441 * strspn - Calculate the length of the initial substring of @s which only contain letters in @accept
442 * @s: The string to be searched
443 * @accept: The string to search for
444 */
strspn(const char * s,const char * accept)445 size_t strspn(const char *s, const char *accept)
446 {
447 const char *p;
448
449 for (p = s; *p != '\0'; ++p) {
450 if (!strchr(accept, *p))
451 break;
452 }
453 return p - s;
454 }
455 EXPORT_SYMBOL(strspn);
456 #endif
457
458 #ifndef __HAVE_ARCH_STRCSPN
459 /**
460 * strcspn - Calculate the length of the initial substring of @s which does not contain letters in @reject
461 * @s: The string to be searched
462 * @reject: The string to avoid
463 */
strcspn(const char * s,const char * reject)464 size_t strcspn(const char *s, const char *reject)
465 {
466 const char *p;
467
468 for (p = s; *p != '\0'; ++p) {
469 if (strchr(reject, *p))
470 break;
471 }
472 return p - s;
473 }
474 EXPORT_SYMBOL(strcspn);
475 #endif
476
477 #ifndef __HAVE_ARCH_STRPBRK
478 /**
479 * strpbrk - Find the first occurrence of a set of characters
480 * @cs: The string to be searched
481 * @ct: The characters to search for
482 */
strpbrk(const char * cs,const char * ct)483 char *strpbrk(const char *cs, const char *ct)
484 {
485 const char *sc;
486
487 for (sc = cs; *sc != '\0'; ++sc) {
488 if (strchr(ct, *sc))
489 return (char *)sc;
490 }
491 return NULL;
492 }
493 EXPORT_SYMBOL(strpbrk);
494 #endif
495
496 #ifndef __HAVE_ARCH_STRSEP
497 /**
498 * strsep - Split a string into tokens
499 * @s: The string to be searched
500 * @ct: The characters to search for
501 *
502 * strsep() updates @s to point after the token, ready for the next call.
503 *
504 * It returns empty tokens, too, behaving exactly like the libc function
505 * of that name. In fact, it was stolen from glibc2 and de-fancy-fied.
506 * Same semantics, slimmer shape. ;)
507 */
strsep(char ** s,const char * ct)508 char *strsep(char **s, const char *ct)
509 {
510 char *sbegin = *s;
511 char *end;
512
513 if (sbegin == NULL)
514 return NULL;
515
516 end = strpbrk(sbegin, ct);
517 if (end)
518 *end++ = '\0';
519 *s = end;
520 return sbegin;
521 }
522 EXPORT_SYMBOL(strsep);
523 #endif
524
525 #ifndef __HAVE_ARCH_MEMSET
526 /**
527 * memset - Fill a region of memory with the given value
528 * @s: Pointer to the start of the area.
529 * @c: The byte to fill the area with
530 * @count: The size of the area.
531 *
532 * Do not use memset() to access IO space, use memset_io() instead.
533 */
memset(void * s,int c,size_t count)534 void *memset(void *s, int c, size_t count)
535 {
536 char *xs = s;
537
538 while (count--)
539 *xs++ = c;
540 return s;
541 }
542 EXPORT_SYMBOL(memset);
543 #endif
544
545 #ifndef __HAVE_ARCH_MEMSET16
546 /**
547 * memset16() - Fill a memory area with a uint16_t
548 * @s: Pointer to the start of the area.
549 * @v: The value to fill the area with
550 * @count: The number of values to store
551 *
552 * Differs from memset() in that it fills with a uint16_t instead
553 * of a byte. Remember that @count is the number of uint16_ts to
554 * store, not the number of bytes.
555 */
memset16(uint16_t * s,uint16_t v,size_t count)556 void *memset16(uint16_t *s, uint16_t v, size_t count)
557 {
558 uint16_t *xs = s;
559
560 while (count--)
561 *xs++ = v;
562 return s;
563 }
564 EXPORT_SYMBOL(memset16);
565 #endif
566
567 #ifndef __HAVE_ARCH_MEMSET32
568 /**
569 * memset32() - Fill a memory area with a uint32_t
570 * @s: Pointer to the start of the area.
571 * @v: The value to fill the area with
572 * @count: The number of values to store
573 *
574 * Differs from memset() in that it fills with a uint32_t instead
575 * of a byte. Remember that @count is the number of uint32_ts to
576 * store, not the number of bytes.
577 */
memset32(uint32_t * s,uint32_t v,size_t count)578 void *memset32(uint32_t *s, uint32_t v, size_t count)
579 {
580 uint32_t *xs = s;
581
582 while (count--)
583 *xs++ = v;
584 return s;
585 }
586 EXPORT_SYMBOL(memset32);
587 #endif
588
589 #ifndef __HAVE_ARCH_MEMSET64
590 /**
591 * memset64() - Fill a memory area with a uint64_t
592 * @s: Pointer to the start of the area.
593 * @v: The value to fill the area with
594 * @count: The number of values to store
595 *
596 * Differs from memset() in that it fills with a uint64_t instead
597 * of a byte. Remember that @count is the number of uint64_ts to
598 * store, not the number of bytes.
599 */
memset64(uint64_t * s,uint64_t v,size_t count)600 void *memset64(uint64_t *s, uint64_t v, size_t count)
601 {
602 uint64_t *xs = s;
603
604 while (count--)
605 *xs++ = v;
606 return s;
607 }
608 EXPORT_SYMBOL(memset64);
609 #endif
610
611 #ifndef __HAVE_ARCH_MEMCPY
612 /**
613 * memcpy - Copy one area of memory to another
614 * @dest: Where to copy to
615 * @src: Where to copy from
616 * @count: The size of the area.
617 *
618 * You should not use this function to access IO space, use memcpy_toio()
619 * or memcpy_fromio() instead.
620 */
memcpy(void * dest,const void * src,size_t count)621 void *memcpy(void *dest, const void *src, size_t count)
622 {
623 char *tmp = dest;
624 const char *s = src;
625
626 while (count--)
627 *tmp++ = *s++;
628 return dest;
629 }
630 EXPORT_SYMBOL(memcpy);
631 #endif
632
633 #ifndef __HAVE_ARCH_MEMMOVE
634 /**
635 * memmove - Copy one area of memory to another
636 * @dest: Where to copy to
637 * @src: Where to copy from
638 * @count: The size of the area.
639 *
640 * Unlike memcpy(), memmove() copes with overlapping areas.
641 */
memmove(void * dest,const void * src,size_t count)642 void *memmove(void *dest, const void *src, size_t count)
643 {
644 char *tmp;
645 const char *s;
646
647 if (dest <= src) {
648 tmp = dest;
649 s = src;
650 while (count--)
651 *tmp++ = *s++;
652 } else {
653 tmp = dest;
654 tmp += count;
655 s = src;
656 s += count;
657 while (count--)
658 *--tmp = *--s;
659 }
660 return dest;
661 }
662 EXPORT_SYMBOL(memmove);
663 #endif
664
665 #ifndef __HAVE_ARCH_MEMCMP
666 /**
667 * memcmp - Compare two areas of memory
668 * @cs: One area of memory
669 * @ct: Another area of memory
670 * @count: The size of the area.
671 */
672 #undef memcmp
memcmp(const void * cs,const void * ct,size_t count)673 __visible int memcmp(const void *cs, const void *ct, size_t count)
674 {
675 const unsigned char *su1, *su2;
676 int res = 0;
677
678 #ifdef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
679 if (count >= sizeof(unsigned long)) {
680 const unsigned long *u1 = cs;
681 const unsigned long *u2 = ct;
682 do {
683 if (get_unaligned(u1) != get_unaligned(u2))
684 break;
685 u1++;
686 u2++;
687 count -= sizeof(unsigned long);
688 } while (count >= sizeof(unsigned long));
689 cs = u1;
690 ct = u2;
691 }
692 #endif
693 for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
694 if ((res = *su1 - *su2) != 0)
695 break;
696 return res;
697 }
698 EXPORT_SYMBOL(memcmp);
699 #endif
700
701 #ifndef __HAVE_ARCH_BCMP
702 /**
703 * bcmp - returns 0 if and only if the buffers have identical contents.
704 * @a: pointer to first buffer.
705 * @b: pointer to second buffer.
706 * @len: size of buffers.
707 *
708 * The sign or magnitude of a non-zero return value has no particular
709 * meaning, and architectures may implement their own more efficient bcmp(). So
710 * while this particular implementation is a simple (tail) call to memcmp, do
711 * not rely on anything but whether the return value is zero or non-zero.
712 */
bcmp(const void * a,const void * b,size_t len)713 int bcmp(const void *a, const void *b, size_t len)
714 {
715 return memcmp(a, b, len);
716 }
717 EXPORT_SYMBOL(bcmp);
718 #endif
719
720 #ifndef __HAVE_ARCH_MEMSCAN
721 /**
722 * memscan - Find a character in an area of memory.
723 * @addr: The memory area
724 * @c: The byte to search for
725 * @size: The size of the area.
726 *
727 * returns the address of the first occurrence of @c, or 1 byte past
728 * the area if @c is not found
729 */
memscan(void * addr,int c,size_t size)730 void *memscan(void *addr, int c, size_t size)
731 {
732 unsigned char *p = addr;
733
734 while (size) {
735 if (*p == (unsigned char)c)
736 return (void *)p;
737 p++;
738 size--;
739 }
740 return (void *)p;
741 }
742 EXPORT_SYMBOL(memscan);
743 #endif
744
745 #ifndef __HAVE_ARCH_STRSTR
746 /**
747 * strstr - Find the first substring in a %NUL terminated string
748 * @s1: The string to be searched
749 * @s2: The string to search for
750 */
strstr(const char * s1,const char * s2)751 char *strstr(const char *s1, const char *s2)
752 {
753 size_t l1, l2;
754
755 l2 = strlen(s2);
756 if (!l2)
757 return (char *)s1;
758 l1 = strlen(s1);
759 while (l1 >= l2) {
760 l1--;
761 if (!memcmp(s1, s2, l2))
762 return (char *)s1;
763 s1++;
764 }
765 return NULL;
766 }
767 EXPORT_SYMBOL(strstr);
768 #endif
769
770 #ifndef __HAVE_ARCH_STRNSTR
771 /**
772 * strnstr - Find the first substring in a length-limited string
773 * @s1: The string to be searched
774 * @s2: The string to search for
775 * @len: the maximum number of characters to search
776 */
strnstr(const char * s1,const char * s2,size_t len)777 char *strnstr(const char *s1, const char *s2, size_t len)
778 {
779 size_t l2;
780
781 l2 = strlen(s2);
782 if (!l2)
783 return (char *)s1;
784 while (len >= l2) {
785 len--;
786 if (!memcmp(s1, s2, l2))
787 return (char *)s1;
788 s1++;
789 }
790 return NULL;
791 }
792 EXPORT_SYMBOL(strnstr);
793 #endif
794
795 #ifndef __HAVE_ARCH_MEMCHR
796 /**
797 * memchr - Find a character in an area of memory.
798 * @s: The memory area
799 * @c: The byte to search for
800 * @n: The size of the area.
801 *
802 * returns the address of the first occurrence of @c, or %NULL
803 * if @c is not found
804 */
memchr(const void * s,int c,size_t n)805 void *memchr(const void *s, int c, size_t n)
806 {
807 const unsigned char *p = s;
808 while (n-- != 0) {
809 if ((unsigned char)c == *p++) {
810 return (void *)(p - 1);
811 }
812 }
813 return NULL;
814 }
815 EXPORT_SYMBOL(memchr);
816 #endif
817
check_bytes8(const u8 * start,u8 value,unsigned int bytes)818 static void *check_bytes8(const u8 *start, u8 value, unsigned int bytes)
819 {
820 while (bytes) {
821 if (*start != value)
822 return (void *)start;
823 start++;
824 bytes--;
825 }
826 return NULL;
827 }
828
829 /**
830 * memchr_inv - Find an unmatching character in an area of memory.
831 * @start: The memory area
832 * @c: Find a character other than c
833 * @bytes: The size of the area.
834 *
835 * returns the address of the first character other than @c, or %NULL
836 * if the whole buffer contains just @c.
837 */
memchr_inv(const void * start,int c,size_t bytes)838 void *memchr_inv(const void *start, int c, size_t bytes)
839 {
840 u8 value = c;
841 u64 value64;
842 unsigned int words, prefix;
843
844 if (bytes <= 16)
845 return check_bytes8(start, value, bytes);
846
847 value64 = value;
848 #if defined(CONFIG_ARCH_HAS_FAST_MULTIPLIER) && BITS_PER_LONG == 64
849 value64 *= 0x0101010101010101ULL;
850 #elif defined(CONFIG_ARCH_HAS_FAST_MULTIPLIER)
851 value64 *= 0x01010101;
852 value64 |= value64 << 32;
853 #else
854 value64 |= value64 << 8;
855 value64 |= value64 << 16;
856 value64 |= value64 << 32;
857 #endif
858
859 prefix = (unsigned long)start % 8;
860 if (prefix) {
861 u8 *r;
862
863 prefix = 8 - prefix;
864 r = check_bytes8(start, value, prefix);
865 if (r)
866 return r;
867 start += prefix;
868 bytes -= prefix;
869 }
870
871 words = bytes / 8;
872
873 while (words) {
874 if (*(u64 *)start != value64)
875 return check_bytes8(start, value, 8);
876 start += 8;
877 words--;
878 }
879
880 return check_bytes8(start, value, bytes % 8);
881 }
882 EXPORT_SYMBOL(memchr_inv);
883