blob: c00bb5895df42b8a113e818c3e99290f4e142c20 [file] [log] [blame]
Sjoerd Simonse4c53832015-12-04 23:27:39 +01001/*
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
Rob Clark2e794612017-09-11 16:53:08 -040016/* from lib/kstrtox.c */
17static 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;
Sean Anderson1fae7412020-06-07 01:36:45 -040025 } else
Rob Clark2e794612017-09-11 16:53:08 -040026 *base = 10;
27 }
28 if (*base == 16 && s[0] == '0' && tolower(s[1]) == 'x')
29 s += 2;
30 return s;
31}
32
Sjoerd Simonse4c53832015-12-04 23:27:39 +010033unsigned long simple_strtoul(const char *cp, char **endp,
34 unsigned int base)
35{
36 unsigned long result = 0;
37 unsigned long value;
38
Rob Clark2e794612017-09-11 16:53:08 -040039 cp = _parse_integer_fixup_radix(cp, &base);
Sjoerd Simonse4c53832015-12-04 23:27:39 +010040
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
53int 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
77long 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
85unsigned long ustrtoul(const char *cp, char **endp, unsigned int base)
86{
87 unsigned long result = simple_strtoul(cp, endp, base);
Miquel Raynala353e6a2018-09-06 09:08:43 +020088 switch (tolower(**endp)) {
89 case 'g':
Sjoerd Simonse4c53832015-12-04 23:27:39 +010090 result *= 1024;
91 /* fall through */
Miquel Raynala353e6a2018-09-06 09:08:43 +020092 case 'm':
Sjoerd Simonse4c53832015-12-04 23:27:39 +010093 result *= 1024;
94 /* fall through */
Sjoerd Simonse4c53832015-12-04 23:27:39 +010095 case 'k':
96 result *= 1024;
Miquel Raynalb87b0d82018-09-06 09:08:44 +020097 (*endp)++;
98 if (**endp == 'i')
99 (*endp)++;
100 if (**endp == 'B')
101 (*endp)++;
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100102 }
103 return result;
104}
105
106unsigned long long ustrtoull(const char *cp, char **endp, unsigned int base)
107{
108 unsigned long long result = simple_strtoull(cp, endp, base);
Miquel Raynala353e6a2018-09-06 09:08:43 +0200109 switch (tolower(**endp)) {
110 case 'g':
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100111 result *= 1024;
112 /* fall through */
Miquel Raynala353e6a2018-09-06 09:08:43 +0200113 case 'm':
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100114 result *= 1024;
115 /* fall through */
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100116 case 'k':
117 result *= 1024;
Miquel Raynalb87b0d82018-09-06 09:08:44 +0200118 (*endp)++;
119 if (**endp == 'i')
120 (*endp)++;
121 if (**endp == 'B')
122 (*endp)++;
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100123 }
124 return result;
125}
126
127unsigned long long simple_strtoull(const char *cp, char **endp,
128 unsigned int base)
129{
130 unsigned long long result = 0, value;
131
Rob Clark2e794612017-09-11 16:53:08 -0400132 cp = _parse_integer_fixup_radix(cp, &base);
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100133
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
146long trailing_strtoln(const char *str, const char *end)
147{
148 const char *p;
149
150 if (!end)
151 end = str + strlen(str);
Simon Glassb91c6a12016-10-05 20:42:11 -0600152 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 }
Sjoerd Simonse4c53832015-12-04 23:27:39 +0100157 }
158
159 return -1;
160}
161
162long trailing_strtol(const char *str)
163{
164 return trailing_strtoln(str, NULL);
165}
Simon Glassfdc79a62020-04-08 08:32:56 -0600166
167void 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}