1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <stdarg.h>
20#include <linux/module.h>
21#include <linux/types.h>
22#include <linux/string.h>
23#include <linux/ctype.h>
24#include <linux/kernel.h>
25
26#include <asm/page.h>
27#include <asm/div64.h>
28
29
30
31
32
33
34
35unsigned long simple_strtoul(const char *cp,char **endp,unsigned int base)
36{
37 unsigned long result = 0,value;
38
39 if (!base) {
40 base = 10;
41 if (*cp == '0') {
42 base = 8;
43 cp++;
44 if ((toupper(*cp) == 'X') && isxdigit(cp[1])) {
45 cp++;
46 base = 16;
47 }
48 }
49 } else if (base == 16) {
50 if (cp[0] == '0' && toupper(cp[1]) == 'X')
51 cp += 2;
52 }
53 while (isxdigit(*cp) &&
54 (value = isdigit(*cp) ? *cp-'0' : toupper(*cp)-'A'+10) < base) {
55 result = result*base + value;
56 cp++;
57 }
58 if (endp)
59 *endp = (char *)cp;
60 return result;
61}
62
63EXPORT_SYMBOL(simple_strtoul);
64
65
66
67
68
69
70
71long simple_strtol(const char *cp,char **endp,unsigned int base)
72{
73 if(*cp=='-')
74 return -simple_strtoul(cp+1,endp,base);
75 return simple_strtoul(cp,endp,base);
76}
77
78EXPORT_SYMBOL(simple_strtol);
79
80
81
82
83
84
85
86unsigned long long simple_strtoull(const char *cp,char **endp,unsigned int base)
87{
88 unsigned long long result = 0,value;
89
90 if (!base) {
91 base = 10;
92 if (*cp == '0') {
93 base = 8;
94 cp++;
95 if ((toupper(*cp) == 'X') && isxdigit(cp[1])) {
96 cp++;
97 base = 16;
98 }
99 }
100 } else if (base == 16) {
101 if (cp[0] == '0' && toupper(cp[1]) == 'X')
102 cp += 2;
103 }
104 while (isxdigit(*cp) && (value = isdigit(*cp) ? *cp-'0' : (islower(*cp)
105 ? toupper(*cp) : *cp)-'A'+10) < base) {
106 result = result*base + value;
107 cp++;
108 }
109 if (endp)
110 *endp = (char *)cp;
111 return result;
112}
113
114EXPORT_SYMBOL(simple_strtoull);
115
116
117
118
119
120
121
122long long simple_strtoll(const char *cp,char **endp,unsigned int base)
123{
124 if(*cp=='-')
125 return -simple_strtoull(cp+1,endp,base);
126 return simple_strtoull(cp,endp,base);
127}
128
129static int skip_atoi(const char **s)
130{
131 int i=0;
132
133 while (isdigit(**s))
134 i = i*10 + *((*s)++) - '0';
135 return i;
136}
137
138
139
140
141
142
143
144
145
146
147
148static char* put_dec_trunc(char *buf, unsigned q)
149{
150 unsigned d3, d2, d1, d0;
151 d1 = (q>>4) & 0xf;
152 d2 = (q>>8) & 0xf;
153 d3 = (q>>12);
154
155 d0 = 6*(d3 + d2 + d1) + (q & 0xf);
156 q = (d0 * 0xcd) >> 11;
157 d0 = d0 - 10*q;
158 *buf++ = d0 + '0';
159 d1 = q + 9*d3 + 5*d2 + d1;
160 if (d1 != 0) {
161 q = (d1 * 0xcd) >> 11;
162 d1 = d1 - 10*q;
163 *buf++ = d1 + '0';
164
165 d2 = q + 2*d2;
166 if ((d2 != 0) || (d3 != 0)) {
167 q = (d2 * 0xd) >> 7;
168 d2 = d2 - 10*q;
169 *buf++ = d2 + '0';
170
171 d3 = q + 4*d3;
172 if (d3 != 0) {
173 q = (d3 * 0xcd) >> 11;
174 d3 = d3 - 10*q;
175 *buf++ = d3 + '0';
176 if (q != 0)
177 *buf++ = q + '0';
178 }
179 }
180 }
181 return buf;
182}
183
184static char* put_dec_full(char *buf, unsigned q)
185{
186
187
188 unsigned d3, d2, d1, d0;
189 d1 = (q>>4) & 0xf;
190 d2 = (q>>8) & 0xf;
191 d3 = (q>>12);
192
193
194
195
196
197
198
199
200
201 d0 = 6*(d3 + d2 + d1) + (q & 0xf);
202 q = (d0 * 0xcd) >> 11;
203 d0 = d0 - 10*q;
204 *buf++ = d0 + '0';
205 d1 = q + 9*d3 + 5*d2 + d1;
206 q = (d1 * 0xcd) >> 11;
207 d1 = d1 - 10*q;
208 *buf++ = d1 + '0';
209
210 d2 = q + 2*d2;
211 q = (d2 * 0xd) >> 7;
212 d2 = d2 - 10*q;
213 *buf++ = d2 + '0';
214
215 d3 = q + 4*d3;
216 q = (d3 * 0xcd) >> 11;
217
218 d3 = d3 - 10*q;
219 *buf++ = d3 + '0';
220 *buf++ = q + '0';
221 return buf;
222}
223
224static noinline char* put_dec(char *buf, unsigned long long num)
225{
226 while (1) {
227 unsigned rem;
228 if (num < 100000)
229 return put_dec_trunc(buf, num);
230 rem = do_div(num, 100000);
231 buf = put_dec_full(buf, rem);
232 }
233}
234
235#define ZEROPAD 1
236#define SIGN 2
237#define PLUS 4
238#define SPACE 8
239#define LEFT 16
240#define SPECIAL 32
241#define LARGE 64
242
243static char *number(char *buf, char *end, unsigned long long num, int base, int size, int precision, int type)
244{
245 char sign,tmp[66];
246 const char *digits;
247
248 static const char small_digits[] = "0123456789abcdefx";
249 static const char large_digits[] = "0123456789ABCDEFX";
250 int need_pfx = ((type & SPECIAL) && base != 10);
251 int i;
252
253 digits = (type & LARGE) ? large_digits : small_digits;
254 if (type & LEFT)
255 type &= ~ZEROPAD;
256 if (base < 2 || base > 36)
257 return NULL;
258 sign = 0;
259 if (type & SIGN) {
260 if ((signed long long) num < 0) {
261 sign = '-';
262 num = - (signed long long) num;
263 size--;
264 } else if (type & PLUS) {
265 sign = '+';
266 size--;
267 } else if (type & SPACE) {
268 sign = ' ';
269 size--;
270 }
271 }
272 if (need_pfx) {
273 size--;
274 if (base == 16)
275 size--;
276 }
277
278
279 i = 0;
280 if (num == 0)
281 tmp[i++] = '0';
282
283
284
285
286
287 else if (base != 10) {
288 int mask = base - 1;
289 int shift = 3;
290 if (base == 16) shift = 4;
291 do {
292 tmp[i++] = digits[((unsigned char)num) & mask];
293 num >>= shift;
294 } while (num);
295 } else {
296 i = put_dec(tmp, num) - tmp;
297 }
298
299
300 if (i > precision)
301 precision = i;
302
303 size -= precision;
304 if (!(type & (ZEROPAD+LEFT))) {
305 while(--size >= 0) {
306 if (buf < end)
307 *buf = ' ';
308 ++buf;
309 }
310 }
311
312 if (sign) {
313 if (buf < end)
314 *buf = sign;
315 ++buf;
316 }
317
318 if (need_pfx) {
319 if (buf < end)
320 *buf = '0';
321 ++buf;
322 if (base == 16) {
323 if (buf < end)
324 *buf = digits[16];
325 ++buf;
326 }
327 }
328
329 if (!(type & LEFT)) {
330 char c = (type & ZEROPAD) ? '0' : ' ';
331 while (--size >= 0) {
332 if (buf < end)
333 *buf = c;
334 ++buf;
335 }
336 }
337
338 while (i <= --precision) {
339 if (buf < end)
340 *buf = '0';
341 ++buf;
342 }
343
344 while (--i >= 0) {
345 if (buf < end)
346 *buf = tmp[i];
347 ++buf;
348 }
349
350 while (--size >= 0) {
351 if (buf < end)
352 *buf = ' ';
353 ++buf;
354 }
355 return buf;
356}
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376int vsnprintf(char *buf, size_t size, const char *fmt, va_list args)
377{
378 int len;
379 unsigned long long num;
380 int i, base;
381 char *str, *end, c;
382 const char *s;
383
384 int flags;
385
386 int field_width;
387 int precision;
388
389 int qualifier;
390
391
392
393
394
395
396 if (unlikely((int) size < 0)) {
397
398 static char warn = 1;
399 WARN_ON(warn);
400 warn = 0;
401 return 0;
402 }
403
404 str = buf;
405 end = buf + size;
406
407
408 if (end < buf) {
409 end = ((void *)-1);
410 size = end - buf;
411 }
412
413 for (; *fmt ; ++fmt) {
414 if (*fmt != '%') {
415 if (str < end)
416 *str = *fmt;
417 ++str;
418 continue;
419 }
420
421
422 flags = 0;
423 repeat:
424 ++fmt;
425 switch (*fmt) {
426 case '-': flags |= LEFT; goto repeat;
427 case '+': flags |= PLUS; goto repeat;
428 case ' ': flags |= SPACE; goto repeat;
429 case '#': flags |= SPECIAL; goto repeat;
430 case '0': flags |= ZEROPAD; goto repeat;
431 }
432
433
434 field_width = -1;
435 if (isdigit(*fmt))
436 field_width = skip_atoi(&fmt);
437 else if (*fmt == '*') {
438 ++fmt;
439
440 field_width = va_arg(args, int);
441 if (field_width < 0) {
442 field_width = -field_width;
443 flags |= LEFT;
444 }
445 }
446
447
448 precision = -1;
449 if (*fmt == '.') {
450 ++fmt;
451 if (isdigit(*fmt))
452 precision = skip_atoi(&fmt);
453 else if (*fmt == '*') {
454 ++fmt;
455
456 precision = va_arg(args, int);
457 }
458 if (precision < 0)
459 precision = 0;
460 }
461
462
463 qualifier = -1;
464 if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L' ||
465 *fmt =='Z' || *fmt == 'z' || *fmt == 't') {
466 qualifier = *fmt;
467 ++fmt;
468 if (qualifier == 'l' && *fmt == 'l') {
469 qualifier = 'L';
470 ++fmt;
471 }
472 }
473
474
475 base = 10;
476
477 switch (*fmt) {
478 case 'c':
479 if (!(flags & LEFT)) {
480 while (--field_width > 0) {
481 if (str < end)
482 *str = ' ';
483 ++str;
484 }
485 }
486 c = (unsigned char) va_arg(args, int);
487 if (str < end)
488 *str = c;
489 ++str;
490 while (--field_width > 0) {
491 if (str < end)
492 *str = ' ';
493 ++str;
494 }
495 continue;
496
497 case 's':
498 s = va_arg(args, char *);
499 if ((unsigned long)s < PAGE_SIZE)
500 s = "<NULL>";
501
502 len = strnlen(s, precision);
503
504 if (!(flags & LEFT)) {
505 while (len < field_width--) {
506 if (str < end)
507 *str = ' ';
508 ++str;
509 }
510 }
511 for (i = 0; i < len; ++i) {
512 if (str < end)
513 *str = *s;
514 ++str; ++s;
515 }
516 while (len < field_width--) {
517 if (str < end)
518 *str = ' ';
519 ++str;
520 }
521 continue;
522
523 case 'p':
524 if (field_width == -1) {
525 field_width = 2*sizeof(void *);
526 flags |= ZEROPAD;
527 }
528 str = number(str, end,
529 (unsigned long) va_arg(args, void *),
530 16, field_width, precision, flags);
531 continue;
532
533
534 case 'n':
535
536
537 if (qualifier == 'l') {
538 long * ip = va_arg(args, long *);
539 *ip = (str - buf);
540 } else if (qualifier == 'Z' || qualifier == 'z') {
541 size_t * ip = va_arg(args, size_t *);
542 *ip = (str - buf);
543 } else {
544 int * ip = va_arg(args, int *);
545 *ip = (str - buf);
546 }
547 continue;
548
549 case '%':
550 if (str < end)
551 *str = '%';
552 ++str;
553 continue;
554
555
556 case 'o':
557 base = 8;
558 break;
559
560 case 'X':
561 flags |= LARGE;
562 case 'x':
563 base = 16;
564 break;
565
566 case 'd':
567 case 'i':
568 flags |= SIGN;
569 case 'u':
570 break;
571
572 default:
573 if (str < end)
574 *str = '%';
575 ++str;
576 if (*fmt) {
577 if (str < end)
578 *str = *fmt;
579 ++str;
580 } else {
581 --fmt;
582 }
583 continue;
584 }
585 if (qualifier == 'L')
586 num = va_arg(args, long long);
587 else if (qualifier == 'l') {
588 num = va_arg(args, unsigned long);
589 if (flags & SIGN)
590 num = (signed long) num;
591 } else if (qualifier == 'Z' || qualifier == 'z') {
592 num = va_arg(args, size_t);
593 } else if (qualifier == 't') {
594 num = va_arg(args, ptrdiff_t);
595 } else if (qualifier == 'h') {
596 num = (unsigned short) va_arg(args, int);
597 if (flags & SIGN)
598 num = (signed short) num;
599 } else {
600 num = va_arg(args, unsigned int);
601 if (flags & SIGN)
602 num = (signed int) num;
603 }
604 str = number(str, end, num, base,
605 field_width, precision, flags);
606 }
607 if (size > 0) {
608 if (str < end)
609 *str = '\0';
610 else
611 end[-1] = '\0';
612 }
613
614 return str-buf;
615}
616
617EXPORT_SYMBOL(vsnprintf);
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633int vscnprintf(char *buf, size_t size, const char *fmt, va_list args)
634{
635 int i;
636
637 i=vsnprintf(buf,size,fmt,args);
638 return (i >= size) ? (size - 1) : i;
639}
640
641EXPORT_SYMBOL(vscnprintf);
642
643
644
645
646
647
648
649
650
651
652
653
654
655int snprintf(char * buf, size_t size, const char *fmt, ...)
656{
657 va_list args;
658 int i;
659
660 va_start(args, fmt);
661 i=vsnprintf(buf,size,fmt,args);
662 va_end(args);
663 return i;
664}
665
666EXPORT_SYMBOL(snprintf);
667
668
669
670
671
672
673
674
675
676
677
678
679int scnprintf(char * buf, size_t size, const char *fmt, ...)
680{
681 va_list args;
682 int i;
683
684 va_start(args, fmt);
685 i = vsnprintf(buf, size, fmt, args);
686 va_end(args);
687 return (i >= size) ? (size - 1) : i;
688}
689EXPORT_SYMBOL(scnprintf);
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704int vsprintf(char *buf, const char *fmt, va_list args)
705{
706 return vsnprintf(buf, INT_MAX, fmt, args);
707}
708
709EXPORT_SYMBOL(vsprintf);
710
711
712
713
714
715
716
717
718
719
720
721int sprintf(char * buf, const char *fmt, ...)
722{
723 va_list args;
724 int i;
725
726 va_start(args, fmt);
727 i=vsnprintf(buf, INT_MAX, fmt, args);
728 va_end(args);
729 return i;
730}
731
732EXPORT_SYMBOL(sprintf);
733
734
735
736
737
738
739
740int vsscanf(const char * buf, const char * fmt, va_list args)
741{
742 const char *str = buf;
743 char *next;
744 char digit;
745 int num = 0;
746 int qualifier;
747 int base;
748 int field_width;
749 int is_sign = 0;
750
751 while(*fmt && *str) {
752
753
754
755
756 if (isspace(*fmt)) {
757 while (isspace(*fmt))
758 ++fmt;
759 while (isspace(*str))
760 ++str;
761 }
762
763
764 if (*fmt != '%' && *fmt) {
765 if (*fmt++ != *str++)
766 break;
767 continue;
768 }
769
770 if (!*fmt)
771 break;
772 ++fmt;
773
774
775
776
777 if (*fmt == '*') {
778 while (!isspace(*fmt) && *fmt)
779 fmt++;
780 while (!isspace(*str) && *str)
781 str++;
782 continue;
783 }
784
785
786 field_width = -1;
787 if (isdigit(*fmt))
788 field_width = skip_atoi(&fmt);
789
790
791 qualifier = -1;
792 if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L' ||
793 *fmt == 'Z' || *fmt == 'z') {
794 qualifier = *fmt++;
795 if (unlikely(qualifier == *fmt)) {
796 if (qualifier == 'h') {
797 qualifier = 'H';
798 fmt++;
799 } else if (qualifier == 'l') {
800 qualifier = 'L';
801 fmt++;
802 }
803 }
804 }
805 base = 10;
806 is_sign = 0;
807
808 if (!*fmt || !*str)
809 break;
810
811 switch(*fmt++) {
812 case 'c':
813 {
814 char *s = (char *) va_arg(args,char*);
815 if (field_width == -1)
816 field_width = 1;
817 do {
818 *s++ = *str++;
819 } while (--field_width > 0 && *str);
820 num++;
821 }
822 continue;
823 case 's':
824 {
825 char *s = (char *) va_arg(args, char *);
826 if(field_width == -1)
827 field_width = INT_MAX;
828
829 while (isspace(*str))
830 str++;
831
832
833 while (*str && !isspace(*str) && field_width--) {
834 *s++ = *str++;
835 }
836 *s = '\0';
837 num++;
838 }
839 continue;
840 case 'n':
841
842 {
843 int *i = (int *)va_arg(args,int*);
844 *i = str - buf;
845 }
846 continue;
847 case 'o':
848 base = 8;
849 break;
850 case 'x':
851 case 'X':
852 base = 16;
853 break;
854 case 'i':
855 base = 0;
856 case 'd':
857 is_sign = 1;
858 case 'u':
859 break;
860 case '%':
861
862 if (*str++ != '%')
863 return num;
864 continue;
865 default:
866
867 return num;
868 }
869
870
871
872
873 while (isspace(*str))
874 str++;
875
876 digit = *str;
877 if (is_sign && digit == '-')
878 digit = *(str + 1);
879
880 if (!digit
881 || (base == 16 && !isxdigit(digit))
882 || (base == 10 && !isdigit(digit))
883 || (base == 8 && (!isdigit(digit) || digit > '7'))
884 || (base == 0 && !isdigit(digit)))
885 break;
886
887 switch(qualifier) {
888 case 'H':
889 if (is_sign) {
890 signed char *s = (signed char *) va_arg(args,signed char *);
891 *s = (signed char) simple_strtol(str,&next,base);
892 } else {
893 unsigned char *s = (unsigned char *) va_arg(args, unsigned char *);
894 *s = (unsigned char) simple_strtoul(str, &next, base);
895 }
896 break;
897 case 'h':
898 if (is_sign) {
899 short *s = (short *) va_arg(args,short *);
900 *s = (short) simple_strtol(str,&next,base);
901 } else {
902 unsigned short *s = (unsigned short *) va_arg(args, unsigned short *);
903 *s = (unsigned short) simple_strtoul(str, &next, base);
904 }
905 break;
906 case 'l':
907 if (is_sign) {
908 long *l = (long *) va_arg(args,long *);
909 *l = simple_strtol(str,&next,base);
910 } else {
911 unsigned long *l = (unsigned long*) va_arg(args,unsigned long*);
912 *l = simple_strtoul(str,&next,base);
913 }
914 break;
915 case 'L':
916 if (is_sign) {
917 long long *l = (long long*) va_arg(args,long long *);
918 *l = simple_strtoll(str,&next,base);
919 } else {
920 unsigned long long *l = (unsigned long long*) va_arg(args,unsigned long long*);
921 *l = simple_strtoull(str,&next,base);
922 }
923 break;
924 case 'Z':
925 case 'z':
926 {
927 size_t *s = (size_t*) va_arg(args,size_t*);
928 *s = (size_t) simple_strtoul(str,&next,base);
929 }
930 break;
931 default:
932 if (is_sign) {
933 int *i = (int *) va_arg(args, int*);
934 *i = (int) simple_strtol(str,&next,base);
935 } else {
936 unsigned int *i = (unsigned int*) va_arg(args, unsigned int*);
937 *i = (unsigned int) simple_strtoul(str,&next,base);
938 }
939 break;
940 }
941 num++;
942
943 if (!next)
944 break;
945 str = next;
946 }
947
948
949
950
951
952
953 if (*fmt == '%' && *(fmt + 1) == 'n') {
954 int *p = (int *)va_arg(args, int *);
955 *p = str - buf;
956 }
957
958 return num;
959}
960
961EXPORT_SYMBOL(vsscanf);
962
963
964
965
966
967
968
969int sscanf(const char * buf, const char * fmt, ...)
970{
971 va_list args;
972 int i;
973
974 va_start(args,fmt);
975 i = vsscanf(buf,fmt,args);
976 va_end(args);
977 return i;
978}
979
980EXPORT_SYMBOL(sscanf);
981