drivers: power: report battery voltage in AOSP compatible format
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / lib / string.c
1 /*
2 * linux/lib/string.c
3 *
4 * Copyright (C) 1991, 1992 Linus Torvalds
5 */
6
7 /*
8 * stupid library routines.. The optimized versions should generally be found
9 * as inline code in <asm-xx/string.h>
10 *
11 * These are buggy as well..
12 *
13 * * Fri Jun 25 1999, Ingo Oeser <ioe@informatik.tu-chemnitz.de>
14 * - Added strsep() which will replace strtok() soon (because strsep() is
15 * reentrant and should be faster). Use only strsep() in new code, please.
16 *
17 * * Sat Feb 09 2002, Jason Thomas <jason@topic.com.au>,
18 * Matthew Hawkins <matt@mh.dropbear.id.au>
19 * - Kissed strtok() goodbye
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 #ifndef __HAVE_ARCH_STRNICMP
31 /**
32 * strnicmp - Case insensitive, length-limited string comparison
33 * @s1: One string
34 * @s2: The other string
35 * @len: the maximum number of characters to compare
36 */
37 int strnicmp(const char *s1, const char *s2, size_t len)
38 {
39 /* Yes, Virginia, it had better be unsigned */
40 unsigned char c1, c2;
41
42 if (!len)
43 return 0;
44
45 do {
46 c1 = *s1++;
47 c2 = *s2++;
48 if (!c1 || !c2)
49 break;
50 if (c1 == c2)
51 continue;
52 c1 = tolower(c1);
53 c2 = tolower(c2);
54 if (c1 != c2)
55 break;
56 } while (--len);
57 return (int)c1 - (int)c2;
58 }
59 EXPORT_SYMBOL(strnicmp);
60 #endif
61
62 #ifndef __HAVE_ARCH_STRCASECMP
63 int strcasecmp(const char *s1, const char *s2)
64 {
65 int c1, c2;
66
67 do {
68 c1 = tolower(*s1++);
69 c2 = tolower(*s2++);
70 } while (c1 == c2 && c1 != 0);
71 return c1 - c2;
72 }
73 EXPORT_SYMBOL(strcasecmp);
74 #endif
75
76 #ifndef __HAVE_ARCH_STRNCASECMP
77 int strncasecmp(const char *s1, const char *s2, size_t n)
78 {
79 int c1, c2;
80
81 do {
82 c1 = tolower(*s1++);
83 c2 = tolower(*s2++);
84 } while ((--n > 0) && c1 == c2 && c1 != 0);
85 return c1 - c2;
86 }
87 EXPORT_SYMBOL(strncasecmp);
88 #endif
89
90 #ifndef __HAVE_ARCH_STRCPY
91 /**
92 * strcpy - Copy a %NUL terminated string
93 * @dest: Where to copy the string to
94 * @src: Where to copy the string from
95 */
96 #undef strcpy
97 char *strcpy(char *dest, const char *src)
98 {
99 char *tmp = dest;
100
101 while ((*dest++ = *src++) != '\0')
102 /* nothing */;
103 return tmp;
104 }
105 EXPORT_SYMBOL(strcpy);
106 #endif
107
108 #ifndef __HAVE_ARCH_STRNCPY
109 /**
110 * strncpy - Copy a length-limited, %NUL-terminated string
111 * @dest: Where to copy the string to
112 * @src: Where to copy the string from
113 * @count: The maximum number of bytes to copy
114 *
115 * The result is not %NUL-terminated if the source exceeds
116 * @count bytes.
117 *
118 * In the case where the length of @src is less than that of
119 * count, the remainder of @dest will be padded with %NUL.
120 *
121 */
122 char *strncpy(char *dest, const char *src, size_t count)
123 {
124 char *tmp = dest;
125
126 while (count) {
127 if ((*tmp = *src) != 0)
128 src++;
129 tmp++;
130 count--;
131 }
132 return dest;
133 }
134 EXPORT_SYMBOL(strncpy);
135 #endif
136
137 #ifndef __HAVE_ARCH_STRLCPY
138 /**
139 * strlcpy - Copy a %NUL terminated string into a sized buffer
140 * @dest: Where to copy the string to
141 * @src: Where to copy the string from
142 * @size: size of destination buffer
143 *
144 * Compatible with *BSD: the result is always a valid
145 * NUL-terminated string that fits in the buffer (unless,
146 * of course, the buffer size is zero). It does not pad
147 * out the result like strncpy() does.
148 */
149 size_t strlcpy(char *dest, const char *src, size_t size)
150 {
151 size_t ret = strlen(src);
152
153 if (size) {
154 size_t len = (ret >= size) ? size - 1 : ret;
155 memcpy(dest, src, len);
156 dest[len] = '\0';
157 }
158 return ret;
159 }
160 EXPORT_SYMBOL(strlcpy);
161 #endif
162
163 #ifndef __HAVE_ARCH_STRCAT
164 /**
165 * strcat - Append one %NUL-terminated string to another
166 * @dest: The string to be appended to
167 * @src: The string to append to it
168 */
169 #undef strcat
170 char *strcat(char *dest, const char *src)
171 {
172 char *tmp = dest;
173
174 while (*dest)
175 dest++;
176 while ((*dest++ = *src++) != '\0')
177 ;
178 return tmp;
179 }
180 EXPORT_SYMBOL(strcat);
181 #endif
182
183 #ifndef __HAVE_ARCH_STRNCAT
184 /**
185 * strncat - Append a length-limited, %NUL-terminated string to another
186 * @dest: The string to be appended to
187 * @src: The string to append to it
188 * @count: The maximum numbers of bytes to copy
189 *
190 * Note that in contrast to strncpy(), strncat() ensures the result is
191 * terminated.
192 */
193 char *strncat(char *dest, const char *src, size_t count)
194 {
195 char *tmp = dest;
196
197 if (count) {
198 while (*dest)
199 dest++;
200 while ((*dest++ = *src++) != 0) {
201 if (--count == 0) {
202 *dest = '\0';
203 break;
204 }
205 }
206 }
207 return tmp;
208 }
209 EXPORT_SYMBOL(strncat);
210 #endif
211
212 #ifndef __HAVE_ARCH_STRLCAT
213 /**
214 * strlcat - Append a length-limited, %NUL-terminated string to another
215 * @dest: The string to be appended to
216 * @src: The string to append to it
217 * @count: The size of the destination buffer.
218 */
219 size_t strlcat(char *dest, const char *src, size_t count)
220 {
221 size_t dsize = strlen(dest);
222 size_t len = strlen(src);
223 size_t res = dsize + len;
224
225 /* This would be a bug */
226 BUG_ON(dsize >= count);
227
228 dest += dsize;
229 count -= dsize;
230 if (len >= count)
231 len = count-1;
232 memcpy(dest, src, len);
233 dest[len] = 0;
234 return res;
235 }
236 EXPORT_SYMBOL(strlcat);
237 #endif
238
239 #ifndef __HAVE_ARCH_STRCMP
240 /**
241 * strcmp - Compare two strings
242 * @cs: One string
243 * @ct: Another string
244 */
245 #undef strcmp
246 int strcmp(const char *cs, const char *ct)
247 {
248 unsigned char c1, c2;
249
250 while (1) {
251 c1 = *cs++;
252 c2 = *ct++;
253 if (c1 != c2)
254 return c1 < c2 ? -1 : 1;
255 if (!c1)
256 break;
257 }
258 return 0;
259 }
260 EXPORT_SYMBOL(strcmp);
261 #endif
262
263 #ifndef __HAVE_ARCH_STRNCMP
264 /**
265 * strncmp - Compare two length-limited strings
266 * @cs: One string
267 * @ct: Another string
268 * @count: The maximum number of bytes to compare
269 */
270 int strncmp(const char *cs, const char *ct, size_t count)
271 {
272 unsigned char c1, c2;
273
274 while (count) {
275 c1 = *cs++;
276 c2 = *ct++;
277 if (c1 != c2)
278 return c1 < c2 ? -1 : 1;
279 if (!c1)
280 break;
281 count--;
282 }
283 return 0;
284 }
285 EXPORT_SYMBOL(strncmp);
286 #endif
287
288 #ifndef __HAVE_ARCH_STRCHR
289 /**
290 * strchr - Find the first occurrence of a character in a string
291 * @s: The string to be searched
292 * @c: The character to search for
293 */
294 char *strchr(const char *s, int c)
295 {
296 for (; *s != (char)c; ++s)
297 if (*s == '\0')
298 return NULL;
299 return (char *)s;
300 }
301 EXPORT_SYMBOL(strchr);
302 #endif
303
304 #ifndef __HAVE_ARCH_STRRCHR
305 /**
306 * strrchr - Find the last occurrence of a character in a string
307 * @s: The string to be searched
308 * @c: The character to search for
309 */
310 char *strrchr(const char *s, int c)
311 {
312 const char *p = s + strlen(s);
313 do {
314 if (*p == (char)c)
315 return (char *)p;
316 } while (--p >= s);
317 return NULL;
318 }
319 EXPORT_SYMBOL(strrchr);
320 #endif
321
322 #ifndef __HAVE_ARCH_STRNCHR
323 /**
324 * strnchr - Find a character in a length limited string
325 * @s: The string to be searched
326 * @count: The number of characters to be searched
327 * @c: The character to search for
328 */
329 char *strnchr(const char *s, size_t count, int c)
330 {
331 for (; count-- && *s != '\0'; ++s)
332 if (*s == (char)c)
333 return (char *)s;
334 return NULL;
335 }
336 EXPORT_SYMBOL(strnchr);
337 #endif
338
339 /**
340 * skip_spaces - Removes leading whitespace from @str.
341 * @str: The string to be stripped.
342 *
343 * Returns a pointer to the first non-whitespace character in @str.
344 */
345 char *skip_spaces(const char *str)
346 {
347 while (isspace(*str))
348 ++str;
349 return (char *)str;
350 }
351 EXPORT_SYMBOL(skip_spaces);
352
353 /**
354 * strim - Removes leading and trailing whitespace from @s.
355 * @s: The string to be stripped.
356 *
357 * Note that the first trailing whitespace is replaced with a %NUL-terminator
358 * in the given string @s. Returns a pointer to the first non-whitespace
359 * character in @s.
360 */
361 char *strim(char *s)
362 {
363 size_t size;
364 char *end;
365
366 size = strlen(s);
367 if (!size)
368 return s;
369
370 end = s + size - 1;
371 while (end >= s && isspace(*end))
372 end--;
373 *(end + 1) = '\0';
374
375 return skip_spaces(s);
376 }
377 EXPORT_SYMBOL(strim);
378
379 #ifndef __HAVE_ARCH_STRLEN
380 /**
381 * strlen - Find the length of a string
382 * @s: The string to be sized
383 */
384 size_t strlen(const char *s)
385 {
386 const char *sc;
387
388 for (sc = s; *sc != '\0'; ++sc)
389 /* nothing */;
390 return sc - s;
391 }
392 EXPORT_SYMBOL(strlen);
393 #endif
394
395 #ifndef __HAVE_ARCH_STRNLEN
396 /**
397 * strnlen - Find the length of a length-limited string
398 * @s: The string to be sized
399 * @count: The maximum number of bytes to search
400 */
401 size_t strnlen(const char *s, size_t count)
402 {
403 const char *sc;
404
405 for (sc = s; count-- && *sc != '\0'; ++sc)
406 /* nothing */;
407 return sc - s;
408 }
409 EXPORT_SYMBOL(strnlen);
410 #endif
411
412 #ifndef __HAVE_ARCH_STRSPN
413 /**
414 * strspn - Calculate the length of the initial substring of @s which only contain letters in @accept
415 * @s: The string to be searched
416 * @accept: The string to search for
417 */
418 size_t strspn(const char *s, const char *accept)
419 {
420 const char *p;
421 const char *a;
422 size_t count = 0;
423
424 for (p = s; *p != '\0'; ++p) {
425 for (a = accept; *a != '\0'; ++a) {
426 if (*p == *a)
427 break;
428 }
429 if (*a == '\0')
430 return count;
431 ++count;
432 }
433 return count;
434 }
435
436 EXPORT_SYMBOL(strspn);
437 #endif
438
439 #ifndef __HAVE_ARCH_STRCSPN
440 /**
441 * strcspn - Calculate the length of the initial substring of @s which does not contain letters in @reject
442 * @s: The string to be searched
443 * @reject: The string to avoid
444 */
445 size_t strcspn(const char *s, const char *reject)
446 {
447 const char *p;
448 const char *r;
449 size_t count = 0;
450
451 for (p = s; *p != '\0'; ++p) {
452 for (r = reject; *r != '\0'; ++r) {
453 if (*p == *r)
454 return count;
455 }
456 ++count;
457 }
458 return count;
459 }
460 EXPORT_SYMBOL(strcspn);
461 #endif
462
463 #ifndef __HAVE_ARCH_STRPBRK
464 /**
465 * strpbrk - Find the first occurrence of a set of characters
466 * @cs: The string to be searched
467 * @ct: The characters to search for
468 */
469 char *strpbrk(const char *cs, const char *ct)
470 {
471 const char *sc1, *sc2;
472
473 for (sc1 = cs; *sc1 != '\0'; ++sc1) {
474 for (sc2 = ct; *sc2 != '\0'; ++sc2) {
475 if (*sc1 == *sc2)
476 return (char *)sc1;
477 }
478 }
479 return NULL;
480 }
481 EXPORT_SYMBOL(strpbrk);
482 #endif
483
484 #ifndef __HAVE_ARCH_STRSEP
485 /**
486 * strsep - Split a string into tokens
487 * @s: The string to be searched
488 * @ct: The characters to search for
489 *
490 * strsep() updates @s to point after the token, ready for the next call.
491 *
492 * It returns empty tokens, too, behaving exactly like the libc function
493 * of that name. In fact, it was stolen from glibc2 and de-fancy-fied.
494 * Same semantics, slimmer shape. ;)
495 */
496 char *strsep(char **s, const char *ct)
497 {
498 char *sbegin = *s;
499 char *end;
500
501 if (sbegin == NULL)
502 return NULL;
503
504 end = strpbrk(sbegin, ct);
505 if (end)
506 *end++ = '\0';
507 *s = end;
508 return sbegin;
509 }
510 EXPORT_SYMBOL(strsep);
511 #endif
512
513 /**
514 * sysfs_streq - return true if strings are equal, modulo trailing newline
515 * @s1: one string
516 * @s2: another string
517 *
518 * This routine returns true iff two strings are equal, treating both
519 * NUL and newline-then-NUL as equivalent string terminations. It's
520 * geared for use with sysfs input strings, which generally terminate
521 * with newlines but are compared against values without newlines.
522 */
523 bool sysfs_streq(const char *s1, const char *s2)
524 {
525 while (*s1 && *s1 == *s2) {
526 s1++;
527 s2++;
528 }
529
530 if (*s1 == *s2)
531 return true;
532 if (!*s1 && *s2 == '\n' && !s2[1])
533 return true;
534 if (*s1 == '\n' && !s1[1] && !*s2)
535 return true;
536 return false;
537 }
538 EXPORT_SYMBOL(sysfs_streq);
539
540 /**
541 * strtobool - convert common user inputs into boolean values
542 * @s: input string
543 * @res: result
544 *
545 * This routine returns 0 iff the first character is one of 'Yy1Nn0'.
546 * Otherwise it will return -EINVAL. Value pointed to by res is
547 * updated upon finding a match.
548 */
549 int strtobool(const char *s, bool *res)
550 {
551 switch (s[0]) {
552 case 'y':
553 case 'Y':
554 case '1':
555 *res = true;
556 break;
557 case 'n':
558 case 'N':
559 case '0':
560 *res = false;
561 break;
562 default:
563 return -EINVAL;
564 }
565 return 0;
566 }
567 EXPORT_SYMBOL(strtobool);
568
569 #ifndef __HAVE_ARCH_MEMSET
570 /**
571 * memset - Fill a region of memory with the given value
572 * @s: Pointer to the start of the area.
573 * @c: The byte to fill the area with
574 * @count: The size of the area.
575 *
576 * Do not use memset() to access IO space, use memset_io() instead.
577 */
578 void *memset(void *s, int c, size_t count)
579 {
580 char *xs = s;
581
582 while (count--)
583 *xs++ = c;
584 return s;
585 }
586 EXPORT_SYMBOL(memset);
587 #endif
588
589 /**
590 * memzero_explicit - Fill a region of memory (e.g. sensitive
591 * keying data) with 0s.
592 * @s: Pointer to the start of the area.
593 * @count: The size of the area.
594 *
595 * memzero_explicit() doesn't need an arch-specific version as
596 * it just invokes the one of memset() implicitly.
597 */
598 void memzero_explicit(void *s, size_t count)
599 {
600 memset(s, 0, count);
601 barrier();
602 }
603 EXPORT_SYMBOL(memzero_explicit);
604
605 #ifndef __HAVE_ARCH_MEMCPY
606 /**
607 * memcpy - Copy one area of memory to another
608 * @dest: Where to copy to
609 * @src: Where to copy from
610 * @count: The size of the area.
611 *
612 * You should not use this function to access IO space, use memcpy_toio()
613 * or memcpy_fromio() instead.
614 */
615 void *memcpy(void *dest, const void *src, size_t count)
616 {
617 char *tmp = dest;
618 const char *s = src;
619
620 while (count--)
621 *tmp++ = *s++;
622 return dest;
623 }
624 EXPORT_SYMBOL(memcpy);
625 #endif
626
627 #ifndef __HAVE_ARCH_MEMMOVE
628 /**
629 * memmove - Copy one area of memory to another
630 * @dest: Where to copy to
631 * @src: Where to copy from
632 * @count: The size of the area.
633 *
634 * Unlike memcpy(), memmove() copes with overlapping areas.
635 */
636 void *memmove(void *dest, const void *src, size_t count)
637 {
638 char *tmp;
639 const char *s;
640
641 if (dest <= src) {
642 tmp = dest;
643 s = src;
644 while (count--)
645 *tmp++ = *s++;
646 } else {
647 tmp = dest;
648 tmp += count;
649 s = src;
650 s += count;
651 while (count--)
652 *--tmp = *--s;
653 }
654 return dest;
655 }
656 EXPORT_SYMBOL(memmove);
657 #endif
658
659 #ifndef __HAVE_ARCH_MEMCMP
660 /**
661 * memcmp - Compare two areas of memory
662 * @cs: One area of memory
663 * @ct: Another area of memory
664 * @count: The size of the area.
665 */
666 #undef memcmp
667 int memcmp(const void *cs, const void *ct, size_t count)
668 {
669 const unsigned char *su1, *su2;
670 int res = 0;
671
672 for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
673 if ((res = *su1 - *su2) != 0)
674 break;
675 return res;
676 }
677 EXPORT_SYMBOL(memcmp);
678 #endif
679
680 #ifndef __HAVE_ARCH_MEMSCAN
681 /**
682 * memscan - Find a character in an area of memory.
683 * @addr: The memory area
684 * @c: The byte to search for
685 * @size: The size of the area.
686 *
687 * returns the address of the first occurrence of @c, or 1 byte past
688 * the area if @c is not found
689 */
690 void *memscan(void *addr, int c, size_t size)
691 {
692 unsigned char *p = addr;
693
694 while (size) {
695 if (*p == c)
696 return (void *)p;
697 p++;
698 size--;
699 }
700 return (void *)p;
701 }
702 EXPORT_SYMBOL(memscan);
703 #endif
704
705 #ifndef __HAVE_ARCH_STRSTR
706 /**
707 * strstr - Find the first substring in a %NUL terminated string
708 * @s1: The string to be searched
709 * @s2: The string to search for
710 */
711 char *strstr(const char *s1, const char *s2)
712 {
713 size_t l1, l2;
714
715 l2 = strlen(s2);
716 if (!l2)
717 return (char *)s1;
718 l1 = strlen(s1);
719 while (l1 >= l2) {
720 l1--;
721 if (!memcmp(s1, s2, l2))
722 return (char *)s1;
723 s1++;
724 }
725 return NULL;
726 }
727 EXPORT_SYMBOL(strstr);
728 #endif
729
730 #ifndef __HAVE_ARCH_STRNSTR
731 /**
732 * strnstr - Find the first substring in a length-limited string
733 * @s1: The string to be searched
734 * @s2: The string to search for
735 * @len: the maximum number of characters to search
736 */
737 char *strnstr(const char *s1, const char *s2, size_t len)
738 {
739 size_t l2;
740
741 l2 = strlen(s2);
742 if (!l2)
743 return (char *)s1;
744 while (len >= l2) {
745 len--;
746 if (!memcmp(s1, s2, l2))
747 return (char *)s1;
748 s1++;
749 }
750 return NULL;
751 }
752 EXPORT_SYMBOL(strnstr);
753 #endif
754
755 #ifndef __HAVE_ARCH_MEMCHR
756 /**
757 * memchr - Find a character in an area of memory.
758 * @s: The memory area
759 * @c: The byte to search for
760 * @n: The size of the area.
761 *
762 * returns the address of the first occurrence of @c, or %NULL
763 * if @c is not found
764 */
765 void *memchr(const void *s, int c, size_t n)
766 {
767 const unsigned char *p = s;
768 while (n-- != 0) {
769 if ((unsigned char)c == *p++) {
770 return (void *)(p - 1);
771 }
772 }
773 return NULL;
774 }
775 EXPORT_SYMBOL(memchr);
776 #endif
777
778 static void *check_bytes8(const u8 *start, u8 value, unsigned int bytes)
779 {
780 while (bytes) {
781 if (*start != value)
782 return (void *)start;
783 start++;
784 bytes--;
785 }
786 return NULL;
787 }
788
789 /**
790 * memchr_inv - Find an unmatching character in an area of memory.
791 * @start: The memory area
792 * @c: Find a character other than c
793 * @bytes: The size of the area.
794 *
795 * returns the address of the first character other than @c, or %NULL
796 * if the whole buffer contains just @c.
797 */
798 void *memchr_inv(const void *start, int c, size_t bytes)
799 {
800 u8 value = c;
801 u64 value64;
802 unsigned int words, prefix;
803
804 if (bytes <= 16)
805 return check_bytes8(start, value, bytes);
806
807 value64 = value;
808 #if defined(ARCH_HAS_FAST_MULTIPLIER) && BITS_PER_LONG == 64
809 value64 *= 0x0101010101010101;
810 #elif defined(ARCH_HAS_FAST_MULTIPLIER)
811 value64 *= 0x01010101;
812 value64 |= value64 << 32;
813 #else
814 value64 |= value64 << 8;
815 value64 |= value64 << 16;
816 value64 |= value64 << 32;
817 #endif
818
819 prefix = (unsigned long)start % 8;
820 if (prefix) {
821 u8 *r;
822
823 prefix = 8 - prefix;
824 r = check_bytes8(start, value, prefix);
825 if (r)
826 return r;
827 start += prefix;
828 bytes -= prefix;
829 }
830
831 words = bytes / 8;
832
833 while (words) {
834 if (*(u64 *)start != value64)
835 return check_bytes8(start, value, 8);
836 start += 8;
837 words--;
838 }
839
840 return check_bytes8(start, value, bytes % 8);
841 }
842 EXPORT_SYMBOL(memchr_inv);