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#ifndef __HAVE_ARCH_STRCAT
276
277
278
279
280
281#undef strcat
282char *strcat(char *dest, const char *src)
283{
284 char *tmp = dest;
285
286 while (*dest)
287 dest++;
288 while ((*dest++ = *src++) != '\0')
289 ;
290 return tmp;
291}
292EXPORT_SYMBOL(strcat);
293#endif
294
295#ifndef __HAVE_ARCH_STRNCAT
296
297
298
299
300
301
302
303
304
305char *strncat(char *dest, const char *src, size_t count)
306{
307 char *tmp = dest;
308
309 if (count) {
310 while (*dest)
311 dest++;
312 while ((*dest++ = *src++) != 0) {
313 if (--count == 0) {
314 *dest = '\0';
315 break;
316 }
317 }
318 }
319 return tmp;
320}
321EXPORT_SYMBOL(strncat);
322#endif
323
324#ifndef __HAVE_ARCH_STRLCAT
325
326
327
328
329
330
331size_t strlcat(char *dest, const char *src, size_t count)
332{
333 size_t dsize = strlen(dest);
334 size_t len = strlen(src);
335 size_t res = dsize + len;
336
337
338 BUG_ON(dsize >= count);
339
340 dest += dsize;
341 count -= dsize;
342 if (len >= count)
343 len = count-1;
344 memcpy(dest, src, len);
345 dest[len] = 0;
346 return res;
347}
348EXPORT_SYMBOL(strlcat);
349#endif
350
351#ifndef __HAVE_ARCH_STRCMP
352
353
354
355
356
357#undef strcmp
358int strcmp(const char *cs, const char *ct)
359{
360 unsigned char c1, c2;
361
362 while (1) {
363 c1 = *cs++;
364 c2 = *ct++;
365 if (c1 != c2)
366 return c1 < c2 ? -1 : 1;
367 if (!c1)
368 break;
369 }
370 return 0;
371}
372EXPORT_SYMBOL(strcmp);
373#endif
374
375#ifndef __HAVE_ARCH_STRNCMP
376
377
378
379
380
381
382int strncmp(const char *cs, const char *ct, size_t count)
383{
384 unsigned char c1, c2;
385
386 while (count) {
387 c1 = *cs++;
388 c2 = *ct++;
389 if (c1 != c2)
390 return c1 < c2 ? -1 : 1;
391 if (!c1)
392 break;
393 count--;
394 }
395 return 0;
396}
397EXPORT_SYMBOL(strncmp);
398#endif
399
400#ifndef __HAVE_ARCH_STRCHR
401
402
403
404
405
406
407
408
409char *strchr(const char *s, int c)
410{
411 for (; *s != (char)c; ++s)
412 if (*s == '\0')
413 return NULL;
414 return (char *)s;
415}
416EXPORT_SYMBOL(strchr);
417#endif
418
419#ifndef __HAVE_ARCH_STRCHRNUL
420
421
422
423
424
425
426
427
428char *strchrnul(const char *s, int c)
429{
430 while (*s && *s != (char)c)
431 s++;
432 return (char *)s;
433}
434EXPORT_SYMBOL(strchrnul);
435#endif
436
437
438
439
440
441
442
443
444
445
446
447char *strnchrnul(const char *s, size_t count, int c)
448{
449 while (count-- && *s && *s != (char)c)
450 s++;
451 return (char *)s;
452}
453
454#ifndef __HAVE_ARCH_STRRCHR
455
456
457
458
459
460char *strrchr(const char *s, int c)
461{
462 const char *last = NULL;
463 do {
464 if (*s == (char)c)
465 last = s;
466 } while (*s++);
467 return (char *)last;
468}
469EXPORT_SYMBOL(strrchr);
470#endif
471
472#ifndef __HAVE_ARCH_STRNCHR
473
474
475
476
477
478
479
480
481
482char *strnchr(const char *s, size_t count, int c)
483{
484 while (count--) {
485 if (*s == (char)c)
486 return (char *)s;
487 if (*s++ == '\0')
488 break;
489 }
490 return NULL;
491}
492EXPORT_SYMBOL(strnchr);
493#endif
494
495
496
497
498
499
500
501char *skip_spaces(const char *str)
502{
503 while (isspace(*str))
504 ++str;
505 return (char *)str;
506}
507EXPORT_SYMBOL(skip_spaces);
508
509
510
511
512
513
514
515
516
517char *strim(char *s)
518{
519 size_t size;
520 char *end;
521
522 size = strlen(s);
523 if (!size)
524 return s;
525
526 end = s + size - 1;
527 while (end >= s && isspace(*end))
528 end--;
529 *(end + 1) = '\0';
530
531 return skip_spaces(s);
532}
533EXPORT_SYMBOL(strim);
534
535#ifndef __HAVE_ARCH_STRLEN
536
537
538
539
540size_t strlen(const char *s)
541{
542 const char *sc;
543
544 for (sc = s; *sc != '\0'; ++sc)
545 ;
546 return sc - s;
547}
548EXPORT_SYMBOL(strlen);
549#endif
550
551#ifndef __HAVE_ARCH_STRNLEN
552
553
554
555
556
557size_t strnlen(const char *s, size_t count)
558{
559 const char *sc;
560
561 for (sc = s; count-- && *sc != '\0'; ++sc)
562 ;
563 return sc - s;
564}
565EXPORT_SYMBOL(strnlen);
566#endif
567
568#ifndef __HAVE_ARCH_STRSPN
569
570
571
572
573
574size_t strspn(const char *s, const char *accept)
575{
576 const char *p;
577 const char *a;
578 size_t count = 0;
579
580 for (p = s; *p != '\0'; ++p) {
581 for (a = accept; *a != '\0'; ++a) {
582 if (*p == *a)
583 break;
584 }
585 if (*a == '\0')
586 return count;
587 ++count;
588 }
589 return count;
590}
591
592EXPORT_SYMBOL(strspn);
593#endif
594
595#ifndef __HAVE_ARCH_STRCSPN
596
597
598
599
600
601size_t strcspn(const char *s, const char *reject)
602{
603 const char *p;
604 const char *r;
605 size_t count = 0;
606
607 for (p = s; *p != '\0'; ++p) {
608 for (r = reject; *r != '\0'; ++r) {
609 if (*p == *r)
610 return count;
611 }
612 ++count;
613 }
614 return count;
615}
616EXPORT_SYMBOL(strcspn);
617#endif
618
619#ifndef __HAVE_ARCH_STRPBRK
620
621
622
623
624
625char *strpbrk(const char *cs, const char *ct)
626{
627 const char *sc1, *sc2;
628
629 for (sc1 = cs; *sc1 != '\0'; ++sc1) {
630 for (sc2 = ct; *sc2 != '\0'; ++sc2) {
631 if (*sc1 == *sc2)
632 return (char *)sc1;
633 }
634 }
635 return NULL;
636}
637EXPORT_SYMBOL(strpbrk);
638#endif
639
640#ifndef __HAVE_ARCH_STRSEP
641
642
643
644
645
646
647
648
649
650
651
652char *strsep(char **s, const char *ct)
653{
654 char *sbegin = *s;
655 char *end;
656
657 if (sbegin == NULL)
658 return NULL;
659
660 end = strpbrk(sbegin, ct);
661 if (end)
662 *end++ = '\0';
663 *s = end;
664 return sbegin;
665}
666EXPORT_SYMBOL(strsep);
667#endif
668
669
670
671
672
673
674
675
676
677
678
679bool sysfs_streq(const char *s1, const char *s2)
680{
681 while (*s1 && *s1 == *s2) {
682 s1++;
683 s2++;
684 }
685
686 if (*s1 == *s2)
687 return true;
688 if (!*s1 && *s2 == '\n' && !s2[1])
689 return true;
690 if (*s1 == '\n' && !s1[1] && !*s2)
691 return true;
692 return false;
693}
694EXPORT_SYMBOL(sysfs_streq);
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713int match_string(const char * const *array, size_t n, const char *string)
714{
715 int index;
716 const char *item;
717
718 for (index = 0; index < n; index++) {
719 item = array[index];
720 if (!item)
721 break;
722 if (!strcmp(item, string))
723 return index;
724 }
725
726 return -EINVAL;
727}
728EXPORT_SYMBOL(match_string);
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747int __sysfs_match_string(const char * const *array, size_t n, const char *str)
748{
749 const char *item;
750 int index;
751
752 for (index = 0; index < n; index++) {
753 item = array[index];
754 if (!item)
755 break;
756 if (sysfs_streq(item, str))
757 return index;
758 }
759
760 return -EINVAL;
761}
762EXPORT_SYMBOL(__sysfs_match_string);
763
764#ifndef __HAVE_ARCH_MEMSET
765
766
767
768
769
770
771
772
773void *memset(void *s, int c, size_t count)
774{
775 char *xs = s;
776
777 while (count--)
778 *xs++ = c;
779 return s;
780}
781EXPORT_SYMBOL(memset);
782#endif
783
784#ifndef __HAVE_ARCH_MEMSET16
785
786
787
788
789
790
791
792
793
794
795void *memset16(uint16_t *s, uint16_t v, size_t count)
796{
797 uint16_t *xs = s;
798
799 while (count--)
800 *xs++ = v;
801 return s;
802}
803EXPORT_SYMBOL(memset16);
804#endif
805
806#ifndef __HAVE_ARCH_MEMSET32
807
808
809
810
811
812
813
814
815
816
817void *memset32(uint32_t *s, uint32_t v, size_t count)
818{
819 uint32_t *xs = s;
820
821 while (count--)
822 *xs++ = v;
823 return s;
824}
825EXPORT_SYMBOL(memset32);
826#endif
827
828#ifndef __HAVE_ARCH_MEMSET64
829
830
831
832
833
834
835
836
837
838
839void *memset64(uint64_t *s, uint64_t v, size_t count)
840{
841 uint64_t *xs = s;
842
843 while (count--)
844 *xs++ = v;
845 return s;
846}
847EXPORT_SYMBOL(memset64);
848#endif
849
850#ifndef __HAVE_ARCH_MEMCPY
851
852
853
854
855
856
857
858
859
860void *memcpy(void *dest, const void *src, size_t count)
861{
862 char *tmp = dest;
863 const char *s = src;
864
865 while (count--)
866 *tmp++ = *s++;
867 return dest;
868}
869EXPORT_SYMBOL(memcpy);
870#endif
871
872#ifndef __HAVE_ARCH_MEMMOVE
873
874
875
876
877
878
879
880
881void *memmove(void *dest, const void *src, size_t count)
882{
883 char *tmp;
884 const char *s;
885
886 if (dest <= src) {
887 tmp = dest;
888 s = src;
889 while (count--)
890 *tmp++ = *s++;
891 } else {
892 tmp = dest;
893 tmp += count;
894 s = src;
895 s += count;
896 while (count--)
897 *--tmp = *--s;
898 }
899 return dest;
900}
901EXPORT_SYMBOL(memmove);
902#endif
903
904#ifndef __HAVE_ARCH_MEMCMP
905
906
907
908
909
910
911#undef memcmp
912__visible int memcmp(const void *cs, const void *ct, size_t count)
913{
914 const unsigned char *su1, *su2;
915 int res = 0;
916
917 for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
918 if ((res = *su1 - *su2) != 0)
919 break;
920 return res;
921}
922EXPORT_SYMBOL(memcmp);
923#endif
924
925#ifndef __HAVE_ARCH_BCMP
926
927
928
929
930
931
932
933
934
935
936
937#undef bcmp
938int bcmp(const void *a, const void *b, size_t len)
939{
940 return memcmp(a, b, len);
941}
942EXPORT_SYMBOL(bcmp);
943#endif
944
945#ifndef __HAVE_ARCH_MEMSCAN
946
947
948
949
950
951
952
953
954
955void *memscan(void *addr, int c, size_t size)
956{
957 unsigned char *p = addr;
958
959 while (size) {
960 if (*p == c)
961 return (void *)p;
962 p++;
963 size--;
964 }
965 return (void *)p;
966}
967EXPORT_SYMBOL(memscan);
968#endif
969
970#ifndef __HAVE_ARCH_STRSTR
971
972
973
974
975
976char *strstr(const char *s1, const char *s2)
977{
978 size_t l1, l2;
979
980 l2 = strlen(s2);
981 if (!l2)
982 return (char *)s1;
983 l1 = strlen(s1);
984 while (l1 >= l2) {
985 l1--;
986 if (!memcmp(s1, s2, l2))
987 return (char *)s1;
988 s1++;
989 }
990 return NULL;
991}
992EXPORT_SYMBOL(strstr);
993#endif
994
995#ifndef __HAVE_ARCH_STRNSTR
996
997
998
999
1000
1001
1002char *strnstr(const char *s1, const char *s2, size_t len)
1003{
1004 size_t l2;
1005
1006 l2 = strlen(s2);
1007 if (!l2)
1008 return (char *)s1;
1009 while (len >= l2) {
1010 len--;
1011 if (!memcmp(s1, s2, l2))
1012 return (char *)s1;
1013 s1++;
1014 }
1015 return NULL;
1016}
1017EXPORT_SYMBOL(strnstr);
1018#endif
1019
1020#ifndef __HAVE_ARCH_MEMCHR
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030void *memchr(const void *s, int c, size_t n)
1031{
1032 const unsigned char *p = s;
1033 while (n-- != 0) {
1034 if ((unsigned char)c == *p++) {
1035 return (void *)(p - 1);
1036 }
1037 }
1038 return NULL;
1039}
1040EXPORT_SYMBOL(memchr);
1041#endif
1042
1043static void *check_bytes8(const u8 *start, u8 value, unsigned int bytes)
1044{
1045 while (bytes) {
1046 if (*start != value)
1047 return (void *)start;
1048 start++;
1049 bytes--;
1050 }
1051 return NULL;
1052}
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063void *memchr_inv(const void *start, int c, size_t bytes)
1064{
1065 u8 value = c;
1066 u64 value64;
1067 unsigned int words, prefix;
1068
1069 if (bytes <= 16)
1070 return check_bytes8(start, value, bytes);
1071
1072 value64 = value;
1073#if defined(CONFIG_ARCH_HAS_FAST_MULTIPLIER) && BITS_PER_LONG == 64
1074 value64 *= 0x0101010101010101ULL;
1075#elif defined(CONFIG_ARCH_HAS_FAST_MULTIPLIER)
1076 value64 *= 0x01010101;
1077 value64 |= value64 << 32;
1078#else
1079 value64 |= value64 << 8;
1080 value64 |= value64 << 16;
1081 value64 |= value64 << 32;
1082#endif
1083
1084 prefix = (unsigned long)start % 8;
1085 if (prefix) {
1086 u8 *r;
1087
1088 prefix = 8 - prefix;
1089 r = check_bytes8(start, value, prefix);
1090 if (r)
1091 return r;
1092 start += prefix;
1093 bytes -= prefix;
1094 }
1095
1096 words = bytes / 8;
1097
1098 while (words) {
1099 if (*(u64 *)start != value64)
1100 return check_bytes8(start, value, 8);
1101 start += 8;
1102 words--;
1103 }
1104
1105 return check_bytes8(start, value, bytes % 8);
1106}
1107EXPORT_SYMBOL(memchr_inv);
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117char *strreplace(char *s, char old, char new)
1118{
1119 for (; *s; ++s)
1120 if (*s == old)
1121 *s = new;
1122 return s;
1123}
1124EXPORT_SYMBOL(strreplace);
1125
1126void fortify_panic(const char *name)
1127{
1128 pr_emerg("detected buffer overflow in %s\n", name);
1129 BUG();
1130}
1131EXPORT_SYMBOL(fortify_panic);
1132