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