1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/types.h>
23#include <linux/string.h>
24#include <linux/ctype.h>
25#include <linux/kernel.h>
26#include <linux/export.h>
27#include <linux/bug.h>
28#include <linux/errno.h>
29
30#include <asm/byteorder.h>
31#include <asm/word-at-a-time.h>
32#include <asm/page.h>
33
34#ifndef __HAVE_ARCH_STRNCASECMP
35
36
37
38
39
40
41int strncasecmp(const char *s1, const char *s2, size_t len)
42{
43
44 unsigned char c1, c2;
45
46 if (!len)
47 return 0;
48
49 do {
50 c1 = *s1++;
51 c2 = *s2++;
52 if (!c1 || !c2)
53 break;
54 if (c1 == c2)
55 continue;
56 c1 = tolower(c1);
57 c2 = tolower(c2);
58 if (c1 != c2)
59 break;
60 } while (--len);
61 return (int)c1 - (int)c2;
62}
63EXPORT_SYMBOL(strncasecmp);
64#endif
65
66#ifndef __HAVE_ARCH_STRCASECMP
67int strcasecmp(const char *s1, const char *s2)
68{
69 int c1, c2;
70
71 do {
72 c1 = tolower(*s1++);
73 c2 = tolower(*s2++);
74 } while (c1 == c2 && c1 != 0);
75 return c1 - c2;
76}
77EXPORT_SYMBOL(strcasecmp);
78#endif
79
80#ifndef __HAVE_ARCH_STRCPY
81
82
83
84
85
86#undef strcpy
87char *strcpy(char *dest, const char *src)
88{
89 char *tmp = dest;
90
91 while ((*dest++ = *src++) != '\0')
92 ;
93 return tmp;
94}
95EXPORT_SYMBOL(strcpy);
96#endif
97
98#ifndef __HAVE_ARCH_STRNCPY
99
100
101
102
103
104
105
106
107
108
109
110
111
112char *strncpy(char *dest, const char *src, size_t count)
113{
114 char *tmp = dest;
115
116 while (count) {
117 if ((*tmp = *src) != 0)
118 src++;
119 tmp++;
120 count--;
121 }
122 return dest;
123}
124EXPORT_SYMBOL(strncpy);
125#endif
126
127#ifndef __HAVE_ARCH_STRLCPY
128
129
130
131
132
133
134
135
136
137
138
139size_t strlcpy(char *dest, const char *src, size_t size)
140{
141 size_t ret = strlen(src);
142
143 if (size) {
144 size_t len = (ret >= size) ? size - 1 : ret;
145 memcpy(dest, src, len);
146 dest[len] = '\0';
147 }
148 return ret;
149}
150EXPORT_SYMBOL(strlcpy);
151#endif
152
153#ifndef __HAVE_ARCH_STRSCPY
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177ssize_t strscpy(char *dest, const char *src, size_t count)
178{
179 const struct word_at_a_time constants = WORD_AT_A_TIME_CONSTANTS;
180 size_t max = count;
181 long res = 0;
182
183 if (count == 0)
184 return -E2BIG;
185
186#ifdef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
187
188
189
190
191 if ((long)src & (sizeof(long) - 1)) {
192 size_t limit = PAGE_SIZE - ((long)src & (PAGE_SIZE - 1));
193 if (limit < max)
194 max = limit;
195 }
196#else
197
198 if (((long) dest | (long) src) & (sizeof(long) - 1))
199 max = 0;
200#endif
201
202 while (max >= sizeof(unsigned long)) {
203 unsigned long c, data;
204
205 c = *(unsigned long *)(src+res);
206 if (has_zero(c, &data, &constants)) {
207 data = prep_zero_mask(c, data, &constants);
208 data = create_zero_mask(data);
209 *(unsigned long *)(dest+res) = c & zero_bytemask(data);
210 return res + find_zero(data);
211 }
212 *(unsigned long *)(dest+res) = c;
213 res += sizeof(unsigned long);
214 count -= sizeof(unsigned long);
215 max -= sizeof(unsigned long);
216 }
217
218 while (count) {
219 char c;
220
221 c = src[res];
222 dest[res] = c;
223 if (!c)
224 return res;
225 res++;
226 count--;
227 }
228
229
230 if (res)
231 dest[res-1] = '\0';
232
233 return -E2BIG;
234}
235EXPORT_SYMBOL(strscpy);
236#endif
237
238#ifndef __HAVE_ARCH_STRCAT
239
240
241
242
243
244#undef strcat
245char *strcat(char *dest, const char *src)
246{
247 char *tmp = dest;
248
249 while (*dest)
250 dest++;
251 while ((*dest++ = *src++) != '\0')
252 ;
253 return tmp;
254}
255EXPORT_SYMBOL(strcat);
256#endif
257
258#ifndef __HAVE_ARCH_STRNCAT
259
260
261
262
263
264
265
266
267
268char *strncat(char *dest, const char *src, size_t count)
269{
270 char *tmp = dest;
271
272 if (count) {
273 while (*dest)
274 dest++;
275 while ((*dest++ = *src++) != 0) {
276 if (--count == 0) {
277 *dest = '\0';
278 break;
279 }
280 }
281 }
282 return tmp;
283}
284EXPORT_SYMBOL(strncat);
285#endif
286
287#ifndef __HAVE_ARCH_STRLCAT
288
289
290
291
292
293
294size_t strlcat(char *dest, const char *src, size_t count)
295{
296 size_t dsize = strlen(dest);
297 size_t len = strlen(src);
298 size_t res = dsize + len;
299
300
301 BUG_ON(dsize >= count);
302
303 dest += dsize;
304 count -= dsize;
305 if (len >= count)
306 len = count-1;
307 memcpy(dest, src, len);
308 dest[len] = 0;
309 return res;
310}
311EXPORT_SYMBOL(strlcat);
312#endif
313
314#ifndef __HAVE_ARCH_STRCMP
315
316
317
318
319
320#undef strcmp
321int strcmp(const char *cs, const char *ct)
322{
323 unsigned char c1, c2;
324
325 while (1) {
326 c1 = *cs++;
327 c2 = *ct++;
328 if (c1 != c2)
329 return c1 < c2 ? -1 : 1;
330 if (!c1)
331 break;
332 }
333 return 0;
334}
335EXPORT_SYMBOL(strcmp);
336#endif
337
338#ifndef __HAVE_ARCH_STRNCMP
339
340
341
342
343
344
345int strncmp(const char *cs, const char *ct, size_t count)
346{
347 unsigned char c1, c2;
348
349 while (count) {
350 c1 = *cs++;
351 c2 = *ct++;
352 if (c1 != c2)
353 return c1 < c2 ? -1 : 1;
354 if (!c1)
355 break;
356 count--;
357 }
358 return 0;
359}
360EXPORT_SYMBOL(strncmp);
361#endif
362
363#ifndef __HAVE_ARCH_STRCHR
364
365
366
367
368
369char *strchr(const char *s, int c)
370{
371 for (; *s != (char)c; ++s)
372 if (*s == '\0')
373 return NULL;
374 return (char *)s;
375}
376EXPORT_SYMBOL(strchr);
377#endif
378
379#ifndef __HAVE_ARCH_STRCHRNUL
380
381
382
383
384
385
386
387
388char *strchrnul(const char *s, int c)
389{
390 while (*s && *s != (char)c)
391 s++;
392 return (char *)s;
393}
394EXPORT_SYMBOL(strchrnul);
395#endif
396
397#ifndef __HAVE_ARCH_STRRCHR
398
399
400
401
402
403char *strrchr(const char *s, int c)
404{
405 const char *last = NULL;
406 do {
407 if (*s == (char)c)
408 last = s;
409 } while (*s++);
410 return (char *)last;
411}
412EXPORT_SYMBOL(strrchr);
413#endif
414
415#ifndef __HAVE_ARCH_STRNCHR
416
417
418
419
420
421
422char *strnchr(const char *s, size_t count, int c)
423{
424 for (; count-- && *s != '\0'; ++s)
425 if (*s == (char)c)
426 return (char *)s;
427 return NULL;
428}
429EXPORT_SYMBOL(strnchr);
430#endif
431
432
433
434
435
436
437
438char *skip_spaces(const char *str)
439{
440 while (isspace(*str))
441 ++str;
442 return (char *)str;
443}
444EXPORT_SYMBOL(skip_spaces);
445
446
447
448
449
450
451
452
453
454char *strim(char *s)
455{
456 size_t size;
457 char *end;
458
459 size = strlen(s);
460 if (!size)
461 return s;
462
463 end = s + size - 1;
464 while (end >= s && isspace(*end))
465 end--;
466 *(end + 1) = '\0';
467
468 return skip_spaces(s);
469}
470EXPORT_SYMBOL(strim);
471
472#ifndef __HAVE_ARCH_STRLEN
473
474
475
476
477size_t strlen(const char *s)
478{
479 const char *sc;
480
481 for (sc = s; *sc != '\0'; ++sc)
482 ;
483 return sc - s;
484}
485EXPORT_SYMBOL(strlen);
486#endif
487
488#ifndef __HAVE_ARCH_STRNLEN
489
490
491
492
493
494size_t strnlen(const char *s, size_t count)
495{
496 const char *sc;
497
498 for (sc = s; count-- && *sc != '\0'; ++sc)
499 ;
500 return sc - s;
501}
502EXPORT_SYMBOL(strnlen);
503#endif
504
505#ifndef __HAVE_ARCH_STRSPN
506
507
508
509
510
511size_t strspn(const char *s, const char *accept)
512{
513 const char *p;
514 const char *a;
515 size_t count = 0;
516
517 for (p = s; *p != '\0'; ++p) {
518 for (a = accept; *a != '\0'; ++a) {
519 if (*p == *a)
520 break;
521 }
522 if (*a == '\0')
523 return count;
524 ++count;
525 }
526 return count;
527}
528
529EXPORT_SYMBOL(strspn);
530#endif
531
532#ifndef __HAVE_ARCH_STRCSPN
533
534
535
536
537
538size_t strcspn(const char *s, const char *reject)
539{
540 const char *p;
541 const char *r;
542 size_t count = 0;
543
544 for (p = s; *p != '\0'; ++p) {
545 for (r = reject; *r != '\0'; ++r) {
546 if (*p == *r)
547 return count;
548 }
549 ++count;
550 }
551 return count;
552}
553EXPORT_SYMBOL(strcspn);
554#endif
555
556#ifndef __HAVE_ARCH_STRPBRK
557
558
559
560
561
562char *strpbrk(const char *cs, const char *ct)
563{
564 const char *sc1, *sc2;
565
566 for (sc1 = cs; *sc1 != '\0'; ++sc1) {
567 for (sc2 = ct; *sc2 != '\0'; ++sc2) {
568 if (*sc1 == *sc2)
569 return (char *)sc1;
570 }
571 }
572 return NULL;
573}
574EXPORT_SYMBOL(strpbrk);
575#endif
576
577#ifndef __HAVE_ARCH_STRSEP
578
579
580
581
582
583
584
585
586
587
588
589char *strsep(char **s, const char *ct)
590{
591 char *sbegin = *s;
592 char *end;
593
594 if (sbegin == NULL)
595 return NULL;
596
597 end = strpbrk(sbegin, ct);
598 if (end)
599 *end++ = '\0';
600 *s = end;
601 return sbegin;
602}
603EXPORT_SYMBOL(strsep);
604#endif
605
606
607
608
609
610
611
612
613
614
615
616bool sysfs_streq(const char *s1, const char *s2)
617{
618 while (*s1 && *s1 == *s2) {
619 s1++;
620 s2++;
621 }
622
623 if (*s1 == *s2)
624 return true;
625 if (!*s1 && *s2 == '\n' && !s2[1])
626 return true;
627 if (*s1 == '\n' && !s1[1] && !*s2)
628 return true;
629 return false;
630}
631EXPORT_SYMBOL(sysfs_streq);
632
633
634
635
636
637
638
639
640
641
642int match_string(const char * const *array, size_t n, const char *string)
643{
644 int index;
645 const char *item;
646
647 for (index = 0; index < n; index++) {
648 item = array[index];
649 if (!item)
650 break;
651 if (!strcmp(item, string))
652 return index;
653 }
654
655 return -EINVAL;
656}
657EXPORT_SYMBOL(match_string);
658
659#ifndef __HAVE_ARCH_MEMSET
660
661
662
663
664
665
666
667
668void *memset(void *s, int c, size_t count)
669{
670 char *xs = s;
671
672 while (count--)
673 *xs++ = c;
674 return s;
675}
676EXPORT_SYMBOL(memset);
677#endif
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693void memzero_explicit(void *s, size_t count)
694{
695 memset(s, 0, count);
696 barrier_data(s);
697}
698EXPORT_SYMBOL(memzero_explicit);
699
700#ifndef __HAVE_ARCH_MEMCPY
701
702
703
704
705
706
707
708
709
710void *memcpy(void *dest, const void *src, size_t count)
711{
712 char *tmp = dest;
713 const char *s = src;
714
715 while (count--)
716 *tmp++ = *s++;
717 return dest;
718}
719EXPORT_SYMBOL(memcpy);
720#endif
721
722#ifndef __HAVE_ARCH_MEMMOVE
723
724
725
726
727
728
729
730
731void *memmove(void *dest, const void *src, size_t count)
732{
733 char *tmp;
734 const char *s;
735
736 if (dest <= src) {
737 tmp = dest;
738 s = src;
739 while (count--)
740 *tmp++ = *s++;
741 } else {
742 tmp = dest;
743 tmp += count;
744 s = src;
745 s += count;
746 while (count--)
747 *--tmp = *--s;
748 }
749 return dest;
750}
751EXPORT_SYMBOL(memmove);
752#endif
753
754#ifndef __HAVE_ARCH_MEMCMP
755
756
757
758
759
760
761#undef memcmp
762__visible int memcmp(const void *cs, const void *ct, size_t count)
763{
764 const unsigned char *su1, *su2;
765 int res = 0;
766
767 for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
768 if ((res = *su1 - *su2) != 0)
769 break;
770 return res;
771}
772EXPORT_SYMBOL(memcmp);
773#endif
774
775#ifndef __HAVE_ARCH_MEMSCAN
776
777
778
779
780
781
782
783
784
785void *memscan(void *addr, int c, size_t size)
786{
787 unsigned char *p = addr;
788
789 while (size) {
790 if (*p == c)
791 return (void *)p;
792 p++;
793 size--;
794 }
795 return (void *)p;
796}
797EXPORT_SYMBOL(memscan);
798#endif
799
800#ifndef __HAVE_ARCH_STRSTR
801
802
803
804
805
806char *strstr(const char *s1, const char *s2)
807{
808 size_t l1, l2;
809
810 l2 = strlen(s2);
811 if (!l2)
812 return (char *)s1;
813 l1 = strlen(s1);
814 while (l1 >= l2) {
815 l1--;
816 if (!memcmp(s1, s2, l2))
817 return (char *)s1;
818 s1++;
819 }
820 return NULL;
821}
822EXPORT_SYMBOL(strstr);
823#endif
824
825#ifndef __HAVE_ARCH_STRNSTR
826
827
828
829
830
831
832char *strnstr(const char *s1, const char *s2, size_t len)
833{
834 size_t l2;
835
836 l2 = strlen(s2);
837 if (!l2)
838 return (char *)s1;
839 while (len >= l2) {
840 len--;
841 if (!memcmp(s1, s2, l2))
842 return (char *)s1;
843 s1++;
844 }
845 return NULL;
846}
847EXPORT_SYMBOL(strnstr);
848#endif
849
850#ifndef __HAVE_ARCH_MEMCHR
851
852
853
854
855
856
857
858
859
860void *memchr(const void *s, int c, size_t n)
861{
862 const unsigned char *p = s;
863 while (n-- != 0) {
864 if ((unsigned char)c == *p++) {
865 return (void *)(p - 1);
866 }
867 }
868 return NULL;
869}
870EXPORT_SYMBOL(memchr);
871#endif
872
873static void *check_bytes8(const u8 *start, u8 value, unsigned int bytes)
874{
875 while (bytes) {
876 if (*start != value)
877 return (void *)start;
878 start++;
879 bytes--;
880 }
881 return NULL;
882}
883
884
885
886
887
888
889
890
891
892
893void *memchr_inv(const void *start, int c, size_t bytes)
894{
895 u8 value = c;
896 u64 value64;
897 unsigned int words, prefix;
898
899 if (bytes <= 16)
900 return check_bytes8(start, value, bytes);
901
902 value64 = value;
903#if defined(CONFIG_ARCH_HAS_FAST_MULTIPLIER) && BITS_PER_LONG == 64
904 value64 *= 0x0101010101010101ULL;
905#elif defined(CONFIG_ARCH_HAS_FAST_MULTIPLIER)
906 value64 *= 0x01010101;
907 value64 |= value64 << 32;
908#else
909 value64 |= value64 << 8;
910 value64 |= value64 << 16;
911 value64 |= value64 << 32;
912#endif
913
914 prefix = (unsigned long)start % 8;
915 if (prefix) {
916 u8 *r;
917
918 prefix = 8 - prefix;
919 r = check_bytes8(start, value, prefix);
920 if (r)
921 return r;
922 start += prefix;
923 bytes -= prefix;
924 }
925
926 words = bytes / 8;
927
928 while (words) {
929 if (*(u64 *)start != value64)
930 return check_bytes8(start, value, 8);
931 start += 8;
932 words--;
933 }
934
935 return check_bytes8(start, value, bytes % 8);
936}
937EXPORT_SYMBOL(memchr_inv);
938
939
940
941
942
943
944
945
946
947char *strreplace(char *s, char old, char new)
948{
949 for (; *s; ++s)
950 if (*s == old)
951 *s = new;
952 return s;
953}
954EXPORT_SYMBOL(strreplace);
955