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