1 /*
2 * linux/lib/vsprintf.c
3 *
4 * Copyright (C) 1991, 1992 Linus Torvalds
5 */
6
7 /* vsprintf.c -- Lars Wirzenius & Linus Torvalds. */
8 /*
9 * Wirzenius wrote this portably, Torvalds fucked it up :-)
10 */
11
12 #include <common.h>
13 #include <errno.h>
14 #include <linux/ctype.h>
15
16 /* from lib/kstrtox.c */
_parse_integer_fixup_radix(const char * s,unsigned int * base)17 static const char *_parse_integer_fixup_radix(const char *s, unsigned int *base)
18 {
19 if (*base == 0) {
20 if (s[0] == '0') {
21 if (tolower(s[1]) == 'x' && isxdigit(s[2]))
22 *base = 16;
23 else
24 *base = 8;
25 } else
26 *base = 10;
27 }
28 if (*base == 16 && s[0] == '0' && tolower(s[1]) == 'x')
29 s += 2;
30 return s;
31 }
32
simple_strtoul(const char * cp,char ** endp,unsigned int base)33 unsigned long simple_strtoul(const char *cp, char **endp,
34 unsigned int base)
35 {
36 unsigned long result = 0;
37 unsigned long value;
38
39 cp = _parse_integer_fixup_radix(cp, &base);
40
41 while (isxdigit(*cp) && (value = isdigit(*cp) ? *cp-'0' : (islower(*cp)
42 ? toupper(*cp) : *cp)-'A'+10) < base) {
43 result = result*base + value;
44 cp++;
45 }
46
47 if (endp)
48 *endp = (char *)cp;
49
50 return result;
51 }
52
strict_strtoul(const char * cp,unsigned int base,unsigned long * res)53 int strict_strtoul(const char *cp, unsigned int base, unsigned long *res)
54 {
55 char *tail;
56 unsigned long val;
57 size_t len;
58
59 *res = 0;
60 len = strlen(cp);
61 if (len == 0)
62 return -EINVAL;
63
64 val = simple_strtoul(cp, &tail, base);
65 if (tail == cp)
66 return -EINVAL;
67
68 if ((*tail == '\0') ||
69 ((len == (size_t)(tail - cp) + 1) && (*tail == '\n'))) {
70 *res = val;
71 return 0;
72 }
73
74 return -EINVAL;
75 }
76
simple_strtol(const char * cp,char ** endp,unsigned int base)77 long simple_strtol(const char *cp, char **endp, unsigned int base)
78 {
79 if (*cp == '-')
80 return -simple_strtoul(cp + 1, endp, base);
81
82 return simple_strtoul(cp, endp, base);
83 }
84
ustrtoul(const char * cp,char ** endp,unsigned int base)85 unsigned long ustrtoul(const char *cp, char **endp, unsigned int base)
86 {
87 unsigned long result = simple_strtoul(cp, endp, base);
88 switch (tolower(**endp)) {
89 case 'g':
90 result *= 1024;
91 /* fall through */
92 case 'm':
93 result *= 1024;
94 /* fall through */
95 case 'k':
96 result *= 1024;
97 (*endp)++;
98 if (**endp == 'i')
99 (*endp)++;
100 if (**endp == 'B')
101 (*endp)++;
102 }
103 return result;
104 }
105
ustrtoull(const char * cp,char ** endp,unsigned int base)106 unsigned long long ustrtoull(const char *cp, char **endp, unsigned int base)
107 {
108 unsigned long long result = simple_strtoull(cp, endp, base);
109 switch (tolower(**endp)) {
110 case 'g':
111 result *= 1024;
112 /* fall through */
113 case 'm':
114 result *= 1024;
115 /* fall through */
116 case 'k':
117 result *= 1024;
118 (*endp)++;
119 if (**endp == 'i')
120 (*endp)++;
121 if (**endp == 'B')
122 (*endp)++;
123 }
124 return result;
125 }
126
simple_strtoull(const char * cp,char ** endp,unsigned int base)127 unsigned long long simple_strtoull(const char *cp, char **endp,
128 unsigned int base)
129 {
130 unsigned long long result = 0, value;
131
132 cp = _parse_integer_fixup_radix(cp, &base);
133
134 while (isxdigit(*cp) && (value = isdigit(*cp) ? *cp - '0'
135 : (islower(*cp) ? toupper(*cp) : *cp) - 'A' + 10) < base) {
136 result = result * base + value;
137 cp++;
138 }
139
140 if (endp)
141 *endp = (char *) cp;
142
143 return result;
144 }
145
trailing_strtoln(const char * str,const char * end)146 long trailing_strtoln(const char *str, const char *end)
147 {
148 const char *p;
149
150 if (!end)
151 end = str + strlen(str);
152 if (isdigit(end[-1])) {
153 for (p = end - 1; p > str; p--) {
154 if (!isdigit(*p))
155 return simple_strtoul(p + 1, NULL, 10);
156 }
157 }
158
159 return -1;
160 }
161
trailing_strtol(const char * str)162 long trailing_strtol(const char *str)
163 {
164 return trailing_strtoln(str, NULL);
165 }
166
str_to_upper(const char * in,char * out,size_t len)167 void str_to_upper(const char *in, char *out, size_t len)
168 {
169 for (; len > 0 && *in; len--)
170 *out++ = toupper(*in++);
171 if (len)
172 *out = '\0';
173 }
174