]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
7b9186f5 | 12 | /* |
1da177e4 LT |
13 | * Fri Jul 13 2001 Crutcher Dunnavant <crutcher+kernel@datastacks.com> |
14 | * - changed to provide snprintf and vsnprintf functions | |
15 | * So Feb 1 16:51:32 CET 2004 Juergen Quade <quade@hsnr.de> | |
16 | * - scnprintf and vscnprintf | |
17 | */ | |
18 | ||
19 | #include <stdarg.h> | |
0d1d7a55 | 20 | #include <linux/clk.h> |
900cca29 | 21 | #include <linux/clk-provider.h> |
8bc3bcc9 | 22 | #include <linux/module.h> /* for KSYM_SYMBOL_LEN */ |
1da177e4 LT |
23 | #include <linux/types.h> |
24 | #include <linux/string.h> | |
25 | #include <linux/ctype.h> | |
26 | #include <linux/kernel.h> | |
0fe1ef24 | 27 | #include <linux/kallsyms.h> |
53809751 | 28 | #include <linux/math64.h> |
0fe1ef24 | 29 | #include <linux/uaccess.h> |
332d2e78 | 30 | #include <linux/ioport.h> |
4b6ccca7 | 31 | #include <linux/dcache.h> |
312b4e22 | 32 | #include <linux/cred.h> |
2b1b0d66 | 33 | #include <linux/uuid.h> |
ce4fecf1 | 34 | #include <linux/of.h> |
8a27f7c9 | 35 | #include <net/addrconf.h> |
ad67b74d TH |
36 | #include <linux/siphash.h> |
37 | #include <linux/compiler.h> | |
1031bc58 DM |
38 | #ifdef CONFIG_BLOCK |
39 | #include <linux/blkdev.h> | |
40 | #endif | |
1da177e4 | 41 | |
edf14cdb VB |
42 | #include "../mm/internal.h" /* For the trace_print_flags arrays */ |
43 | ||
4e57b681 | 44 | #include <asm/page.h> /* for PAGE_SIZE */ |
deac93df | 45 | #include <asm/sections.h> /* for dereference_function_descriptor() */ |
7c43d9a3 | 46 | #include <asm/byteorder.h> /* cpu_to_le16 */ |
1da177e4 | 47 | |
71dca95d | 48 | #include <linux/string_helpers.h> |
1dff46d6 | 49 | #include "kstrtox.h" |
aa46a63e | 50 | |
1da177e4 | 51 | /** |
922ac25c | 52 | * simple_strtoull - convert a string to an unsigned long long |
1da177e4 LT |
53 | * @cp: The start of the string |
54 | * @endp: A pointer to the end of the parsed string will be placed here | |
55 | * @base: The number base to use | |
462e4711 EZ |
56 | * |
57 | * This function is obsolete. Please use kstrtoull instead. | |
1da177e4 | 58 | */ |
922ac25c | 59 | unsigned long long simple_strtoull(const char *cp, char **endp, unsigned int base) |
1da177e4 | 60 | { |
1dff46d6 AD |
61 | unsigned long long result; |
62 | unsigned int rv; | |
aa46a63e | 63 | |
1dff46d6 AD |
64 | cp = _parse_integer_fixup_radix(cp, &base); |
65 | rv = _parse_integer(cp, base, &result); | |
66 | /* FIXME */ | |
67 | cp += (rv & ~KSTRTOX_OVERFLOW); | |
aa46a63e | 68 | |
1da177e4 LT |
69 | if (endp) |
70 | *endp = (char *)cp; | |
7b9186f5 | 71 | |
1da177e4 LT |
72 | return result; |
73 | } | |
922ac25c | 74 | EXPORT_SYMBOL(simple_strtoull); |
1da177e4 LT |
75 | |
76 | /** | |
922ac25c | 77 | * simple_strtoul - convert a string to an unsigned long |
1da177e4 LT |
78 | * @cp: The start of the string |
79 | * @endp: A pointer to the end of the parsed string will be placed here | |
80 | * @base: The number base to use | |
462e4711 EZ |
81 | * |
82 | * This function is obsolete. Please use kstrtoul instead. | |
1da177e4 | 83 | */ |
922ac25c | 84 | unsigned long simple_strtoul(const char *cp, char **endp, unsigned int base) |
1da177e4 | 85 | { |
922ac25c | 86 | return simple_strtoull(cp, endp, base); |
1da177e4 | 87 | } |
922ac25c | 88 | EXPORT_SYMBOL(simple_strtoul); |
1da177e4 LT |
89 | |
90 | /** | |
922ac25c | 91 | * simple_strtol - convert a string to a signed long |
1da177e4 LT |
92 | * @cp: The start of the string |
93 | * @endp: A pointer to the end of the parsed string will be placed here | |
94 | * @base: The number base to use | |
462e4711 EZ |
95 | * |
96 | * This function is obsolete. Please use kstrtol instead. | |
1da177e4 | 97 | */ |
922ac25c | 98 | long simple_strtol(const char *cp, char **endp, unsigned int base) |
1da177e4 | 99 | { |
922ac25c AGR |
100 | if (*cp == '-') |
101 | return -simple_strtoul(cp + 1, endp, base); | |
7b9186f5 | 102 | |
922ac25c | 103 | return simple_strtoul(cp, endp, base); |
1da177e4 | 104 | } |
922ac25c | 105 | EXPORT_SYMBOL(simple_strtol); |
1da177e4 LT |
106 | |
107 | /** | |
108 | * simple_strtoll - convert a string to a signed long long | |
109 | * @cp: The start of the string | |
110 | * @endp: A pointer to the end of the parsed string will be placed here | |
111 | * @base: The number base to use | |
462e4711 EZ |
112 | * |
113 | * This function is obsolete. Please use kstrtoll instead. | |
1da177e4 | 114 | */ |
22d27051 | 115 | long long simple_strtoll(const char *cp, char **endp, unsigned int base) |
1da177e4 | 116 | { |
7b9186f5 | 117 | if (*cp == '-') |
22d27051 | 118 | return -simple_strtoull(cp + 1, endp, base); |
7b9186f5 | 119 | |
22d27051 | 120 | return simple_strtoull(cp, endp, base); |
1da177e4 | 121 | } |
98d5ce0d | 122 | EXPORT_SYMBOL(simple_strtoll); |
1da177e4 | 123 | |
cf3b429b JP |
124 | static noinline_for_stack |
125 | int skip_atoi(const char **s) | |
1da177e4 | 126 | { |
7b9186f5 | 127 | int i = 0; |
1da177e4 | 128 | |
43e5b666 | 129 | do { |
1da177e4 | 130 | i = i*10 + *((*s)++) - '0'; |
43e5b666 | 131 | } while (isdigit(**s)); |
7b9186f5 | 132 | |
1da177e4 LT |
133 | return i; |
134 | } | |
135 | ||
7c43d9a3 RV |
136 | /* |
137 | * Decimal conversion is by far the most typical, and is used for | |
138 | * /proc and /sys data. This directly impacts e.g. top performance | |
139 | * with many processes running. We optimize it for speed by emitting | |
140 | * two characters at a time, using a 200 byte lookup table. This | |
141 | * roughly halves the number of multiplications compared to computing | |
142 | * the digits one at a time. Implementation strongly inspired by the | |
143 | * previous version, which in turn used ideas described at | |
144 | * <http://www.cs.uiowa.edu/~jones/bcd/divide.html> (with permission | |
145 | * from the author, Douglas W. Jones). | |
146 | * | |
147 | * It turns out there is precisely one 26 bit fixed-point | |
148 | * approximation a of 64/100 for which x/100 == (x * (u64)a) >> 32 | |
149 | * holds for all x in [0, 10^8-1], namely a = 0x28f5c29. The actual | |
150 | * range happens to be somewhat larger (x <= 1073741898), but that's | |
151 | * irrelevant for our purpose. | |
152 | * | |
153 | * For dividing a number in the range [10^4, 10^6-1] by 100, we still | |
154 | * need a 32x32->64 bit multiply, so we simply use the same constant. | |
155 | * | |
156 | * For dividing a number in the range [100, 10^4-1] by 100, there are | |
157 | * several options. The simplest is (x * 0x147b) >> 19, which is valid | |
158 | * for all x <= 43698. | |
133fd9f5 | 159 | */ |
4277eedd | 160 | |
7c43d9a3 RV |
161 | static const u16 decpair[100] = { |
162 | #define _(x) (__force u16) cpu_to_le16(((x % 10) | ((x / 10) << 8)) + 0x3030) | |
163 | _( 0), _( 1), _( 2), _( 3), _( 4), _( 5), _( 6), _( 7), _( 8), _( 9), | |
164 | _(10), _(11), _(12), _(13), _(14), _(15), _(16), _(17), _(18), _(19), | |
165 | _(20), _(21), _(22), _(23), _(24), _(25), _(26), _(27), _(28), _(29), | |
166 | _(30), _(31), _(32), _(33), _(34), _(35), _(36), _(37), _(38), _(39), | |
167 | _(40), _(41), _(42), _(43), _(44), _(45), _(46), _(47), _(48), _(49), | |
168 | _(50), _(51), _(52), _(53), _(54), _(55), _(56), _(57), _(58), _(59), | |
169 | _(60), _(61), _(62), _(63), _(64), _(65), _(66), _(67), _(68), _(69), | |
170 | _(70), _(71), _(72), _(73), _(74), _(75), _(76), _(77), _(78), _(79), | |
171 | _(80), _(81), _(82), _(83), _(84), _(85), _(86), _(87), _(88), _(89), | |
172 | _(90), _(91), _(92), _(93), _(94), _(95), _(96), _(97), _(98), _(99), | |
173 | #undef _ | |
174 | }; | |
175 | ||
176 | /* | |
177 | * This will print a single '0' even if r == 0, since we would | |
675cf53c RV |
178 | * immediately jump to out_r where two 0s would be written but only |
179 | * one of them accounted for in buf. This is needed by ip4_string | |
180 | * below. All other callers pass a non-zero value of r. | |
7c43d9a3 | 181 | */ |
cf3b429b | 182 | static noinline_for_stack |
7c43d9a3 | 183 | char *put_dec_trunc8(char *buf, unsigned r) |
4277eedd | 184 | { |
7c43d9a3 RV |
185 | unsigned q; |
186 | ||
187 | /* 1 <= r < 10^8 */ | |
188 | if (r < 100) | |
189 | goto out_r; | |
190 | ||
191 | /* 100 <= r < 10^8 */ | |
192 | q = (r * (u64)0x28f5c29) >> 32; | |
193 | *((u16 *)buf) = decpair[r - 100*q]; | |
194 | buf += 2; | |
195 | ||
196 | /* 1 <= q < 10^6 */ | |
197 | if (q < 100) | |
198 | goto out_q; | |
199 | ||
200 | /* 100 <= q < 10^6 */ | |
201 | r = (q * (u64)0x28f5c29) >> 32; | |
202 | *((u16 *)buf) = decpair[q - 100*r]; | |
203 | buf += 2; | |
204 | ||
205 | /* 1 <= r < 10^4 */ | |
206 | if (r < 100) | |
207 | goto out_r; | |
208 | ||
209 | /* 100 <= r < 10^4 */ | |
210 | q = (r * 0x147b) >> 19; | |
211 | *((u16 *)buf) = decpair[r - 100*q]; | |
212 | buf += 2; | |
213 | out_q: | |
214 | /* 1 <= q < 100 */ | |
215 | r = q; | |
216 | out_r: | |
217 | /* 1 <= r < 100 */ | |
218 | *((u16 *)buf) = decpair[r]; | |
675cf53c | 219 | buf += r < 10 ? 1 : 2; |
4277eedd DV |
220 | return buf; |
221 | } | |
133fd9f5 | 222 | |
7c43d9a3 | 223 | #if BITS_PER_LONG == 64 && BITS_PER_LONG_LONG == 64 |
cf3b429b | 224 | static noinline_for_stack |
7c43d9a3 | 225 | char *put_dec_full8(char *buf, unsigned r) |
4277eedd | 226 | { |
133fd9f5 DV |
227 | unsigned q; |
228 | ||
7c43d9a3 RV |
229 | /* 0 <= r < 10^8 */ |
230 | q = (r * (u64)0x28f5c29) >> 32; | |
231 | *((u16 *)buf) = decpair[r - 100*q]; | |
232 | buf += 2; | |
4277eedd | 233 | |
7c43d9a3 RV |
234 | /* 0 <= q < 10^6 */ |
235 | r = (q * (u64)0x28f5c29) >> 32; | |
236 | *((u16 *)buf) = decpair[q - 100*r]; | |
237 | buf += 2; | |
7b9186f5 | 238 | |
7c43d9a3 RV |
239 | /* 0 <= r < 10^4 */ |
240 | q = (r * 0x147b) >> 19; | |
241 | *((u16 *)buf) = decpair[r - 100*q]; | |
242 | buf += 2; | |
133fd9f5 | 243 | |
7c43d9a3 RV |
244 | /* 0 <= q < 100 */ |
245 | *((u16 *)buf) = decpair[q]; | |
246 | buf += 2; | |
247 | return buf; | |
248 | } | |
133fd9f5 | 249 | |
7c43d9a3 | 250 | static noinline_for_stack |
133fd9f5 DV |
251 | char *put_dec(char *buf, unsigned long long n) |
252 | { | |
7c43d9a3 RV |
253 | if (n >= 100*1000*1000) |
254 | buf = put_dec_full8(buf, do_div(n, 100*1000*1000)); | |
255 | /* 1 <= n <= 1.6e11 */ | |
256 | if (n >= 100*1000*1000) | |
257 | buf = put_dec_full8(buf, do_div(n, 100*1000*1000)); | |
258 | /* 1 <= n < 1e8 */ | |
133fd9f5 | 259 | return put_dec_trunc8(buf, n); |
4277eedd | 260 | } |
133fd9f5 | 261 | |
7c43d9a3 | 262 | #elif BITS_PER_LONG == 32 && BITS_PER_LONG_LONG == 64 |
133fd9f5 | 263 | |
7c43d9a3 RV |
264 | static void |
265 | put_dec_full4(char *buf, unsigned r) | |
4277eedd | 266 | { |
7c43d9a3 RV |
267 | unsigned q; |
268 | ||
269 | /* 0 <= r < 10^4 */ | |
270 | q = (r * 0x147b) >> 19; | |
271 | *((u16 *)buf) = decpair[r - 100*q]; | |
272 | buf += 2; | |
273 | /* 0 <= q < 100 */ | |
274 | *((u16 *)buf) = decpair[q]; | |
2359172a GS |
275 | } |
276 | ||
277 | /* | |
278 | * Call put_dec_full4 on x % 10000, return x / 10000. | |
279 | * The approximation x/10000 == (x * 0x346DC5D7) >> 43 | |
280 | * holds for all x < 1,128,869,999. The largest value this | |
281 | * helper will ever be asked to convert is 1,125,520,955. | |
7c43d9a3 | 282 | * (second call in the put_dec code, assuming n is all-ones). |
2359172a | 283 | */ |
7c43d9a3 | 284 | static noinline_for_stack |
2359172a GS |
285 | unsigned put_dec_helper4(char *buf, unsigned x) |
286 | { | |
287 | uint32_t q = (x * (uint64_t)0x346DC5D7) >> 43; | |
288 | ||
289 | put_dec_full4(buf, x - q * 10000); | |
290 | return q; | |
4277eedd DV |
291 | } |
292 | ||
133fd9f5 DV |
293 | /* Based on code by Douglas W. Jones found at |
294 | * <http://www.cs.uiowa.edu/~jones/bcd/decimal.html#sixtyfour> | |
295 | * (with permission from the author). | |
296 | * Performs no 64-bit division and hence should be fast on 32-bit machines. | |
297 | */ | |
298 | static | |
299 | char *put_dec(char *buf, unsigned long long n) | |
300 | { | |
301 | uint32_t d3, d2, d1, q, h; | |
302 | ||
303 | if (n < 100*1000*1000) | |
304 | return put_dec_trunc8(buf, n); | |
305 | ||
306 | d1 = ((uint32_t)n >> 16); /* implicit "& 0xffff" */ | |
307 | h = (n >> 32); | |
308 | d2 = (h ) & 0xffff; | |
309 | d3 = (h >> 16); /* implicit "& 0xffff" */ | |
310 | ||
7c43d9a3 RV |
311 | /* n = 2^48 d3 + 2^32 d2 + 2^16 d1 + d0 |
312 | = 281_4749_7671_0656 d3 + 42_9496_7296 d2 + 6_5536 d1 + d0 */ | |
133fd9f5 | 313 | q = 656 * d3 + 7296 * d2 + 5536 * d1 + ((uint32_t)n & 0xffff); |
2359172a GS |
314 | q = put_dec_helper4(buf, q); |
315 | ||
316 | q += 7671 * d3 + 9496 * d2 + 6 * d1; | |
317 | q = put_dec_helper4(buf+4, q); | |
318 | ||
319 | q += 4749 * d3 + 42 * d2; | |
320 | q = put_dec_helper4(buf+8, q); | |
133fd9f5 | 321 | |
2359172a GS |
322 | q += 281 * d3; |
323 | buf += 12; | |
324 | if (q) | |
325 | buf = put_dec_trunc8(buf, q); | |
326 | else while (buf[-1] == '0') | |
133fd9f5 DV |
327 | --buf; |
328 | ||
329 | return buf; | |
330 | } | |
331 | ||
332 | #endif | |
333 | ||
1ac101a5 KH |
334 | /* |
335 | * Convert passed number to decimal string. | |
336 | * Returns the length of string. On buffer overflow, returns 0. | |
337 | * | |
338 | * If speed is not important, use snprintf(). It's easy to read the code. | |
339 | */ | |
340 | int num_to_str(char *buf, int size, unsigned long long num) | |
341 | { | |
7c43d9a3 RV |
342 | /* put_dec requires 2-byte alignment of the buffer. */ |
343 | char tmp[sizeof(num) * 3] __aligned(2); | |
1ac101a5 KH |
344 | int idx, len; |
345 | ||
133fd9f5 DV |
346 | /* put_dec() may work incorrectly for num = 0 (generate "", not "0") */ |
347 | if (num <= 9) { | |
348 | tmp[0] = '0' + num; | |
349 | len = 1; | |
350 | } else { | |
351 | len = put_dec(tmp, num) - tmp; | |
352 | } | |
1ac101a5 KH |
353 | |
354 | if (len > size) | |
355 | return 0; | |
356 | for (idx = 0; idx < len; ++idx) | |
357 | buf[idx] = tmp[len - idx - 1]; | |
133fd9f5 | 358 | return len; |
1ac101a5 KH |
359 | } |
360 | ||
51be17df | 361 | #define SIGN 1 /* unsigned/signed, must be 1 */ |
d1c1b121 | 362 | #define LEFT 2 /* left justified */ |
1da177e4 LT |
363 | #define PLUS 4 /* show plus */ |
364 | #define SPACE 8 /* space if plus */ | |
d1c1b121 | 365 | #define ZEROPAD 16 /* pad with zero, must be 16 == '0' - ' ' */ |
b89dc5d6 BH |
366 | #define SMALL 32 /* use lowercase in hex (must be 32 == 0x20) */ |
367 | #define SPECIAL 64 /* prefix hex with "0x", octal with "0" */ | |
1da177e4 | 368 | |
fef20d9c FW |
369 | enum format_type { |
370 | FORMAT_TYPE_NONE, /* Just a string part */ | |
ed681a91 | 371 | FORMAT_TYPE_WIDTH, |
fef20d9c FW |
372 | FORMAT_TYPE_PRECISION, |
373 | FORMAT_TYPE_CHAR, | |
374 | FORMAT_TYPE_STR, | |
375 | FORMAT_TYPE_PTR, | |
376 | FORMAT_TYPE_PERCENT_CHAR, | |
377 | FORMAT_TYPE_INVALID, | |
378 | FORMAT_TYPE_LONG_LONG, | |
379 | FORMAT_TYPE_ULONG, | |
380 | FORMAT_TYPE_LONG, | |
a4e94ef0 Z |
381 | FORMAT_TYPE_UBYTE, |
382 | FORMAT_TYPE_BYTE, | |
fef20d9c FW |
383 | FORMAT_TYPE_USHORT, |
384 | FORMAT_TYPE_SHORT, | |
385 | FORMAT_TYPE_UINT, | |
386 | FORMAT_TYPE_INT, | |
fef20d9c FW |
387 | FORMAT_TYPE_SIZE_T, |
388 | FORMAT_TYPE_PTRDIFF | |
389 | }; | |
390 | ||
391 | struct printf_spec { | |
d0484193 RV |
392 | unsigned int type:8; /* format_type enum */ |
393 | signed int field_width:24; /* width of output field */ | |
394 | unsigned int flags:8; /* flags to number() */ | |
395 | unsigned int base:8; /* number base, 8, 10 or 16 only */ | |
396 | signed int precision:16; /* # of digits/chars */ | |
397 | } __packed; | |
4d72ba01 RV |
398 | #define FIELD_WIDTH_MAX ((1 << 23) - 1) |
399 | #define PRECISION_MAX ((1 << 15) - 1) | |
fef20d9c | 400 | |
cf3b429b JP |
401 | static noinline_for_stack |
402 | char *number(char *buf, char *end, unsigned long long num, | |
403 | struct printf_spec spec) | |
1da177e4 | 404 | { |
7c43d9a3 RV |
405 | /* put_dec requires 2-byte alignment of the buffer. */ |
406 | char tmp[3 * sizeof(num)] __aligned(2); | |
9b706aee DV |
407 | char sign; |
408 | char locase; | |
fef20d9c | 409 | int need_pfx = ((spec.flags & SPECIAL) && spec.base != 10); |
1da177e4 | 410 | int i; |
7c203422 | 411 | bool is_zero = num == 0LL; |
1c7a8e62 RV |
412 | int field_width = spec.field_width; |
413 | int precision = spec.precision; | |
1da177e4 | 414 | |
d0484193 RV |
415 | BUILD_BUG_ON(sizeof(struct printf_spec) != 8); |
416 | ||
9b706aee DV |
417 | /* locase = 0 or 0x20. ORing digits or letters with 'locase' |
418 | * produces same digits or (maybe lowercased) letters */ | |
fef20d9c FW |
419 | locase = (spec.flags & SMALL); |
420 | if (spec.flags & LEFT) | |
421 | spec.flags &= ~ZEROPAD; | |
1da177e4 | 422 | sign = 0; |
fef20d9c | 423 | if (spec.flags & SIGN) { |
7b9186f5 | 424 | if ((signed long long)num < 0) { |
1da177e4 | 425 | sign = '-'; |
7b9186f5 | 426 | num = -(signed long long)num; |
1c7a8e62 | 427 | field_width--; |
fef20d9c | 428 | } else if (spec.flags & PLUS) { |
1da177e4 | 429 | sign = '+'; |
1c7a8e62 | 430 | field_width--; |
fef20d9c | 431 | } else if (spec.flags & SPACE) { |
1da177e4 | 432 | sign = ' '; |
1c7a8e62 | 433 | field_width--; |
1da177e4 LT |
434 | } |
435 | } | |
b39a7340 | 436 | if (need_pfx) { |
fef20d9c | 437 | if (spec.base == 16) |
1c7a8e62 | 438 | field_width -= 2; |
7c203422 | 439 | else if (!is_zero) |
1c7a8e62 | 440 | field_width--; |
1da177e4 | 441 | } |
b39a7340 DV |
442 | |
443 | /* generate full string in tmp[], in reverse order */ | |
1da177e4 | 444 | i = 0; |
133fd9f5 | 445 | if (num < spec.base) |
3ea8d440 | 446 | tmp[i++] = hex_asc_upper[num] | locase; |
fef20d9c FW |
447 | else if (spec.base != 10) { /* 8 or 16 */ |
448 | int mask = spec.base - 1; | |
b39a7340 | 449 | int shift = 3; |
7b9186f5 AGR |
450 | |
451 | if (spec.base == 16) | |
452 | shift = 4; | |
b39a7340 | 453 | do { |
3ea8d440 | 454 | tmp[i++] = (hex_asc_upper[((unsigned char)num) & mask] | locase); |
b39a7340 DV |
455 | num >>= shift; |
456 | } while (num); | |
4277eedd DV |
457 | } else { /* base 10 */ |
458 | i = put_dec(tmp, num) - tmp; | |
459 | } | |
b39a7340 DV |
460 | |
461 | /* printing 100 using %2d gives "100", not "00" */ | |
1c7a8e62 RV |
462 | if (i > precision) |
463 | precision = i; | |
b39a7340 | 464 | /* leading space padding */ |
1c7a8e62 | 465 | field_width -= precision; |
51be17df | 466 | if (!(spec.flags & (ZEROPAD | LEFT))) { |
1c7a8e62 | 467 | while (--field_width >= 0) { |
f796937a | 468 | if (buf < end) |
1da177e4 LT |
469 | *buf = ' '; |
470 | ++buf; | |
471 | } | |
472 | } | |
b39a7340 | 473 | /* sign */ |
1da177e4 | 474 | if (sign) { |
f796937a | 475 | if (buf < end) |
1da177e4 LT |
476 | *buf = sign; |
477 | ++buf; | |
478 | } | |
b39a7340 DV |
479 | /* "0x" / "0" prefix */ |
480 | if (need_pfx) { | |
7c203422 PC |
481 | if (spec.base == 16 || !is_zero) { |
482 | if (buf < end) | |
483 | *buf = '0'; | |
484 | ++buf; | |
485 | } | |
fef20d9c | 486 | if (spec.base == 16) { |
f796937a | 487 | if (buf < end) |
9b706aee | 488 | *buf = ('X' | locase); |
1da177e4 LT |
489 | ++buf; |
490 | } | |
491 | } | |
b39a7340 | 492 | /* zero or space padding */ |
fef20d9c | 493 | if (!(spec.flags & LEFT)) { |
d1c1b121 RV |
494 | char c = ' ' + (spec.flags & ZEROPAD); |
495 | BUILD_BUG_ON(' ' + ZEROPAD != '0'); | |
1c7a8e62 | 496 | while (--field_width >= 0) { |
f796937a | 497 | if (buf < end) |
1da177e4 LT |
498 | *buf = c; |
499 | ++buf; | |
500 | } | |
501 | } | |
b39a7340 | 502 | /* hmm even more zero padding? */ |
1c7a8e62 | 503 | while (i <= --precision) { |
f796937a | 504 | if (buf < end) |
1da177e4 LT |
505 | *buf = '0'; |
506 | ++buf; | |
507 | } | |
b39a7340 DV |
508 | /* actual digits of result */ |
509 | while (--i >= 0) { | |
f796937a | 510 | if (buf < end) |
1da177e4 LT |
511 | *buf = tmp[i]; |
512 | ++buf; | |
513 | } | |
b39a7340 | 514 | /* trailing space padding */ |
1c7a8e62 | 515 | while (--field_width >= 0) { |
f796937a | 516 | if (buf < end) |
1da177e4 LT |
517 | *buf = ' '; |
518 | ++buf; | |
519 | } | |
7b9186f5 | 520 | |
1da177e4 LT |
521 | return buf; |
522 | } | |
523 | ||
3cab1e71 AS |
524 | static noinline_for_stack |
525 | char *special_hex_number(char *buf, char *end, unsigned long long num, int size) | |
526 | { | |
527 | struct printf_spec spec; | |
528 | ||
529 | spec.type = FORMAT_TYPE_PTR; | |
530 | spec.field_width = 2 + 2 * size; /* 0x + hex */ | |
531 | spec.flags = SPECIAL | SMALL | ZEROPAD; | |
532 | spec.base = 16; | |
533 | spec.precision = -1; | |
534 | ||
535 | return number(buf, end, num, spec); | |
536 | } | |
537 | ||
cfccde04 | 538 | static void move_right(char *buf, char *end, unsigned len, unsigned spaces) |
4b6ccca7 AV |
539 | { |
540 | size_t size; | |
541 | if (buf >= end) /* nowhere to put anything */ | |
542 | return; | |
543 | size = end - buf; | |
544 | if (size <= spaces) { | |
545 | memset(buf, ' ', size); | |
546 | return; | |
547 | } | |
548 | if (len) { | |
549 | if (len > size - spaces) | |
550 | len = size - spaces; | |
551 | memmove(buf + spaces, buf, len); | |
552 | } | |
553 | memset(buf, ' ', spaces); | |
554 | } | |
555 | ||
cfccde04 RV |
556 | /* |
557 | * Handle field width padding for a string. | |
558 | * @buf: current buffer position | |
559 | * @n: length of string | |
560 | * @end: end of output buffer | |
561 | * @spec: for field width and flags | |
562 | * Returns: new buffer position after padding. | |
563 | */ | |
564 | static noinline_for_stack | |
565 | char *widen_string(char *buf, int n, char *end, struct printf_spec spec) | |
566 | { | |
567 | unsigned spaces; | |
568 | ||
569 | if (likely(n >= spec.field_width)) | |
570 | return buf; | |
571 | /* we want to pad the sucker */ | |
572 | spaces = spec.field_width - n; | |
573 | if (!(spec.flags & LEFT)) { | |
574 | move_right(buf - n, end, n, spaces); | |
575 | return buf + spaces; | |
576 | } | |
577 | while (spaces--) { | |
578 | if (buf < end) | |
579 | *buf = ' '; | |
580 | ++buf; | |
581 | } | |
582 | return buf; | |
583 | } | |
584 | ||
95508cfa RV |
585 | static noinline_for_stack |
586 | char *string(char *buf, char *end, const char *s, struct printf_spec spec) | |
587 | { | |
34fc8b90 RV |
588 | int len = 0; |
589 | size_t lim = spec.precision; | |
95508cfa RV |
590 | |
591 | if ((unsigned long)s < PAGE_SIZE) | |
592 | s = "(null)"; | |
593 | ||
34fc8b90 RV |
594 | while (lim--) { |
595 | char c = *s++; | |
596 | if (!c) | |
597 | break; | |
95508cfa | 598 | if (buf < end) |
34fc8b90 | 599 | *buf = c; |
95508cfa | 600 | ++buf; |
34fc8b90 | 601 | ++len; |
95508cfa | 602 | } |
34fc8b90 | 603 | return widen_string(buf, len, end, spec); |
95508cfa RV |
604 | } |
605 | ||
4b6ccca7 AV |
606 | static noinline_for_stack |
607 | char *dentry_name(char *buf, char *end, const struct dentry *d, struct printf_spec spec, | |
608 | const char *fmt) | |
609 | { | |
610 | const char *array[4], *s; | |
611 | const struct dentry *p; | |
612 | int depth; | |
613 | int i, n; | |
614 | ||
615 | switch (fmt[1]) { | |
616 | case '2': case '3': case '4': | |
617 | depth = fmt[1] - '0'; | |
618 | break; | |
619 | default: | |
620 | depth = 1; | |
621 | } | |
622 | ||
623 | rcu_read_lock(); | |
624 | for (i = 0; i < depth; i++, d = p) { | |
6aa7de05 MR |
625 | p = READ_ONCE(d->d_parent); |
626 | array[i] = READ_ONCE(d->d_name.name); | |
4b6ccca7 AV |
627 | if (p == d) { |
628 | if (i) | |
629 | array[i] = ""; | |
630 | i++; | |
631 | break; | |
632 | } | |
633 | } | |
634 | s = array[--i]; | |
635 | for (n = 0; n != spec.precision; n++, buf++) { | |
636 | char c = *s++; | |
637 | if (!c) { | |
638 | if (!i) | |
639 | break; | |
640 | c = '/'; | |
641 | s = array[--i]; | |
642 | } | |
643 | if (buf < end) | |
644 | *buf = c; | |
645 | } | |
646 | rcu_read_unlock(); | |
cfccde04 | 647 | return widen_string(buf, n, end, spec); |
4b6ccca7 AV |
648 | } |
649 | ||
1031bc58 DM |
650 | #ifdef CONFIG_BLOCK |
651 | static noinline_for_stack | |
652 | char *bdev_name(char *buf, char *end, struct block_device *bdev, | |
653 | struct printf_spec spec, const char *fmt) | |
654 | { | |
655 | struct gendisk *hd = bdev->bd_disk; | |
656 | ||
657 | buf = string(buf, end, hd->disk_name, spec); | |
658 | if (bdev->bd_part->partno) { | |
659 | if (isdigit(hd->disk_name[strlen(hd->disk_name)-1])) { | |
660 | if (buf < end) | |
661 | *buf = 'p'; | |
662 | buf++; | |
663 | } | |
664 | buf = number(buf, end, bdev->bd_part->partno, spec); | |
665 | } | |
666 | return buf; | |
667 | } | |
668 | #endif | |
669 | ||
cf3b429b JP |
670 | static noinline_for_stack |
671 | char *symbol_string(char *buf, char *end, void *ptr, | |
b0d33c2b | 672 | struct printf_spec spec, const char *fmt) |
0fe1ef24 | 673 | { |
b0d33c2b | 674 | unsigned long value; |
0fe1ef24 LT |
675 | #ifdef CONFIG_KALLSYMS |
676 | char sym[KSYM_SYMBOL_LEN]; | |
b0d33c2b JP |
677 | #endif |
678 | ||
679 | if (fmt[1] == 'R') | |
680 | ptr = __builtin_extract_return_addr(ptr); | |
681 | value = (unsigned long)ptr; | |
682 | ||
683 | #ifdef CONFIG_KALLSYMS | |
684 | if (*fmt == 'B') | |
0f77a8d3 | 685 | sprint_backtrace(sym, value); |
b0d33c2b | 686 | else if (*fmt != 'f' && *fmt != 's') |
0c8b946e FW |
687 | sprint_symbol(sym, value); |
688 | else | |
4796dd20 | 689 | sprint_symbol_no_offset(sym, value); |
7b9186f5 | 690 | |
fef20d9c | 691 | return string(buf, end, sym, spec); |
0fe1ef24 | 692 | #else |
3cab1e71 | 693 | return special_hex_number(buf, end, value, sizeof(void *)); |
0fe1ef24 LT |
694 | #endif |
695 | } | |
696 | ||
cf3b429b JP |
697 | static noinline_for_stack |
698 | char *resource_string(char *buf, char *end, struct resource *res, | |
699 | struct printf_spec spec, const char *fmt) | |
332d2e78 LT |
700 | { |
701 | #ifndef IO_RSRC_PRINTK_SIZE | |
28405372 | 702 | #define IO_RSRC_PRINTK_SIZE 6 |
332d2e78 LT |
703 | #endif |
704 | ||
705 | #ifndef MEM_RSRC_PRINTK_SIZE | |
28405372 | 706 | #define MEM_RSRC_PRINTK_SIZE 10 |
332d2e78 | 707 | #endif |
4da0b66c | 708 | static const struct printf_spec io_spec = { |
fef20d9c | 709 | .base = 16, |
4da0b66c | 710 | .field_width = IO_RSRC_PRINTK_SIZE, |
fef20d9c FW |
711 | .precision = -1, |
712 | .flags = SPECIAL | SMALL | ZEROPAD, | |
713 | }; | |
4da0b66c BH |
714 | static const struct printf_spec mem_spec = { |
715 | .base = 16, | |
716 | .field_width = MEM_RSRC_PRINTK_SIZE, | |
717 | .precision = -1, | |
718 | .flags = SPECIAL | SMALL | ZEROPAD, | |
719 | }; | |
0f4050c7 BH |
720 | static const struct printf_spec bus_spec = { |
721 | .base = 16, | |
722 | .field_width = 2, | |
723 | .precision = -1, | |
724 | .flags = SMALL | ZEROPAD, | |
725 | }; | |
4da0b66c | 726 | static const struct printf_spec dec_spec = { |
c91d3376 BH |
727 | .base = 10, |
728 | .precision = -1, | |
729 | .flags = 0, | |
730 | }; | |
4da0b66c | 731 | static const struct printf_spec str_spec = { |
fd95541e BH |
732 | .field_width = -1, |
733 | .precision = 10, | |
734 | .flags = LEFT, | |
735 | }; | |
4da0b66c | 736 | static const struct printf_spec flag_spec = { |
fd95541e BH |
737 | .base = 16, |
738 | .precision = -1, | |
739 | .flags = SPECIAL | SMALL, | |
740 | }; | |
c7dabef8 BH |
741 | |
742 | /* 32-bit res (sizeof==4): 10 chars in dec, 10 in hex ("0x" + 8) | |
743 | * 64-bit res (sizeof==8): 20 chars in dec, 18 in hex ("0x" + 16) */ | |
744 | #define RSRC_BUF_SIZE ((2 * sizeof(resource_size_t)) + 4) | |
745 | #define FLAG_BUF_SIZE (2 * sizeof(res->flags)) | |
9d7cca04 | 746 | #define DECODED_BUF_SIZE sizeof("[mem - 64bit pref window disabled]") |
c7dabef8 BH |
747 | #define RAW_BUF_SIZE sizeof("[mem - flags 0x]") |
748 | char sym[max(2*RSRC_BUF_SIZE + DECODED_BUF_SIZE, | |
749 | 2*RSRC_BUF_SIZE + FLAG_BUF_SIZE + RAW_BUF_SIZE)]; | |
750 | ||
332d2e78 | 751 | char *p = sym, *pend = sym + sizeof(sym); |
c7dabef8 | 752 | int decode = (fmt[0] == 'R') ? 1 : 0; |
4da0b66c | 753 | const struct printf_spec *specp; |
332d2e78 LT |
754 | |
755 | *p++ = '['; | |
4da0b66c | 756 | if (res->flags & IORESOURCE_IO) { |
c7dabef8 | 757 | p = string(p, pend, "io ", str_spec); |
4da0b66c BH |
758 | specp = &io_spec; |
759 | } else if (res->flags & IORESOURCE_MEM) { | |
c7dabef8 | 760 | p = string(p, pend, "mem ", str_spec); |
4da0b66c BH |
761 | specp = &mem_spec; |
762 | } else if (res->flags & IORESOURCE_IRQ) { | |
c7dabef8 | 763 | p = string(p, pend, "irq ", str_spec); |
4da0b66c BH |
764 | specp = &dec_spec; |
765 | } else if (res->flags & IORESOURCE_DMA) { | |
c7dabef8 | 766 | p = string(p, pend, "dma ", str_spec); |
4da0b66c | 767 | specp = &dec_spec; |
0f4050c7 BH |
768 | } else if (res->flags & IORESOURCE_BUS) { |
769 | p = string(p, pend, "bus ", str_spec); | |
770 | specp = &bus_spec; | |
4da0b66c | 771 | } else { |
c7dabef8 | 772 | p = string(p, pend, "??? ", str_spec); |
4da0b66c | 773 | specp = &mem_spec; |
c7dabef8 | 774 | decode = 0; |
fd95541e | 775 | } |
d19cb803 BH |
776 | if (decode && res->flags & IORESOURCE_UNSET) { |
777 | p = string(p, pend, "size ", str_spec); | |
778 | p = number(p, pend, resource_size(res), *specp); | |
779 | } else { | |
780 | p = number(p, pend, res->start, *specp); | |
781 | if (res->start != res->end) { | |
782 | *p++ = '-'; | |
783 | p = number(p, pend, res->end, *specp); | |
784 | } | |
c91d3376 | 785 | } |
c7dabef8 | 786 | if (decode) { |
fd95541e BH |
787 | if (res->flags & IORESOURCE_MEM_64) |
788 | p = string(p, pend, " 64bit", str_spec); | |
789 | if (res->flags & IORESOURCE_PREFETCH) | |
790 | p = string(p, pend, " pref", str_spec); | |
9d7cca04 BH |
791 | if (res->flags & IORESOURCE_WINDOW) |
792 | p = string(p, pend, " window", str_spec); | |
fd95541e BH |
793 | if (res->flags & IORESOURCE_DISABLED) |
794 | p = string(p, pend, " disabled", str_spec); | |
c7dabef8 BH |
795 | } else { |
796 | p = string(p, pend, " flags ", str_spec); | |
797 | p = number(p, pend, res->flags, flag_spec); | |
fd95541e | 798 | } |
332d2e78 | 799 | *p++ = ']'; |
c7dabef8 | 800 | *p = '\0'; |
332d2e78 | 801 | |
fef20d9c | 802 | return string(buf, end, sym, spec); |
332d2e78 LT |
803 | } |
804 | ||
31550a16 AS |
805 | static noinline_for_stack |
806 | char *hex_string(char *buf, char *end, u8 *addr, struct printf_spec spec, | |
807 | const char *fmt) | |
808 | { | |
360603a1 | 809 | int i, len = 1; /* if we pass '%ph[CDN]', field width remains |
31550a16 AS |
810 | negative value, fallback to the default */ |
811 | char separator; | |
812 | ||
813 | if (spec.field_width == 0) | |
814 | /* nothing to print */ | |
815 | return buf; | |
816 | ||
817 | if (ZERO_OR_NULL_PTR(addr)) | |
818 | /* NULL pointer */ | |
819 | return string(buf, end, NULL, spec); | |
820 | ||
821 | switch (fmt[1]) { | |
822 | case 'C': | |
823 | separator = ':'; | |
824 | break; | |
825 | case 'D': | |
826 | separator = '-'; | |
827 | break; | |
828 | case 'N': | |
829 | separator = 0; | |
830 | break; | |
831 | default: | |
832 | separator = ' '; | |
833 | break; | |
834 | } | |
835 | ||
836 | if (spec.field_width > 0) | |
837 | len = min_t(int, spec.field_width, 64); | |
838 | ||
9c98f235 RV |
839 | for (i = 0; i < len; ++i) { |
840 | if (buf < end) | |
841 | *buf = hex_asc_hi(addr[i]); | |
842 | ++buf; | |
843 | if (buf < end) | |
844 | *buf = hex_asc_lo(addr[i]); | |
845 | ++buf; | |
31550a16 | 846 | |
9c98f235 RV |
847 | if (separator && i != len - 1) { |
848 | if (buf < end) | |
849 | *buf = separator; | |
850 | ++buf; | |
851 | } | |
31550a16 AS |
852 | } |
853 | ||
854 | return buf; | |
855 | } | |
856 | ||
dbc760bc TH |
857 | static noinline_for_stack |
858 | char *bitmap_string(char *buf, char *end, unsigned long *bitmap, | |
859 | struct printf_spec spec, const char *fmt) | |
860 | { | |
861 | const int CHUNKSZ = 32; | |
862 | int nr_bits = max_t(int, spec.field_width, 0); | |
863 | int i, chunksz; | |
864 | bool first = true; | |
865 | ||
866 | /* reused to print numbers */ | |
867 | spec = (struct printf_spec){ .flags = SMALL | ZEROPAD, .base = 16 }; | |
868 | ||
869 | chunksz = nr_bits & (CHUNKSZ - 1); | |
870 | if (chunksz == 0) | |
871 | chunksz = CHUNKSZ; | |
872 | ||
873 | i = ALIGN(nr_bits, CHUNKSZ) - CHUNKSZ; | |
874 | for (; i >= 0; i -= CHUNKSZ) { | |
875 | u32 chunkmask, val; | |
876 | int word, bit; | |
877 | ||
878 | chunkmask = ((1ULL << chunksz) - 1); | |
879 | word = i / BITS_PER_LONG; | |
880 | bit = i % BITS_PER_LONG; | |
881 | val = (bitmap[word] >> bit) & chunkmask; | |
882 | ||
883 | if (!first) { | |
884 | if (buf < end) | |
885 | *buf = ','; | |
886 | buf++; | |
887 | } | |
888 | first = false; | |
889 | ||
890 | spec.field_width = DIV_ROUND_UP(chunksz, 4); | |
891 | buf = number(buf, end, val, spec); | |
892 | ||
893 | chunksz = CHUNKSZ; | |
894 | } | |
895 | return buf; | |
896 | } | |
897 | ||
898 | static noinline_for_stack | |
899 | char *bitmap_list_string(char *buf, char *end, unsigned long *bitmap, | |
900 | struct printf_spec spec, const char *fmt) | |
901 | { | |
902 | int nr_bits = max_t(int, spec.field_width, 0); | |
903 | /* current bit is 'cur', most recently seen range is [rbot, rtop] */ | |
904 | int cur, rbot, rtop; | |
905 | bool first = true; | |
906 | ||
907 | /* reused to print numbers */ | |
908 | spec = (struct printf_spec){ .base = 10 }; | |
909 | ||
910 | rbot = cur = find_first_bit(bitmap, nr_bits); | |
911 | while (cur < nr_bits) { | |
912 | rtop = cur; | |
913 | cur = find_next_bit(bitmap, nr_bits, cur + 1); | |
914 | if (cur < nr_bits && cur <= rtop + 1) | |
915 | continue; | |
916 | ||
917 | if (!first) { | |
918 | if (buf < end) | |
919 | *buf = ','; | |
920 | buf++; | |
921 | } | |
922 | first = false; | |
923 | ||
924 | buf = number(buf, end, rbot, spec); | |
925 | if (rbot < rtop) { | |
926 | if (buf < end) | |
927 | *buf = '-'; | |
928 | buf++; | |
929 | ||
930 | buf = number(buf, end, rtop, spec); | |
931 | } | |
932 | ||
933 | rbot = cur; | |
934 | } | |
935 | return buf; | |
936 | } | |
937 | ||
cf3b429b JP |
938 | static noinline_for_stack |
939 | char *mac_address_string(char *buf, char *end, u8 *addr, | |
940 | struct printf_spec spec, const char *fmt) | |
dd45c9cf | 941 | { |
8a27f7c9 | 942 | char mac_addr[sizeof("xx:xx:xx:xx:xx:xx")]; |
dd45c9cf HH |
943 | char *p = mac_addr; |
944 | int i; | |
bc7259a2 | 945 | char separator; |
76597ff9 | 946 | bool reversed = false; |
bc7259a2 | 947 | |
76597ff9 AE |
948 | switch (fmt[1]) { |
949 | case 'F': | |
bc7259a2 | 950 | separator = '-'; |
76597ff9 AE |
951 | break; |
952 | ||
953 | case 'R': | |
954 | reversed = true; | |
955 | /* fall through */ | |
956 | ||
957 | default: | |
bc7259a2 | 958 | separator = ':'; |
76597ff9 | 959 | break; |
bc7259a2 | 960 | } |
dd45c9cf HH |
961 | |
962 | for (i = 0; i < 6; i++) { | |
76597ff9 AE |
963 | if (reversed) |
964 | p = hex_byte_pack(p, addr[5 - i]); | |
965 | else | |
966 | p = hex_byte_pack(p, addr[i]); | |
967 | ||
8a27f7c9 | 968 | if (fmt[0] == 'M' && i != 5) |
bc7259a2 | 969 | *p++ = separator; |
dd45c9cf HH |
970 | } |
971 | *p = '\0'; | |
972 | ||
fef20d9c | 973 | return string(buf, end, mac_addr, spec); |
dd45c9cf HH |
974 | } |
975 | ||
cf3b429b JP |
976 | static noinline_for_stack |
977 | char *ip4_string(char *p, const u8 *addr, const char *fmt) | |
8a27f7c9 JP |
978 | { |
979 | int i; | |
0159f24e JP |
980 | bool leading_zeros = (fmt[0] == 'i'); |
981 | int index; | |
982 | int step; | |
983 | ||
984 | switch (fmt[2]) { | |
985 | case 'h': | |
986 | #ifdef __BIG_ENDIAN | |
987 | index = 0; | |
988 | step = 1; | |
989 | #else | |
990 | index = 3; | |
991 | step = -1; | |
992 | #endif | |
993 | break; | |
994 | case 'l': | |
995 | index = 3; | |
996 | step = -1; | |
997 | break; | |
998 | case 'n': | |
999 | case 'b': | |
1000 | default: | |
1001 | index = 0; | |
1002 | step = 1; | |
1003 | break; | |
1004 | } | |
8a27f7c9 | 1005 | for (i = 0; i < 4; i++) { |
7c43d9a3 | 1006 | char temp[4] __aligned(2); /* hold each IP quad in reverse order */ |
133fd9f5 | 1007 | int digits = put_dec_trunc8(temp, addr[index]) - temp; |
8a27f7c9 JP |
1008 | if (leading_zeros) { |
1009 | if (digits < 3) | |
1010 | *p++ = '0'; | |
1011 | if (digits < 2) | |
1012 | *p++ = '0'; | |
1013 | } | |
1014 | /* reverse the digits in the quad */ | |
1015 | while (digits--) | |
1016 | *p++ = temp[digits]; | |
1017 | if (i < 3) | |
1018 | *p++ = '.'; | |
0159f24e | 1019 | index += step; |
8a27f7c9 | 1020 | } |
8a27f7c9 | 1021 | *p = '\0'; |
7b9186f5 | 1022 | |
8a27f7c9 JP |
1023 | return p; |
1024 | } | |
1025 | ||
cf3b429b JP |
1026 | static noinline_for_stack |
1027 | char *ip6_compressed_string(char *p, const char *addr) | |
689afa7d | 1028 | { |
7b9186f5 | 1029 | int i, j, range; |
8a27f7c9 JP |
1030 | unsigned char zerolength[8]; |
1031 | int longest = 1; | |
1032 | int colonpos = -1; | |
1033 | u16 word; | |
7b9186f5 | 1034 | u8 hi, lo; |
8a27f7c9 | 1035 | bool needcolon = false; |
eb78cd26 JP |
1036 | bool useIPv4; |
1037 | struct in6_addr in6; | |
1038 | ||
1039 | memcpy(&in6, addr, sizeof(struct in6_addr)); | |
1040 | ||
1041 | useIPv4 = ipv6_addr_v4mapped(&in6) || ipv6_addr_is_isatap(&in6); | |
8a27f7c9 JP |
1042 | |
1043 | memset(zerolength, 0, sizeof(zerolength)); | |
1044 | ||
1045 | if (useIPv4) | |
1046 | range = 6; | |
1047 | else | |
1048 | range = 8; | |
1049 | ||
1050 | /* find position of longest 0 run */ | |
1051 | for (i = 0; i < range; i++) { | |
1052 | for (j = i; j < range; j++) { | |
eb78cd26 | 1053 | if (in6.s6_addr16[j] != 0) |
8a27f7c9 JP |
1054 | break; |
1055 | zerolength[i]++; | |
1056 | } | |
1057 | } | |
1058 | for (i = 0; i < range; i++) { | |
1059 | if (zerolength[i] > longest) { | |
1060 | longest = zerolength[i]; | |
1061 | colonpos = i; | |
1062 | } | |
1063 | } | |
29cf519e JP |
1064 | if (longest == 1) /* don't compress a single 0 */ |
1065 | colonpos = -1; | |
689afa7d | 1066 | |
8a27f7c9 JP |
1067 | /* emit address */ |
1068 | for (i = 0; i < range; i++) { | |
1069 | if (i == colonpos) { | |
1070 | if (needcolon || i == 0) | |
1071 | *p++ = ':'; | |
1072 | *p++ = ':'; | |
1073 | needcolon = false; | |
1074 | i += longest - 1; | |
1075 | continue; | |
1076 | } | |
1077 | if (needcolon) { | |
1078 | *p++ = ':'; | |
1079 | needcolon = false; | |
1080 | } | |
1081 | /* hex u16 without leading 0s */ | |
eb78cd26 | 1082 | word = ntohs(in6.s6_addr16[i]); |
8a27f7c9 JP |
1083 | hi = word >> 8; |
1084 | lo = word & 0xff; | |
1085 | if (hi) { | |
1086 | if (hi > 0x0f) | |
55036ba7 | 1087 | p = hex_byte_pack(p, hi); |
8a27f7c9 JP |
1088 | else |
1089 | *p++ = hex_asc_lo(hi); | |
55036ba7 | 1090 | p = hex_byte_pack(p, lo); |
8a27f7c9 | 1091 | } |
b5ff992b | 1092 | else if (lo > 0x0f) |
55036ba7 | 1093 | p = hex_byte_pack(p, lo); |
8a27f7c9 JP |
1094 | else |
1095 | *p++ = hex_asc_lo(lo); | |
1096 | needcolon = true; | |
1097 | } | |
1098 | ||
1099 | if (useIPv4) { | |
1100 | if (needcolon) | |
1101 | *p++ = ':'; | |
0159f24e | 1102 | p = ip4_string(p, &in6.s6_addr[12], "I4"); |
8a27f7c9 | 1103 | } |
8a27f7c9 | 1104 | *p = '\0'; |
7b9186f5 | 1105 | |
8a27f7c9 JP |
1106 | return p; |
1107 | } | |
1108 | ||
cf3b429b JP |
1109 | static noinline_for_stack |
1110 | char *ip6_string(char *p, const char *addr, const char *fmt) | |
8a27f7c9 JP |
1111 | { |
1112 | int i; | |
7b9186f5 | 1113 | |
689afa7d | 1114 | for (i = 0; i < 8; i++) { |
55036ba7 AS |
1115 | p = hex_byte_pack(p, *addr++); |
1116 | p = hex_byte_pack(p, *addr++); | |
8a27f7c9 | 1117 | if (fmt[0] == 'I' && i != 7) |
689afa7d HH |
1118 | *p++ = ':'; |
1119 | } | |
1120 | *p = '\0'; | |
7b9186f5 | 1121 | |
8a27f7c9 JP |
1122 | return p; |
1123 | } | |
1124 | ||
cf3b429b JP |
1125 | static noinline_for_stack |
1126 | char *ip6_addr_string(char *buf, char *end, const u8 *addr, | |
1127 | struct printf_spec spec, const char *fmt) | |
8a27f7c9 JP |
1128 | { |
1129 | char ip6_addr[sizeof("xxxx:xxxx:xxxx:xxxx:xxxx:xxxx:255.255.255.255")]; | |
1130 | ||
1131 | if (fmt[0] == 'I' && fmt[2] == 'c') | |
eb78cd26 | 1132 | ip6_compressed_string(ip6_addr, addr); |
8a27f7c9 | 1133 | else |
eb78cd26 | 1134 | ip6_string(ip6_addr, addr, fmt); |
689afa7d | 1135 | |
fef20d9c | 1136 | return string(buf, end, ip6_addr, spec); |
689afa7d HH |
1137 | } |
1138 | ||
cf3b429b JP |
1139 | static noinline_for_stack |
1140 | char *ip4_addr_string(char *buf, char *end, const u8 *addr, | |
1141 | struct printf_spec spec, const char *fmt) | |
4aa99606 | 1142 | { |
8a27f7c9 | 1143 | char ip4_addr[sizeof("255.255.255.255")]; |
4aa99606 | 1144 | |
0159f24e | 1145 | ip4_string(ip4_addr, addr, fmt); |
4aa99606 | 1146 | |
fef20d9c | 1147 | return string(buf, end, ip4_addr, spec); |
4aa99606 HH |
1148 | } |
1149 | ||
10679643 DB |
1150 | static noinline_for_stack |
1151 | char *ip6_addr_string_sa(char *buf, char *end, const struct sockaddr_in6 *sa, | |
1152 | struct printf_spec spec, const char *fmt) | |
1153 | { | |
1154 | bool have_p = false, have_s = false, have_f = false, have_c = false; | |
1155 | char ip6_addr[sizeof("[xxxx:xxxx:xxxx:xxxx:xxxx:xxxx:255.255.255.255]") + | |
1156 | sizeof(":12345") + sizeof("/123456789") + | |
1157 | sizeof("%1234567890")]; | |
1158 | char *p = ip6_addr, *pend = ip6_addr + sizeof(ip6_addr); | |
1159 | const u8 *addr = (const u8 *) &sa->sin6_addr; | |
1160 | char fmt6[2] = { fmt[0], '6' }; | |
1161 | u8 off = 0; | |
1162 | ||
1163 | fmt++; | |
1164 | while (isalpha(*++fmt)) { | |
1165 | switch (*fmt) { | |
1166 | case 'p': | |
1167 | have_p = true; | |
1168 | break; | |
1169 | case 'f': | |
1170 | have_f = true; | |
1171 | break; | |
1172 | case 's': | |
1173 | have_s = true; | |
1174 | break; | |
1175 | case 'c': | |
1176 | have_c = true; | |
1177 | break; | |
1178 | } | |
1179 | } | |
1180 | ||
1181 | if (have_p || have_s || have_f) { | |
1182 | *p = '['; | |
1183 | off = 1; | |
1184 | } | |
1185 | ||
1186 | if (fmt6[0] == 'I' && have_c) | |
1187 | p = ip6_compressed_string(ip6_addr + off, addr); | |
1188 | else | |
1189 | p = ip6_string(ip6_addr + off, addr, fmt6); | |
1190 | ||
1191 | if (have_p || have_s || have_f) | |
1192 | *p++ = ']'; | |
1193 | ||
1194 | if (have_p) { | |
1195 | *p++ = ':'; | |
1196 | p = number(p, pend, ntohs(sa->sin6_port), spec); | |
1197 | } | |
1198 | if (have_f) { | |
1199 | *p++ = '/'; | |
1200 | p = number(p, pend, ntohl(sa->sin6_flowinfo & | |
1201 | IPV6_FLOWINFO_MASK), spec); | |
1202 | } | |
1203 | if (have_s) { | |
1204 | *p++ = '%'; | |
1205 | p = number(p, pend, sa->sin6_scope_id, spec); | |
1206 | } | |
1207 | *p = '\0'; | |
1208 | ||
1209 | return string(buf, end, ip6_addr, spec); | |
1210 | } | |
1211 | ||
1212 | static noinline_for_stack | |
1213 | char *ip4_addr_string_sa(char *buf, char *end, const struct sockaddr_in *sa, | |
1214 | struct printf_spec spec, const char *fmt) | |
1215 | { | |
1216 | bool have_p = false; | |
1217 | char *p, ip4_addr[sizeof("255.255.255.255") + sizeof(":12345")]; | |
1218 | char *pend = ip4_addr + sizeof(ip4_addr); | |
1219 | const u8 *addr = (const u8 *) &sa->sin_addr.s_addr; | |
1220 | char fmt4[3] = { fmt[0], '4', 0 }; | |
1221 | ||
1222 | fmt++; | |
1223 | while (isalpha(*++fmt)) { | |
1224 | switch (*fmt) { | |
1225 | case 'p': | |
1226 | have_p = true; | |
1227 | break; | |
1228 | case 'h': | |
1229 | case 'l': | |
1230 | case 'n': | |
1231 | case 'b': | |
1232 | fmt4[2] = *fmt; | |
1233 | break; | |
1234 | } | |
1235 | } | |
1236 | ||
1237 | p = ip4_string(ip4_addr, addr, fmt4); | |
1238 | if (have_p) { | |
1239 | *p++ = ':'; | |
1240 | p = number(p, pend, ntohs(sa->sin_port), spec); | |
1241 | } | |
1242 | *p = '\0'; | |
1243 | ||
1244 | return string(buf, end, ip4_addr, spec); | |
1245 | } | |
1246 | ||
71dca95d AS |
1247 | static noinline_for_stack |
1248 | char *escaped_string(char *buf, char *end, u8 *addr, struct printf_spec spec, | |
1249 | const char *fmt) | |
1250 | { | |
1251 | bool found = true; | |
1252 | int count = 1; | |
1253 | unsigned int flags = 0; | |
1254 | int len; | |
1255 | ||
1256 | if (spec.field_width == 0) | |
1257 | return buf; /* nothing to print */ | |
1258 | ||
1259 | if (ZERO_OR_NULL_PTR(addr)) | |
1260 | return string(buf, end, NULL, spec); /* NULL pointer */ | |
1261 | ||
1262 | ||
1263 | do { | |
1264 | switch (fmt[count++]) { | |
1265 | case 'a': | |
1266 | flags |= ESCAPE_ANY; | |
1267 | break; | |
1268 | case 'c': | |
1269 | flags |= ESCAPE_SPECIAL; | |
1270 | break; | |
1271 | case 'h': | |
1272 | flags |= ESCAPE_HEX; | |
1273 | break; | |
1274 | case 'n': | |
1275 | flags |= ESCAPE_NULL; | |
1276 | break; | |
1277 | case 'o': | |
1278 | flags |= ESCAPE_OCTAL; | |
1279 | break; | |
1280 | case 'p': | |
1281 | flags |= ESCAPE_NP; | |
1282 | break; | |
1283 | case 's': | |
1284 | flags |= ESCAPE_SPACE; | |
1285 | break; | |
1286 | default: | |
1287 | found = false; | |
1288 | break; | |
1289 | } | |
1290 | } while (found); | |
1291 | ||
1292 | if (!flags) | |
1293 | flags = ESCAPE_ANY_NP; | |
1294 | ||
1295 | len = spec.field_width < 0 ? 1 : spec.field_width; | |
1296 | ||
41416f23 RV |
1297 | /* |
1298 | * string_escape_mem() writes as many characters as it can to | |
1299 | * the given buffer, and returns the total size of the output | |
1300 | * had the buffer been big enough. | |
1301 | */ | |
1302 | buf += string_escape_mem(addr, len, buf, buf < end ? end - buf : 0, flags, NULL); | |
71dca95d AS |
1303 | |
1304 | return buf; | |
1305 | } | |
1306 | ||
cf3b429b JP |
1307 | static noinline_for_stack |
1308 | char *uuid_string(char *buf, char *end, const u8 *addr, | |
1309 | struct printf_spec spec, const char *fmt) | |
9ac6e44e | 1310 | { |
2b1b0d66 | 1311 | char uuid[UUID_STRING_LEN + 1]; |
9ac6e44e JP |
1312 | char *p = uuid; |
1313 | int i; | |
f9727a17 | 1314 | const u8 *index = uuid_index; |
9ac6e44e JP |
1315 | bool uc = false; |
1316 | ||
1317 | switch (*(++fmt)) { | |
1318 | case 'L': | |
1319 | uc = true; /* fall-through */ | |
1320 | case 'l': | |
f9727a17 | 1321 | index = guid_index; |
9ac6e44e JP |
1322 | break; |
1323 | case 'B': | |
1324 | uc = true; | |
1325 | break; | |
1326 | } | |
1327 | ||
1328 | for (i = 0; i < 16; i++) { | |
aa4ea1c3 AS |
1329 | if (uc) |
1330 | p = hex_byte_pack_upper(p, addr[index[i]]); | |
1331 | else | |
1332 | p = hex_byte_pack(p, addr[index[i]]); | |
9ac6e44e JP |
1333 | switch (i) { |
1334 | case 3: | |
1335 | case 5: | |
1336 | case 7: | |
1337 | case 9: | |
1338 | *p++ = '-'; | |
1339 | break; | |
1340 | } | |
1341 | } | |
1342 | ||
1343 | *p = 0; | |
1344 | ||
9ac6e44e JP |
1345 | return string(buf, end, uuid, spec); |
1346 | } | |
1347 | ||
57e73442 TH |
1348 | int kptr_restrict __read_mostly; |
1349 | ||
1350 | static noinline_for_stack | |
1351 | char *restricted_pointer(char *buf, char *end, const void *ptr, | |
1352 | struct printf_spec spec) | |
1353 | { | |
1354 | spec.base = 16; | |
1355 | spec.flags |= SMALL; | |
1356 | if (spec.field_width == -1) { | |
1357 | spec.field_width = 2 * sizeof(ptr); | |
1358 | spec.flags |= ZEROPAD; | |
1359 | } | |
1360 | ||
1361 | switch (kptr_restrict) { | |
1362 | case 0: | |
1363 | /* Always print %pK values */ | |
1364 | break; | |
1365 | case 1: { | |
1366 | const struct cred *cred; | |
1367 | ||
1368 | /* | |
1369 | * kptr_restrict==1 cannot be used in IRQ context | |
1370 | * because its test for CAP_SYSLOG would be meaningless. | |
1371 | */ | |
1372 | if (in_irq() || in_serving_softirq() || in_nmi()) | |
1373 | return string(buf, end, "pK-error", spec); | |
1374 | ||
1375 | /* | |
1376 | * Only print the real pointer value if the current | |
1377 | * process has CAP_SYSLOG and is running with the | |
1378 | * same credentials it started with. This is because | |
1379 | * access to files is checked at open() time, but %pK | |
1380 | * checks permission at read() time. We don't want to | |
1381 | * leak pointer values if a binary opens a file using | |
1382 | * %pK and then elevates privileges before reading it. | |
1383 | */ | |
1384 | cred = current_cred(); | |
1385 | if (!has_capability_noaudit(current, CAP_SYSLOG) || | |
1386 | !uid_eq(cred->euid, cred->uid) || | |
1387 | !gid_eq(cred->egid, cred->gid)) | |
1388 | ptr = NULL; | |
1389 | break; | |
1390 | } | |
1391 | case 2: | |
1392 | default: | |
1393 | /* Always print 0's for %pK */ | |
1394 | ptr = NULL; | |
1395 | break; | |
1396 | } | |
1397 | ||
1398 | return number(buf, end, (unsigned long)ptr, spec); | |
1399 | } | |
1400 | ||
5b17aecf AS |
1401 | static noinline_for_stack |
1402 | char *netdev_bits(char *buf, char *end, const void *addr, const char *fmt) | |
c8f44aff | 1403 | { |
5b17aecf AS |
1404 | unsigned long long num; |
1405 | int size; | |
1406 | ||
1407 | switch (fmt[1]) { | |
1408 | case 'F': | |
1409 | num = *(const netdev_features_t *)addr; | |
1410 | size = sizeof(netdev_features_t); | |
1411 | break; | |
1412 | default: | |
1413 | num = (unsigned long)addr; | |
1414 | size = sizeof(unsigned long); | |
1415 | break; | |
1416 | } | |
c8f44aff | 1417 | |
3cab1e71 | 1418 | return special_hex_number(buf, end, num, size); |
c8f44aff MM |
1419 | } |
1420 | ||
aaf07621 | 1421 | static noinline_for_stack |
3cab1e71 | 1422 | char *address_val(char *buf, char *end, const void *addr, const char *fmt) |
aaf07621 JP |
1423 | { |
1424 | unsigned long long num; | |
3cab1e71 | 1425 | int size; |
aaf07621 JP |
1426 | |
1427 | switch (fmt[1]) { | |
1428 | case 'd': | |
1429 | num = *(const dma_addr_t *)addr; | |
3cab1e71 | 1430 | size = sizeof(dma_addr_t); |
aaf07621 JP |
1431 | break; |
1432 | case 'p': | |
1433 | default: | |
1434 | num = *(const phys_addr_t *)addr; | |
3cab1e71 | 1435 | size = sizeof(phys_addr_t); |
aaf07621 JP |
1436 | break; |
1437 | } | |
1438 | ||
3cab1e71 | 1439 | return special_hex_number(buf, end, num, size); |
aaf07621 JP |
1440 | } |
1441 | ||
900cca29 GU |
1442 | static noinline_for_stack |
1443 | char *clock(char *buf, char *end, struct clk *clk, struct printf_spec spec, | |
1444 | const char *fmt) | |
1445 | { | |
1446 | if (!IS_ENABLED(CONFIG_HAVE_CLK) || !clk) | |
1447 | return string(buf, end, NULL, spec); | |
1448 | ||
1449 | switch (fmt[1]) { | |
1450 | case 'r': | |
1451 | return number(buf, end, clk_get_rate(clk), spec); | |
1452 | ||
1453 | case 'n': | |
1454 | default: | |
1455 | #ifdef CONFIG_COMMON_CLK | |
1456 | return string(buf, end, __clk_get_name(clk), spec); | |
1457 | #else | |
3cab1e71 | 1458 | return special_hex_number(buf, end, (unsigned long)clk, sizeof(unsigned long)); |
900cca29 GU |
1459 | #endif |
1460 | } | |
1461 | } | |
1462 | ||
edf14cdb VB |
1463 | static |
1464 | char *format_flags(char *buf, char *end, unsigned long flags, | |
1465 | const struct trace_print_flags *names) | |
1466 | { | |
1467 | unsigned long mask; | |
1468 | const struct printf_spec strspec = { | |
1469 | .field_width = -1, | |
1470 | .precision = -1, | |
1471 | }; | |
1472 | const struct printf_spec numspec = { | |
1473 | .flags = SPECIAL|SMALL, | |
1474 | .field_width = -1, | |
1475 | .precision = -1, | |
1476 | .base = 16, | |
1477 | }; | |
1478 | ||
1479 | for ( ; flags && names->name; names++) { | |
1480 | mask = names->mask; | |
1481 | if ((flags & mask) != mask) | |
1482 | continue; | |
1483 | ||
1484 | buf = string(buf, end, names->name, strspec); | |
1485 | ||
1486 | flags &= ~mask; | |
1487 | if (flags) { | |
1488 | if (buf < end) | |
1489 | *buf = '|'; | |
1490 | buf++; | |
1491 | } | |
1492 | } | |
1493 | ||
1494 | if (flags) | |
1495 | buf = number(buf, end, flags, numspec); | |
1496 | ||
1497 | return buf; | |
1498 | } | |
1499 | ||
1500 | static noinline_for_stack | |
1501 | char *flags_string(char *buf, char *end, void *flags_ptr, const char *fmt) | |
1502 | { | |
1503 | unsigned long flags; | |
1504 | const struct trace_print_flags *names; | |
1505 | ||
1506 | switch (fmt[1]) { | |
1507 | case 'p': | |
1508 | flags = *(unsigned long *)flags_ptr; | |
1509 | /* Remove zone id */ | |
1510 | flags &= (1UL << NR_PAGEFLAGS) - 1; | |
1511 | names = pageflag_names; | |
1512 | break; | |
1513 | case 'v': | |
1514 | flags = *(unsigned long *)flags_ptr; | |
1515 | names = vmaflag_names; | |
1516 | break; | |
1517 | case 'g': | |
1518 | flags = *(gfp_t *)flags_ptr; | |
1519 | names = gfpflag_names; | |
1520 | break; | |
1521 | default: | |
1522 | WARN_ONCE(1, "Unsupported flags modifier: %c\n", fmt[1]); | |
1523 | return buf; | |
1524 | } | |
1525 | ||
1526 | return format_flags(buf, end, flags, names); | |
1527 | } | |
1528 | ||
ce4fecf1 PA |
1529 | static const char *device_node_name_for_depth(const struct device_node *np, int depth) |
1530 | { | |
1531 | for ( ; np && depth; depth--) | |
1532 | np = np->parent; | |
1533 | ||
1534 | return kbasename(np->full_name); | |
1535 | } | |
1536 | ||
1537 | static noinline_for_stack | |
1538 | char *device_node_gen_full_name(const struct device_node *np, char *buf, char *end) | |
1539 | { | |
1540 | int depth; | |
1541 | const struct device_node *parent = np->parent; | |
1542 | static const struct printf_spec strspec = { | |
1543 | .field_width = -1, | |
1544 | .precision = -1, | |
1545 | }; | |
1546 | ||
1547 | /* special case for root node */ | |
1548 | if (!parent) | |
1549 | return string(buf, end, "/", strspec); | |
1550 | ||
1551 | for (depth = 0; parent->parent; depth++) | |
1552 | parent = parent->parent; | |
1553 | ||
1554 | for ( ; depth >= 0; depth--) { | |
1555 | buf = string(buf, end, "/", strspec); | |
1556 | buf = string(buf, end, device_node_name_for_depth(np, depth), | |
1557 | strspec); | |
1558 | } | |
1559 | return buf; | |
1560 | } | |
1561 | ||
1562 | static noinline_for_stack | |
1563 | char *device_node_string(char *buf, char *end, struct device_node *dn, | |
1564 | struct printf_spec spec, const char *fmt) | |
1565 | { | |
1566 | char tbuf[sizeof("xxxx") + 1]; | |
1567 | const char *p; | |
1568 | int ret; | |
1569 | char *buf_start = buf; | |
1570 | struct property *prop; | |
1571 | bool has_mult, pass; | |
1572 | static const struct printf_spec num_spec = { | |
1573 | .flags = SMALL, | |
1574 | .field_width = -1, | |
1575 | .precision = -1, | |
1576 | .base = 10, | |
1577 | }; | |
1578 | ||
1579 | struct printf_spec str_spec = spec; | |
1580 | str_spec.field_width = -1; | |
1581 | ||
1582 | if (!IS_ENABLED(CONFIG_OF)) | |
1583 | return string(buf, end, "(!OF)", spec); | |
1584 | ||
1585 | if ((unsigned long)dn < PAGE_SIZE) | |
1586 | return string(buf, end, "(null)", spec); | |
1587 | ||
1588 | /* simple case without anything any more format specifiers */ | |
1589 | fmt++; | |
1590 | if (fmt[0] == '\0' || strcspn(fmt,"fnpPFcC") > 0) | |
1591 | fmt = "f"; | |
1592 | ||
1593 | for (pass = false; strspn(fmt,"fnpPFcC"); fmt++, pass = true) { | |
1594 | if (pass) { | |
1595 | if (buf < end) | |
1596 | *buf = ':'; | |
1597 | buf++; | |
1598 | } | |
1599 | ||
1600 | switch (*fmt) { | |
1601 | case 'f': /* full_name */ | |
1602 | buf = device_node_gen_full_name(dn, buf, end); | |
1603 | break; | |
1604 | case 'n': /* name */ | |
1605 | buf = string(buf, end, dn->name, str_spec); | |
1606 | break; | |
1607 | case 'p': /* phandle */ | |
1608 | buf = number(buf, end, (unsigned int)dn->phandle, num_spec); | |
1609 | break; | |
1610 | case 'P': /* path-spec */ | |
1611 | p = kbasename(of_node_full_name(dn)); | |
1612 | if (!p[1]) | |
1613 | p = "/"; | |
1614 | buf = string(buf, end, p, str_spec); | |
1615 | break; | |
1616 | case 'F': /* flags */ | |
1617 | tbuf[0] = of_node_check_flag(dn, OF_DYNAMIC) ? 'D' : '-'; | |
1618 | tbuf[1] = of_node_check_flag(dn, OF_DETACHED) ? 'd' : '-'; | |
1619 | tbuf[2] = of_node_check_flag(dn, OF_POPULATED) ? 'P' : '-'; | |
1620 | tbuf[3] = of_node_check_flag(dn, OF_POPULATED_BUS) ? 'B' : '-'; | |
1621 | tbuf[4] = 0; | |
1622 | buf = string(buf, end, tbuf, str_spec); | |
1623 | break; | |
1624 | case 'c': /* major compatible string */ | |
1625 | ret = of_property_read_string(dn, "compatible", &p); | |
1626 | if (!ret) | |
1627 | buf = string(buf, end, p, str_spec); | |
1628 | break; | |
1629 | case 'C': /* full compatible string */ | |
1630 | has_mult = false; | |
1631 | of_property_for_each_string(dn, "compatible", prop, p) { | |
1632 | if (has_mult) | |
1633 | buf = string(buf, end, ",", str_spec); | |
1634 | buf = string(buf, end, "\"", str_spec); | |
1635 | buf = string(buf, end, p, str_spec); | |
1636 | buf = string(buf, end, "\"", str_spec); | |
1637 | ||
1638 | has_mult = true; | |
1639 | } | |
1640 | break; | |
1641 | default: | |
1642 | break; | |
1643 | } | |
1644 | } | |
1645 | ||
1646 | return widen_string(buf, buf - buf_start, end, spec); | |
1647 | } | |
1648 | ||
7b1924a1 TH |
1649 | static noinline_for_stack |
1650 | char *pointer_string(char *buf, char *end, const void *ptr, | |
1651 | struct printf_spec spec) | |
1652 | { | |
1653 | spec.base = 16; | |
1654 | spec.flags |= SMALL; | |
1655 | if (spec.field_width == -1) { | |
1656 | spec.field_width = 2 * sizeof(ptr); | |
1657 | spec.flags |= ZEROPAD; | |
1658 | } | |
1659 | ||
1660 | return number(buf, end, (unsigned long int)ptr, spec); | |
1661 | } | |
1662 | ||
ad67b74d TH |
1663 | static bool have_filled_random_ptr_key __read_mostly; |
1664 | static siphash_key_t ptr_key __read_mostly; | |
1665 | ||
1666 | static void fill_random_ptr_key(struct random_ready_callback *unused) | |
1667 | { | |
1668 | get_random_bytes(&ptr_key, sizeof(ptr_key)); | |
1669 | /* | |
1670 | * have_filled_random_ptr_key==true is dependent on get_random_bytes(). | |
1671 | * ptr_to_id() needs to see have_filled_random_ptr_key==true | |
1672 | * after get_random_bytes() returns. | |
1673 | */ | |
1674 | smp_mb(); | |
1675 | WRITE_ONCE(have_filled_random_ptr_key, true); | |
1676 | } | |
1677 | ||
1678 | static struct random_ready_callback random_ready = { | |
1679 | .func = fill_random_ptr_key | |
1680 | }; | |
1681 | ||
1682 | static int __init initialize_ptr_random(void) | |
1683 | { | |
1684 | int ret = add_random_ready_callback(&random_ready); | |
1685 | ||
1686 | if (!ret) { | |
1687 | return 0; | |
1688 | } else if (ret == -EALREADY) { | |
1689 | fill_random_ptr_key(&random_ready); | |
1690 | return 0; | |
1691 | } | |
1692 | ||
1693 | return ret; | |
1694 | } | |
1695 | early_initcall(initialize_ptr_random); | |
1696 | ||
1697 | /* Maps a pointer to a 32 bit unique identifier. */ | |
1698 | static char *ptr_to_id(char *buf, char *end, void *ptr, struct printf_spec spec) | |
1699 | { | |
1700 | unsigned long hashval; | |
1701 | const int default_width = 2 * sizeof(ptr); | |
1702 | ||
1703 | if (unlikely(!have_filled_random_ptr_key)) { | |
1704 | spec.field_width = default_width; | |
1705 | /* string length must be less than default_width */ | |
1706 | return string(buf, end, "(ptrval)", spec); | |
1707 | } | |
1708 | ||
1709 | #ifdef CONFIG_64BIT | |
1710 | hashval = (unsigned long)siphash_1u64((u64)ptr, &ptr_key); | |
1711 | /* | |
1712 | * Mask off the first 32 bits, this makes explicit that we have | |
1713 | * modified the address (and 32 bits is plenty for a unique ID). | |
1714 | */ | |
1715 | hashval = hashval & 0xffffffff; | |
1716 | #else | |
1717 | hashval = (unsigned long)siphash_1u32((u32)ptr, &ptr_key); | |
1718 | #endif | |
1719 | ||
1720 | spec.flags |= SMALL; | |
1721 | if (spec.field_width == -1) { | |
1722 | spec.field_width = default_width; | |
1723 | spec.flags |= ZEROPAD; | |
1724 | } | |
1725 | spec.base = 16; | |
1726 | ||
1727 | return number(buf, end, hashval, spec); | |
1728 | } | |
1729 | ||
4d8a743c LT |
1730 | /* |
1731 | * Show a '%p' thing. A kernel extension is that the '%p' is followed | |
1732 | * by an extra set of alphanumeric characters that are extended format | |
1733 | * specifiers. | |
1734 | * | |
0b523769 JP |
1735 | * Please update scripts/checkpatch.pl when adding/removing conversion |
1736 | * characters. (Search for "check for vsprintf extension"). | |
1737 | * | |
332d2e78 LT |
1738 | * Right now we handle: |
1739 | * | |
0c8b946e FW |
1740 | * - 'F' For symbolic function descriptor pointers with offset |
1741 | * - 'f' For simple symbolic function names without offset | |
0efb4d20 SR |
1742 | * - 'S' For symbolic direct pointers with offset |
1743 | * - 's' For symbolic direct pointers without offset | |
b0d33c2b | 1744 | * - '[FfSs]R' as above with __builtin_extract_return_addr() translation |
0f77a8d3 | 1745 | * - 'B' For backtraced symbolic direct pointers with offset |
c7dabef8 BH |
1746 | * - 'R' For decoded struct resource, e.g., [mem 0x0-0x1f 64bit pref] |
1747 | * - 'r' For raw struct resource, e.g., [mem 0x0-0x1f flags 0x201] | |
dbc760bc TH |
1748 | * - 'b[l]' For a bitmap, the number of bits is determined by the field |
1749 | * width which must be explicitly specified either as part of the | |
1750 | * format string '%32b[l]' or through '%*b[l]', [l] selects | |
1751 | * range-list format instead of hex format | |
dd45c9cf HH |
1752 | * - 'M' For a 6-byte MAC address, it prints the address in the |
1753 | * usual colon-separated hex notation | |
8a27f7c9 | 1754 | * - 'm' For a 6-byte MAC address, it prints the hex address without colons |
bc7259a2 | 1755 | * - 'MF' For a 6-byte MAC FDDI address, it prints the address |
c8e00060 | 1756 | * with a dash-separated hex notation |
7c59154e | 1757 | * - '[mM]R' For a 6-byte MAC address, Reverse order (Bluetooth) |
8a27f7c9 JP |
1758 | * - 'I' [46] for IPv4/IPv6 addresses printed in the usual way |
1759 | * IPv4 uses dot-separated decimal without leading 0's (1.2.3.4) | |
1760 | * IPv6 uses colon separated network-order 16 bit hex with leading 0's | |
10679643 DB |
1761 | * [S][pfs] |
1762 | * Generic IPv4/IPv6 address (struct sockaddr *) that falls back to | |
1763 | * [4] or [6] and is able to print port [p], flowinfo [f], scope [s] | |
8a27f7c9 JP |
1764 | * - 'i' [46] for 'raw' IPv4/IPv6 addresses |
1765 | * IPv6 omits the colons (01020304...0f) | |
1766 | * IPv4 uses dot-separated decimal with leading 0's (010.123.045.006) | |
10679643 DB |
1767 | * [S][pfs] |
1768 | * Generic IPv4/IPv6 address (struct sockaddr *) that falls back to | |
1769 | * [4] or [6] and is able to print port [p], flowinfo [f], scope [s] | |
1770 | * - '[Ii][4S][hnbl]' IPv4 addresses in host, network, big or little endian order | |
1771 | * - 'I[6S]c' for IPv6 addresses printed as specified by | |
29cf519e | 1772 | * http://tools.ietf.org/html/rfc5952 |
71dca95d AS |
1773 | * - 'E[achnops]' For an escaped buffer, where rules are defined by combination |
1774 | * of the following flags (see string_escape_mem() for the | |
1775 | * details): | |
1776 | * a - ESCAPE_ANY | |
1777 | * c - ESCAPE_SPECIAL | |
1778 | * h - ESCAPE_HEX | |
1779 | * n - ESCAPE_NULL | |
1780 | * o - ESCAPE_OCTAL | |
1781 | * p - ESCAPE_NP | |
1782 | * s - ESCAPE_SPACE | |
1783 | * By default ESCAPE_ANY_NP is used. | |
9ac6e44e JP |
1784 | * - 'U' For a 16 byte UUID/GUID, it prints the UUID/GUID in the form |
1785 | * "xxxxxxxx-xxxx-xxxx-xxxx-xxxxxxxxxxxx" | |
1786 | * Options for %pU are: | |
1787 | * b big endian lower case hex (default) | |
1788 | * B big endian UPPER case hex | |
1789 | * l little endian lower case hex | |
1790 | * L little endian UPPER case hex | |
1791 | * big endian output byte order is: | |
1792 | * [0][1][2][3]-[4][5]-[6][7]-[8][9]-[10][11][12][13][14][15] | |
1793 | * little endian output byte order is: | |
1794 | * [3][2][1][0]-[5][4]-[7][6]-[8][9]-[10][11][12][13][14][15] | |
7db6f5fb JP |
1795 | * - 'V' For a struct va_format which contains a format string * and va_list *, |
1796 | * call vsnprintf(->format, *->va_list). | |
1797 | * Implements a "recursive vsnprintf". | |
1798 | * Do not use this feature without some mechanism to verify the | |
1799 | * correctness of the format string and va_list arguments. | |
455cd5ab | 1800 | * - 'K' For a kernel pointer that should be hidden from unprivileged users |
c8f44aff | 1801 | * - 'NF' For a netdev_features_t |
31550a16 AS |
1802 | * - 'h[CDN]' For a variable-length buffer, it prints it as a hex string with |
1803 | * a certain separator (' ' by default): | |
1804 | * C colon | |
1805 | * D dash | |
1806 | * N no separator | |
1807 | * The maximum supported length is 64 bytes of the input. Consider | |
1808 | * to use print_hex_dump() for the larger input. | |
aaf07621 JP |
1809 | * - 'a[pd]' For address types [p] phys_addr_t, [d] dma_addr_t and derivatives |
1810 | * (default assumed to be phys_addr_t, passed by reference) | |
c0d92a57 OJ |
1811 | * - 'd[234]' For a dentry name (optionally 2-4 last components) |
1812 | * - 'D[234]' Same as 'd' but for a struct file | |
1031bc58 | 1813 | * - 'g' For block_device name (gendisk + partition number) |
900cca29 GU |
1814 | * - 'C' For a clock, it prints the name (Common Clock Framework) or address |
1815 | * (legacy clock framework) of the clock | |
1816 | * - 'Cn' For a clock, it prints the name (Common Clock Framework) or address | |
1817 | * (legacy clock framework) of the clock | |
1818 | * - 'Cr' For a clock, it prints the current rate of the clock | |
edf14cdb VB |
1819 | * - 'G' For flags to be printed as a collection of symbolic strings that would |
1820 | * construct the specific value. Supported flags given by option: | |
1821 | * p page flags (see struct page) given as pointer to unsigned long | |
1822 | * g gfp flags (GFP_* and __GFP_*) given as pointer to gfp_t | |
1823 | * v vma flags (VM_*) given as pointer to unsigned long | |
ce4fecf1 PA |
1824 | * - 'O' For a kobject based struct. Must be one of the following: |
1825 | * - 'OF[fnpPcCF]' For a device tree object | |
1826 | * Without any optional arguments prints the full_name | |
1827 | * f device node full_name | |
1828 | * n device node name | |
1829 | * p device node phandle | |
1830 | * P device node path spec (name + @unit) | |
1831 | * F device node flags | |
1832 | * c major compatible string | |
1833 | * C full compatible string | |
5e4ee7b1 | 1834 | * |
7b1924a1 TH |
1835 | * - 'x' For printing the address. Equivalent to "%lx". |
1836 | * | |
5e4ee7b1 | 1837 | * ** Please update also Documentation/printk-formats.txt when making changes ** |
9ac6e44e | 1838 | * |
332d2e78 LT |
1839 | * Note: The difference between 'S' and 'F' is that on ia64 and ppc64 |
1840 | * function pointers are really function descriptors, which contain a | |
1841 | * pointer to the real address. | |
ad67b74d TH |
1842 | * |
1843 | * Note: The default behaviour (unadorned %p) is to hash the address, | |
1844 | * rendering it useful as a unique identifier. | |
4d8a743c | 1845 | */ |
cf3b429b JP |
1846 | static noinline_for_stack |
1847 | char *pointer(const char *fmt, char *buf, char *end, void *ptr, | |
1848 | struct printf_spec spec) | |
78a8bf69 | 1849 | { |
80c9eb46 | 1850 | const int default_width = 2 * sizeof(void *); |
725fe002 | 1851 | |
9f36e2c4 | 1852 | if (!ptr && *fmt != 'K') { |
5e057981 JP |
1853 | /* |
1854 | * Print (null) with the same width as a pointer so it makes | |
1855 | * tabular output look nice. | |
1856 | */ | |
1857 | if (spec.field_width == -1) | |
725fe002 | 1858 | spec.field_width = default_width; |
fef20d9c | 1859 | return string(buf, end, "(null)", spec); |
5e057981 | 1860 | } |
d97106ab | 1861 | |
0fe1ef24 LT |
1862 | switch (*fmt) { |
1863 | case 'F': | |
0c8b946e | 1864 | case 'f': |
0fe1ef24 LT |
1865 | ptr = dereference_function_descriptor(ptr); |
1866 | /* Fallthrough */ | |
1867 | case 'S': | |
9ac6e44e | 1868 | case 's': |
0f77a8d3 | 1869 | case 'B': |
b0d33c2b | 1870 | return symbol_string(buf, end, ptr, spec, fmt); |
332d2e78 | 1871 | case 'R': |
c7dabef8 | 1872 | case 'r': |
fd95541e | 1873 | return resource_string(buf, end, ptr, spec, fmt); |
31550a16 AS |
1874 | case 'h': |
1875 | return hex_string(buf, end, ptr, spec, fmt); | |
dbc760bc TH |
1876 | case 'b': |
1877 | switch (fmt[1]) { | |
1878 | case 'l': | |
1879 | return bitmap_list_string(buf, end, ptr, spec, fmt); | |
1880 | default: | |
1881 | return bitmap_string(buf, end, ptr, spec, fmt); | |
1882 | } | |
8a27f7c9 JP |
1883 | case 'M': /* Colon separated: 00:01:02:03:04:05 */ |
1884 | case 'm': /* Contiguous: 000102030405 */ | |
76597ff9 AE |
1885 | /* [mM]F (FDDI) */ |
1886 | /* [mM]R (Reverse order; Bluetooth) */ | |
8a27f7c9 JP |
1887 | return mac_address_string(buf, end, ptr, spec, fmt); |
1888 | case 'I': /* Formatted IP supported | |
1889 | * 4: 1.2.3.4 | |
1890 | * 6: 0001:0203:...:0708 | |
1891 | * 6c: 1::708 or 1::1.2.3.4 | |
1892 | */ | |
1893 | case 'i': /* Contiguous: | |
1894 | * 4: 001.002.003.004 | |
1895 | * 6: 000102...0f | |
1896 | */ | |
1897 | switch (fmt[1]) { | |
1898 | case '6': | |
1899 | return ip6_addr_string(buf, end, ptr, spec, fmt); | |
1900 | case '4': | |
1901 | return ip4_addr_string(buf, end, ptr, spec, fmt); | |
10679643 DB |
1902 | case 'S': { |
1903 | const union { | |
1904 | struct sockaddr raw; | |
1905 | struct sockaddr_in v4; | |
1906 | struct sockaddr_in6 v6; | |
1907 | } *sa = ptr; | |
1908 | ||
1909 | switch (sa->raw.sa_family) { | |
1910 | case AF_INET: | |
1911 | return ip4_addr_string_sa(buf, end, &sa->v4, spec, fmt); | |
1912 | case AF_INET6: | |
1913 | return ip6_addr_string_sa(buf, end, &sa->v6, spec, fmt); | |
1914 | default: | |
1915 | return string(buf, end, "(invalid address)", spec); | |
1916 | }} | |
8a27f7c9 | 1917 | } |
fef20d9c | 1918 | break; |
71dca95d AS |
1919 | case 'E': |
1920 | return escaped_string(buf, end, ptr, spec, fmt); | |
9ac6e44e JP |
1921 | case 'U': |
1922 | return uuid_string(buf, end, ptr, spec, fmt); | |
7db6f5fb | 1923 | case 'V': |
5756b76e JB |
1924 | { |
1925 | va_list va; | |
1926 | ||
1927 | va_copy(va, *((struct va_format *)ptr)->va); | |
1928 | buf += vsnprintf(buf, end > buf ? end - buf : 0, | |
1929 | ((struct va_format *)ptr)->fmt, va); | |
1930 | va_end(va); | |
1931 | return buf; | |
1932 | } | |
455cd5ab | 1933 | case 'K': |
ef0010a3 LT |
1934 | if (!kptr_restrict) |
1935 | break; | |
57e73442 | 1936 | return restricted_pointer(buf, end, ptr, spec); |
c8f44aff | 1937 | case 'N': |
5b17aecf | 1938 | return netdev_bits(buf, end, ptr, fmt); |
7d799210 | 1939 | case 'a': |
3cab1e71 | 1940 | return address_val(buf, end, ptr, fmt); |
4b6ccca7 AV |
1941 | case 'd': |
1942 | return dentry_name(buf, end, ptr, spec, fmt); | |
900cca29 GU |
1943 | case 'C': |
1944 | return clock(buf, end, ptr, spec, fmt); | |
4b6ccca7 AV |
1945 | case 'D': |
1946 | return dentry_name(buf, end, | |
1947 | ((const struct file *)ptr)->f_path.dentry, | |
1948 | spec, fmt); | |
1031bc58 DM |
1949 | #ifdef CONFIG_BLOCK |
1950 | case 'g': | |
1951 | return bdev_name(buf, end, ptr, spec, fmt); | |
1952 | #endif | |
1953 | ||
edf14cdb VB |
1954 | case 'G': |
1955 | return flags_string(buf, end, ptr, fmt); | |
ce4fecf1 PA |
1956 | case 'O': |
1957 | switch (fmt[1]) { | |
1958 | case 'F': | |
1959 | return device_node_string(buf, end, ptr, spec, fmt + 1); | |
1960 | } | |
7b1924a1 TH |
1961 | case 'x': |
1962 | return pointer_string(buf, end, ptr, spec); | |
fef20d9c | 1963 | } |
fef20d9c | 1964 | |
ad67b74d TH |
1965 | /* default is to _not_ leak addresses, hash before printing */ |
1966 | return ptr_to_id(buf, end, ptr, spec); | |
fef20d9c FW |
1967 | } |
1968 | ||
1969 | /* | |
1970 | * Helper function to decode printf style format. | |
1971 | * Each call decode a token from the format and return the | |
1972 | * number of characters read (or likely the delta where it wants | |
1973 | * to go on the next call). | |
1974 | * The decoded token is returned through the parameters | |
1975 | * | |
1976 | * 'h', 'l', or 'L' for integer fields | |
1977 | * 'z' support added 23/7/1999 S.H. | |
1978 | * 'z' changed to 'Z' --davidm 1/25/99 | |
5b5e0928 | 1979 | * 'Z' changed to 'z' --adobriyan 2017-01-25 |
fef20d9c FW |
1980 | * 't' added for ptrdiff_t |
1981 | * | |
1982 | * @fmt: the format string | |
1983 | * @type of the token returned | |
1984 | * @flags: various flags such as +, -, # tokens.. | |
1985 | * @field_width: overwritten width | |
1986 | * @base: base of the number (octal, hex, ...) | |
1987 | * @precision: precision of a number | |
1988 | * @qualifier: qualifier of a number (long, size_t, ...) | |
1989 | */ | |
cf3b429b JP |
1990 | static noinline_for_stack |
1991 | int format_decode(const char *fmt, struct printf_spec *spec) | |
fef20d9c FW |
1992 | { |
1993 | const char *start = fmt; | |
d0484193 | 1994 | char qualifier; |
fef20d9c FW |
1995 | |
1996 | /* we finished early by reading the field width */ | |
ed681a91 | 1997 | if (spec->type == FORMAT_TYPE_WIDTH) { |
fef20d9c FW |
1998 | if (spec->field_width < 0) { |
1999 | spec->field_width = -spec->field_width; | |
2000 | spec->flags |= LEFT; | |
2001 | } | |
2002 | spec->type = FORMAT_TYPE_NONE; | |
2003 | goto precision; | |
2004 | } | |
2005 | ||
2006 | /* we finished early by reading the precision */ | |
2007 | if (spec->type == FORMAT_TYPE_PRECISION) { | |
2008 | if (spec->precision < 0) | |
2009 | spec->precision = 0; | |
2010 | ||
2011 | spec->type = FORMAT_TYPE_NONE; | |
2012 | goto qualifier; | |
2013 | } | |
2014 | ||
2015 | /* By default */ | |
2016 | spec->type = FORMAT_TYPE_NONE; | |
2017 | ||
2018 | for (; *fmt ; ++fmt) { | |
2019 | if (*fmt == '%') | |
2020 | break; | |
2021 | } | |
2022 | ||
2023 | /* Return the current non-format string */ | |
2024 | if (fmt != start || !*fmt) | |
2025 | return fmt - start; | |
2026 | ||
2027 | /* Process flags */ | |
2028 | spec->flags = 0; | |
2029 | ||
2030 | while (1) { /* this also skips first '%' */ | |
2031 | bool found = true; | |
2032 | ||
2033 | ++fmt; | |
2034 | ||
2035 | switch (*fmt) { | |
2036 | case '-': spec->flags |= LEFT; break; | |
2037 | case '+': spec->flags |= PLUS; break; | |
2038 | case ' ': spec->flags |= SPACE; break; | |
2039 | case '#': spec->flags |= SPECIAL; break; | |
2040 | case '0': spec->flags |= ZEROPAD; break; | |
2041 | default: found = false; | |
2042 | } | |
2043 | ||
2044 | if (!found) | |
2045 | break; | |
2046 | } | |
2047 | ||
2048 | /* get field width */ | |
2049 | spec->field_width = -1; | |
2050 | ||
2051 | if (isdigit(*fmt)) | |
2052 | spec->field_width = skip_atoi(&fmt); | |
2053 | else if (*fmt == '*') { | |
2054 | /* it's the next argument */ | |
ed681a91 | 2055 | spec->type = FORMAT_TYPE_WIDTH; |
fef20d9c FW |
2056 | return ++fmt - start; |
2057 | } | |
2058 | ||
2059 | precision: | |
2060 | /* get the precision */ | |
2061 | spec->precision = -1; | |
2062 | if (*fmt == '.') { | |
2063 | ++fmt; | |
2064 | if (isdigit(*fmt)) { | |
2065 | spec->precision = skip_atoi(&fmt); | |
2066 | if (spec->precision < 0) | |
2067 | spec->precision = 0; | |
2068 | } else if (*fmt == '*') { | |
2069 | /* it's the next argument */ | |
adf26f84 | 2070 | spec->type = FORMAT_TYPE_PRECISION; |
fef20d9c FW |
2071 | return ++fmt - start; |
2072 | } | |
2073 | } | |
2074 | ||
2075 | qualifier: | |
2076 | /* get the conversion qualifier */ | |
d0484193 | 2077 | qualifier = 0; |
75fb8f26 | 2078 | if (*fmt == 'h' || _tolower(*fmt) == 'l' || |
5b5e0928 | 2079 | *fmt == 'z' || *fmt == 't') { |
d0484193 RV |
2080 | qualifier = *fmt++; |
2081 | if (unlikely(qualifier == *fmt)) { | |
2082 | if (qualifier == 'l') { | |
2083 | qualifier = 'L'; | |
a4e94ef0 | 2084 | ++fmt; |
d0484193 RV |
2085 | } else if (qualifier == 'h') { |
2086 | qualifier = 'H'; | |
a4e94ef0 Z |
2087 | ++fmt; |
2088 | } | |
fef20d9c FW |
2089 | } |
2090 | } | |
2091 | ||
2092 | /* default base */ | |
2093 | spec->base = 10; | |
2094 | switch (*fmt) { | |
2095 | case 'c': | |
2096 | spec->type = FORMAT_TYPE_CHAR; | |
2097 | return ++fmt - start; | |
2098 | ||
2099 | case 's': | |
2100 | spec->type = FORMAT_TYPE_STR; | |
2101 | return ++fmt - start; | |
2102 | ||
2103 | case 'p': | |
2104 | spec->type = FORMAT_TYPE_PTR; | |
ffbfed03 | 2105 | return ++fmt - start; |
fef20d9c | 2106 | |
fef20d9c FW |
2107 | case '%': |
2108 | spec->type = FORMAT_TYPE_PERCENT_CHAR; | |
2109 | return ++fmt - start; | |
2110 | ||
2111 | /* integer number formats - set up the flags and "break" */ | |
2112 | case 'o': | |
2113 | spec->base = 8; | |
2114 | break; | |
2115 | ||
2116 | case 'x': | |
2117 | spec->flags |= SMALL; | |
2118 | ||
2119 | case 'X': | |
2120 | spec->base = 16; | |
2121 | break; | |
2122 | ||
2123 | case 'd': | |
2124 | case 'i': | |
39e874f8 | 2125 | spec->flags |= SIGN; |
fef20d9c | 2126 | case 'u': |
4aa99606 | 2127 | break; |
fef20d9c | 2128 | |
708d96fd RM |
2129 | case 'n': |
2130 | /* | |
b006f19b RV |
2131 | * Since %n poses a greater security risk than |
2132 | * utility, treat it as any other invalid or | |
2133 | * unsupported format specifier. | |
708d96fd | 2134 | */ |
708d96fd RM |
2135 | /* Fall-through */ |
2136 | ||
fef20d9c | 2137 | default: |
b006f19b | 2138 | WARN_ONCE(1, "Please remove unsupported %%%c in format string\n", *fmt); |
fef20d9c FW |
2139 | spec->type = FORMAT_TYPE_INVALID; |
2140 | return fmt - start; | |
0fe1ef24 | 2141 | } |
fef20d9c | 2142 | |
d0484193 | 2143 | if (qualifier == 'L') |
fef20d9c | 2144 | spec->type = FORMAT_TYPE_LONG_LONG; |
d0484193 | 2145 | else if (qualifier == 'l') { |
51be17df RV |
2146 | BUILD_BUG_ON(FORMAT_TYPE_ULONG + SIGN != FORMAT_TYPE_LONG); |
2147 | spec->type = FORMAT_TYPE_ULONG + (spec->flags & SIGN); | |
5b5e0928 | 2148 | } else if (qualifier == 'z') { |
fef20d9c | 2149 | spec->type = FORMAT_TYPE_SIZE_T; |
d0484193 | 2150 | } else if (qualifier == 't') { |
fef20d9c | 2151 | spec->type = FORMAT_TYPE_PTRDIFF; |
d0484193 | 2152 | } else if (qualifier == 'H') { |
51be17df RV |
2153 | BUILD_BUG_ON(FORMAT_TYPE_UBYTE + SIGN != FORMAT_TYPE_BYTE); |
2154 | spec->type = FORMAT_TYPE_UBYTE + (spec->flags & SIGN); | |
d0484193 | 2155 | } else if (qualifier == 'h') { |
51be17df RV |
2156 | BUILD_BUG_ON(FORMAT_TYPE_USHORT + SIGN != FORMAT_TYPE_SHORT); |
2157 | spec->type = FORMAT_TYPE_USHORT + (spec->flags & SIGN); | |
fef20d9c | 2158 | } else { |
51be17df RV |
2159 | BUILD_BUG_ON(FORMAT_TYPE_UINT + SIGN != FORMAT_TYPE_INT); |
2160 | spec->type = FORMAT_TYPE_UINT + (spec->flags & SIGN); | |
78a8bf69 | 2161 | } |
fef20d9c FW |
2162 | |
2163 | return ++fmt - start; | |
78a8bf69 LT |
2164 | } |
2165 | ||
4d72ba01 RV |
2166 | static void |
2167 | set_field_width(struct printf_spec *spec, int width) | |
2168 | { | |
2169 | spec->field_width = width; | |
2170 | if (WARN_ONCE(spec->field_width != width, "field width %d too large", width)) { | |
2171 | spec->field_width = clamp(width, -FIELD_WIDTH_MAX, FIELD_WIDTH_MAX); | |
2172 | } | |
2173 | } | |
2174 | ||
2175 | static void | |
2176 | set_precision(struct printf_spec *spec, int prec) | |
2177 | { | |
2178 | spec->precision = prec; | |
2179 | if (WARN_ONCE(spec->precision != prec, "precision %d too large", prec)) { | |
2180 | spec->precision = clamp(prec, 0, PRECISION_MAX); | |
2181 | } | |
2182 | } | |
2183 | ||
1da177e4 LT |
2184 | /** |
2185 | * vsnprintf - Format a string and place it in a buffer | |
2186 | * @buf: The buffer to place the result into | |
2187 | * @size: The size of the buffer, including the trailing null space | |
2188 | * @fmt: The format string to use | |
2189 | * @args: Arguments for the format string | |
2190 | * | |
d7ec9a05 RV |
2191 | * This function generally follows C99 vsnprintf, but has some |
2192 | * extensions and a few limitations: | |
2193 | * | |
6cc89134 MCC |
2194 | * - ``%n`` is unsupported |
2195 | * - ``%p*`` is handled by pointer() | |
5e4ee7b1 MK |
2196 | * |
2197 | * See pointer() or Documentation/printk-formats.txt for more | |
2198 | * extensive description. | |
20036fdc | 2199 | * |
6cc89134 | 2200 | * **Please update the documentation in both places when making changes** |
80f548e0 | 2201 | * |
1da177e4 LT |
2202 | * The return value is the number of characters which would |
2203 | * be generated for the given input, excluding the trailing | |
2204 | * '\0', as per ISO C99. If you want to have the exact | |
2205 | * number of characters written into @buf as return value | |
72fd4a35 | 2206 | * (not including the trailing '\0'), use vscnprintf(). If the |
1da177e4 LT |
2207 | * return is greater than or equal to @size, the resulting |
2208 | * string is truncated. | |
2209 | * | |
ba1835eb | 2210 | * If you're not already dealing with a va_list consider using snprintf(). |
1da177e4 LT |
2211 | */ |
2212 | int vsnprintf(char *buf, size_t size, const char *fmt, va_list args) | |
2213 | { | |
1da177e4 | 2214 | unsigned long long num; |
d4be151b | 2215 | char *str, *end; |
fef20d9c | 2216 | struct printf_spec spec = {0}; |
1da177e4 | 2217 | |
f796937a JF |
2218 | /* Reject out-of-range values early. Large positive sizes are |
2219 | used for unknown buffer sizes. */ | |
2aa2f9e2 | 2220 | if (WARN_ON_ONCE(size > INT_MAX)) |
1da177e4 | 2221 | return 0; |
1da177e4 LT |
2222 | |
2223 | str = buf; | |
f796937a | 2224 | end = buf + size; |
1da177e4 | 2225 | |
f796937a JF |
2226 | /* Make sure end is always >= buf */ |
2227 | if (end < buf) { | |
2228 | end = ((void *)-1); | |
2229 | size = end - buf; | |
1da177e4 LT |
2230 | } |
2231 | ||
fef20d9c FW |
2232 | while (*fmt) { |
2233 | const char *old_fmt = fmt; | |
d4be151b | 2234 | int read = format_decode(fmt, &spec); |
1da177e4 | 2235 | |
fef20d9c | 2236 | fmt += read; |
1da177e4 | 2237 | |
fef20d9c FW |
2238 | switch (spec.type) { |
2239 | case FORMAT_TYPE_NONE: { | |
2240 | int copy = read; | |
2241 | if (str < end) { | |
2242 | if (copy > end - str) | |
2243 | copy = end - str; | |
2244 | memcpy(str, old_fmt, copy); | |
1da177e4 | 2245 | } |
fef20d9c FW |
2246 | str += read; |
2247 | break; | |
1da177e4 LT |
2248 | } |
2249 | ||
ed681a91 | 2250 | case FORMAT_TYPE_WIDTH: |
4d72ba01 | 2251 | set_field_width(&spec, va_arg(args, int)); |
fef20d9c | 2252 | break; |
1da177e4 | 2253 | |
fef20d9c | 2254 | case FORMAT_TYPE_PRECISION: |
4d72ba01 | 2255 | set_precision(&spec, va_arg(args, int)); |
fef20d9c | 2256 | break; |
1da177e4 | 2257 | |
d4be151b AGR |
2258 | case FORMAT_TYPE_CHAR: { |
2259 | char c; | |
2260 | ||
fef20d9c FW |
2261 | if (!(spec.flags & LEFT)) { |
2262 | while (--spec.field_width > 0) { | |
f796937a | 2263 | if (str < end) |
1da177e4 LT |
2264 | *str = ' '; |
2265 | ++str; | |
1da177e4 | 2266 | |
fef20d9c FW |
2267 | } |
2268 | } | |
2269 | c = (unsigned char) va_arg(args, int); | |
2270 | if (str < end) | |
2271 | *str = c; | |
2272 | ++str; | |
2273 | while (--spec.field_width > 0) { | |
f796937a | 2274 | if (str < end) |
fef20d9c | 2275 | *str = ' '; |
1da177e4 | 2276 | ++str; |
fef20d9c FW |
2277 | } |
2278 | break; | |
d4be151b | 2279 | } |
1da177e4 | 2280 | |
fef20d9c FW |
2281 | case FORMAT_TYPE_STR: |
2282 | str = string(str, end, va_arg(args, char *), spec); | |
2283 | break; | |
1da177e4 | 2284 | |
fef20d9c | 2285 | case FORMAT_TYPE_PTR: |
ffbfed03 | 2286 | str = pointer(fmt, str, end, va_arg(args, void *), |
fef20d9c FW |
2287 | spec); |
2288 | while (isalnum(*fmt)) | |
2289 | fmt++; | |
2290 | break; | |
1da177e4 | 2291 | |
fef20d9c FW |
2292 | case FORMAT_TYPE_PERCENT_CHAR: |
2293 | if (str < end) | |
2294 | *str = '%'; | |
2295 | ++str; | |
2296 | break; | |
1da177e4 | 2297 | |
fef20d9c | 2298 | case FORMAT_TYPE_INVALID: |
b006f19b RV |
2299 | /* |
2300 | * Presumably the arguments passed gcc's type | |
2301 | * checking, but there is no safe or sane way | |
2302 | * for us to continue parsing the format and | |
2303 | * fetching from the va_list; the remaining | |
2304 | * specifiers and arguments would be out of | |
2305 | * sync. | |
2306 | */ | |
2307 | goto out; | |
fef20d9c | 2308 | |
fef20d9c FW |
2309 | default: |
2310 | switch (spec.type) { | |
2311 | case FORMAT_TYPE_LONG_LONG: | |
2312 | num = va_arg(args, long long); | |
2313 | break; | |
2314 | case FORMAT_TYPE_ULONG: | |
2315 | num = va_arg(args, unsigned long); | |
2316 | break; | |
2317 | case FORMAT_TYPE_LONG: | |
2318 | num = va_arg(args, long); | |
2319 | break; | |
2320 | case FORMAT_TYPE_SIZE_T: | |
ef124960 JG |
2321 | if (spec.flags & SIGN) |
2322 | num = va_arg(args, ssize_t); | |
2323 | else | |
2324 | num = va_arg(args, size_t); | |
fef20d9c FW |
2325 | break; |
2326 | case FORMAT_TYPE_PTRDIFF: | |
2327 | num = va_arg(args, ptrdiff_t); | |
2328 | break; | |
a4e94ef0 Z |
2329 | case FORMAT_TYPE_UBYTE: |
2330 | num = (unsigned char) va_arg(args, int); | |
2331 | break; | |
2332 | case FORMAT_TYPE_BYTE: | |
2333 | num = (signed char) va_arg(args, int); | |
2334 | break; | |
fef20d9c FW |
2335 | case FORMAT_TYPE_USHORT: |
2336 | num = (unsigned short) va_arg(args, int); | |
2337 | break; | |
2338 | case FORMAT_TYPE_SHORT: | |
2339 | num = (short) va_arg(args, int); | |
2340 | break; | |
39e874f8 FW |
2341 | case FORMAT_TYPE_INT: |
2342 | num = (int) va_arg(args, int); | |
fef20d9c FW |
2343 | break; |
2344 | default: | |
2345 | num = va_arg(args, unsigned int); | |
2346 | } | |
2347 | ||
2348 | str = number(str, end, num, spec); | |
1da177e4 | 2349 | } |
1da177e4 | 2350 | } |
fef20d9c | 2351 | |
b006f19b | 2352 | out: |
f796937a JF |
2353 | if (size > 0) { |
2354 | if (str < end) | |
2355 | *str = '\0'; | |
2356 | else | |
0a6047ee | 2357 | end[-1] = '\0'; |
f796937a | 2358 | } |
fef20d9c | 2359 | |
f796937a | 2360 | /* the trailing null byte doesn't count towards the total */ |
1da177e4 | 2361 | return str-buf; |
fef20d9c | 2362 | |
1da177e4 | 2363 | } |
1da177e4 LT |
2364 | EXPORT_SYMBOL(vsnprintf); |
2365 | ||
2366 | /** | |
2367 | * vscnprintf - Format a string and place it in a buffer | |
2368 | * @buf: The buffer to place the result into | |
2369 | * @size: The size of the buffer, including the trailing null space | |
2370 | * @fmt: The format string to use | |
2371 | * @args: Arguments for the format string | |
2372 | * | |
2373 | * The return value is the number of characters which have been written into | |
b921c69f | 2374 | * the @buf not including the trailing '\0'. If @size is == 0 the function |
1da177e4 LT |
2375 | * returns 0. |
2376 | * | |
ba1835eb | 2377 | * If you're not already dealing with a va_list consider using scnprintf(). |
20036fdc AK |
2378 | * |
2379 | * See the vsnprintf() documentation for format string extensions over C99. | |
1da177e4 LT |
2380 | */ |
2381 | int vscnprintf(char *buf, size_t size, const char *fmt, va_list args) | |
2382 | { | |
2383 | int i; | |
2384 | ||
7b9186f5 AGR |
2385 | i = vsnprintf(buf, size, fmt, args); |
2386 | ||
b921c69f AA |
2387 | if (likely(i < size)) |
2388 | return i; | |
2389 | if (size != 0) | |
2390 | return size - 1; | |
2391 | return 0; | |
1da177e4 | 2392 | } |
1da177e4 LT |
2393 | EXPORT_SYMBOL(vscnprintf); |
2394 | ||
2395 | /** | |
2396 | * snprintf - Format a string and place it in a buffer | |
2397 | * @buf: The buffer to place the result into | |
2398 | * @size: The size of the buffer, including the trailing null space | |
2399 | * @fmt: The format string to use | |
2400 | * @...: Arguments for the format string | |
2401 | * | |
2402 | * The return value is the number of characters which would be | |
2403 | * generated for the given input, excluding the trailing null, | |
2404 | * as per ISO C99. If the return is greater than or equal to | |
2405 | * @size, the resulting string is truncated. | |
20036fdc AK |
2406 | * |
2407 | * See the vsnprintf() documentation for format string extensions over C99. | |
1da177e4 | 2408 | */ |
7b9186f5 | 2409 | int snprintf(char *buf, size_t size, const char *fmt, ...) |
1da177e4 LT |
2410 | { |
2411 | va_list args; | |
2412 | int i; | |
2413 | ||
2414 | va_start(args, fmt); | |
7b9186f5 | 2415 | i = vsnprintf(buf, size, fmt, args); |
1da177e4 | 2416 | va_end(args); |
7b9186f5 | 2417 | |
1da177e4 LT |
2418 | return i; |
2419 | } | |
1da177e4 LT |
2420 | EXPORT_SYMBOL(snprintf); |
2421 | ||
2422 | /** | |
2423 | * scnprintf - Format a string and place it in a buffer | |
2424 | * @buf: The buffer to place the result into | |
2425 | * @size: The size of the buffer, including the trailing null space | |
2426 | * @fmt: The format string to use | |
2427 | * @...: Arguments for the format string | |
2428 | * | |
2429 | * The return value is the number of characters written into @buf not including | |
b903c0b8 | 2430 | * the trailing '\0'. If @size is == 0 the function returns 0. |
1da177e4 LT |
2431 | */ |
2432 | ||
7b9186f5 | 2433 | int scnprintf(char *buf, size_t size, const char *fmt, ...) |
1da177e4 LT |
2434 | { |
2435 | va_list args; | |
2436 | int i; | |
2437 | ||
2438 | va_start(args, fmt); | |
b921c69f | 2439 | i = vscnprintf(buf, size, fmt, args); |
1da177e4 | 2440 | va_end(args); |
7b9186f5 | 2441 | |
b921c69f | 2442 | return i; |
1da177e4 LT |
2443 | } |
2444 | EXPORT_SYMBOL(scnprintf); | |
2445 | ||
2446 | /** | |
2447 | * vsprintf - Format a string and place it in a buffer | |
2448 | * @buf: The buffer to place the result into | |
2449 | * @fmt: The format string to use | |
2450 | * @args: Arguments for the format string | |
2451 | * | |
2452 | * The function returns the number of characters written | |
72fd4a35 | 2453 | * into @buf. Use vsnprintf() or vscnprintf() in order to avoid |
1da177e4 LT |
2454 | * buffer overflows. |
2455 | * | |
ba1835eb | 2456 | * If you're not already dealing with a va_list consider using sprintf(). |
20036fdc AK |
2457 | * |
2458 | * See the vsnprintf() documentation for format string extensions over C99. | |
1da177e4 LT |
2459 | */ |
2460 | int vsprintf(char *buf, const char *fmt, va_list args) | |
2461 | { | |
2462 | return vsnprintf(buf, INT_MAX, fmt, args); | |
2463 | } | |
1da177e4 LT |
2464 | EXPORT_SYMBOL(vsprintf); |
2465 | ||
2466 | /** | |
2467 | * sprintf - Format a string and place it in a buffer | |
2468 | * @buf: The buffer to place the result into | |
2469 | * @fmt: The format string to use | |
2470 | * @...: Arguments for the format string | |
2471 | * | |
2472 | * The function returns the number of characters written | |
72fd4a35 | 2473 | * into @buf. Use snprintf() or scnprintf() in order to avoid |
1da177e4 | 2474 | * buffer overflows. |
20036fdc AK |
2475 | * |
2476 | * See the vsnprintf() documentation for format string extensions over C99. | |
1da177e4 | 2477 | */ |
7b9186f5 | 2478 | int sprintf(char *buf, const char *fmt, ...) |
1da177e4 LT |
2479 | { |
2480 | va_list args; | |
2481 | int i; | |
2482 | ||
2483 | va_start(args, fmt); | |
7b9186f5 | 2484 | i = vsnprintf(buf, INT_MAX, fmt, args); |
1da177e4 | 2485 | va_end(args); |
7b9186f5 | 2486 | |
1da177e4 LT |
2487 | return i; |
2488 | } | |
1da177e4 LT |
2489 | EXPORT_SYMBOL(sprintf); |
2490 | ||
4370aa4a LJ |
2491 | #ifdef CONFIG_BINARY_PRINTF |
2492 | /* | |
2493 | * bprintf service: | |
2494 | * vbin_printf() - VA arguments to binary data | |
2495 | * bstr_printf() - Binary data to text string | |
2496 | */ | |
2497 | ||
2498 | /** | |
2499 | * vbin_printf - Parse a format string and place args' binary value in a buffer | |
2500 | * @bin_buf: The buffer to place args' binary value | |
2501 | * @size: The size of the buffer(by words(32bits), not characters) | |
2502 | * @fmt: The format string to use | |
2503 | * @args: Arguments for the format string | |
2504 | * | |
2505 | * The format follows C99 vsnprintf, except %n is ignored, and its argument | |
da3dae54 | 2506 | * is skipped. |
4370aa4a LJ |
2507 | * |
2508 | * The return value is the number of words(32bits) which would be generated for | |
2509 | * the given input. | |
2510 | * | |
2511 | * NOTE: | |
2512 | * If the return value is greater than @size, the resulting bin_buf is NOT | |
2513 | * valid for bstr_printf(). | |
2514 | */ | |
2515 | int vbin_printf(u32 *bin_buf, size_t size, const char *fmt, va_list args) | |
2516 | { | |
fef20d9c | 2517 | struct printf_spec spec = {0}; |
4370aa4a | 2518 | char *str, *end; |
4370aa4a LJ |
2519 | |
2520 | str = (char *)bin_buf; | |
2521 | end = (char *)(bin_buf + size); | |
2522 | ||
2523 | #define save_arg(type) \ | |
2524 | do { \ | |
2525 | if (sizeof(type) == 8) { \ | |
2526 | unsigned long long value; \ | |
2527 | str = PTR_ALIGN(str, sizeof(u32)); \ | |
2528 | value = va_arg(args, unsigned long long); \ | |
2529 | if (str + sizeof(type) <= end) { \ | |
2530 | *(u32 *)str = *(u32 *)&value; \ | |
2531 | *(u32 *)(str + 4) = *((u32 *)&value + 1); \ | |
2532 | } \ | |
2533 | } else { \ | |
2534 | unsigned long value; \ | |
2535 | str = PTR_ALIGN(str, sizeof(type)); \ | |
2536 | value = va_arg(args, int); \ | |
2537 | if (str + sizeof(type) <= end) \ | |
2538 | *(typeof(type) *)str = (type)value; \ | |
2539 | } \ | |
2540 | str += sizeof(type); \ | |
2541 | } while (0) | |
2542 | ||
fef20d9c | 2543 | while (*fmt) { |
d4be151b | 2544 | int read = format_decode(fmt, &spec); |
4370aa4a | 2545 | |
fef20d9c | 2546 | fmt += read; |
4370aa4a | 2547 | |
fef20d9c FW |
2548 | switch (spec.type) { |
2549 | case FORMAT_TYPE_NONE: | |
d4be151b | 2550 | case FORMAT_TYPE_PERCENT_CHAR: |
fef20d9c | 2551 | break; |
b006f19b RV |
2552 | case FORMAT_TYPE_INVALID: |
2553 | goto out; | |
fef20d9c | 2554 | |
ed681a91 | 2555 | case FORMAT_TYPE_WIDTH: |
fef20d9c FW |
2556 | case FORMAT_TYPE_PRECISION: |
2557 | save_arg(int); | |
2558 | break; | |
2559 | ||
2560 | case FORMAT_TYPE_CHAR: | |
4370aa4a | 2561 | save_arg(char); |
fef20d9c FW |
2562 | break; |
2563 | ||
2564 | case FORMAT_TYPE_STR: { | |
4370aa4a LJ |
2565 | const char *save_str = va_arg(args, char *); |
2566 | size_t len; | |
6c356634 | 2567 | |
4370aa4a LJ |
2568 | if ((unsigned long)save_str > (unsigned long)-PAGE_SIZE |
2569 | || (unsigned long)save_str < PAGE_SIZE) | |
0f4f81dc | 2570 | save_str = "(null)"; |
6c356634 AGR |
2571 | len = strlen(save_str) + 1; |
2572 | if (str + len < end) | |
2573 | memcpy(str, save_str, len); | |
2574 | str += len; | |
fef20d9c | 2575 | break; |
4370aa4a | 2576 | } |
fef20d9c FW |
2577 | |
2578 | case FORMAT_TYPE_PTR: | |
4370aa4a LJ |
2579 | save_arg(void *); |
2580 | /* skip all alphanumeric pointer suffixes */ | |
fef20d9c | 2581 | while (isalnum(*fmt)) |
4370aa4a | 2582 | fmt++; |
fef20d9c FW |
2583 | break; |
2584 | ||
fef20d9c FW |
2585 | default: |
2586 | switch (spec.type) { | |
2587 | ||
2588 | case FORMAT_TYPE_LONG_LONG: | |
4370aa4a | 2589 | save_arg(long long); |
fef20d9c FW |
2590 | break; |
2591 | case FORMAT_TYPE_ULONG: | |
2592 | case FORMAT_TYPE_LONG: | |
4370aa4a | 2593 | save_arg(unsigned long); |
fef20d9c FW |
2594 | break; |
2595 | case FORMAT_TYPE_SIZE_T: | |
4370aa4a | 2596 | save_arg(size_t); |
fef20d9c FW |
2597 | break; |
2598 | case FORMAT_TYPE_PTRDIFF: | |
4370aa4a | 2599 | save_arg(ptrdiff_t); |
fef20d9c | 2600 | break; |
a4e94ef0 Z |
2601 | case FORMAT_TYPE_UBYTE: |
2602 | case FORMAT_TYPE_BYTE: | |
2603 | save_arg(char); | |
2604 | break; | |
fef20d9c FW |
2605 | case FORMAT_TYPE_USHORT: |
2606 | case FORMAT_TYPE_SHORT: | |
4370aa4a | 2607 | save_arg(short); |
fef20d9c FW |
2608 | break; |
2609 | default: | |
4370aa4a | 2610 | save_arg(int); |
fef20d9c | 2611 | } |
4370aa4a LJ |
2612 | } |
2613 | } | |
fef20d9c | 2614 | |
b006f19b | 2615 | out: |
7b9186f5 | 2616 | return (u32 *)(PTR_ALIGN(str, sizeof(u32))) - bin_buf; |
fef20d9c | 2617 | #undef save_arg |
4370aa4a LJ |
2618 | } |
2619 | EXPORT_SYMBOL_GPL(vbin_printf); | |
2620 | ||
2621 | /** | |
2622 | * bstr_printf - Format a string from binary arguments and place it in a buffer | |
2623 | * @buf: The buffer to place the result into | |
2624 | * @size: The size of the buffer, including the trailing null space | |
2625 | * @fmt: The format string to use | |
2626 | * @bin_buf: Binary arguments for the format string | |
2627 | * | |
2628 | * This function like C99 vsnprintf, but the difference is that vsnprintf gets | |
2629 | * arguments from stack, and bstr_printf gets arguments from @bin_buf which is | |
2630 | * a binary buffer that generated by vbin_printf. | |
2631 | * | |
2632 | * The format follows C99 vsnprintf, but has some extensions: | |
0efb4d20 | 2633 | * see vsnprintf comment for details. |
4370aa4a LJ |
2634 | * |
2635 | * The return value is the number of characters which would | |
2636 | * be generated for the given input, excluding the trailing | |
2637 | * '\0', as per ISO C99. If you want to have the exact | |
2638 | * number of characters written into @buf as return value | |
2639 | * (not including the trailing '\0'), use vscnprintf(). If the | |
2640 | * return is greater than or equal to @size, the resulting | |
2641 | * string is truncated. | |
2642 | */ | |
2643 | int bstr_printf(char *buf, size_t size, const char *fmt, const u32 *bin_buf) | |
2644 | { | |
fef20d9c | 2645 | struct printf_spec spec = {0}; |
d4be151b AGR |
2646 | char *str, *end; |
2647 | const char *args = (const char *)bin_buf; | |
4370aa4a | 2648 | |
762abb51 | 2649 | if (WARN_ON_ONCE(size > INT_MAX)) |
4370aa4a | 2650 | return 0; |
4370aa4a LJ |
2651 | |
2652 | str = buf; | |
2653 | end = buf + size; | |
2654 | ||
2655 | #define get_arg(type) \ | |
2656 | ({ \ | |
2657 | typeof(type) value; \ | |
2658 | if (sizeof(type) == 8) { \ | |
2659 | args = PTR_ALIGN(args, sizeof(u32)); \ | |
2660 | *(u32 *)&value = *(u32 *)args; \ | |
2661 | *((u32 *)&value + 1) = *(u32 *)(args + 4); \ | |
2662 | } else { \ | |
2663 | args = PTR_ALIGN(args, sizeof(type)); \ | |
2664 | value = *(typeof(type) *)args; \ | |
2665 | } \ | |
2666 | args += sizeof(type); \ | |
2667 | value; \ | |
2668 | }) | |
2669 | ||
2670 | /* Make sure end is always >= buf */ | |
2671 | if (end < buf) { | |
2672 | end = ((void *)-1); | |
2673 | size = end - buf; | |
2674 | } | |
2675 | ||
fef20d9c | 2676 | while (*fmt) { |
fef20d9c | 2677 | const char *old_fmt = fmt; |
d4be151b | 2678 | int read = format_decode(fmt, &spec); |
4370aa4a | 2679 | |
fef20d9c | 2680 | fmt += read; |
4370aa4a | 2681 | |
fef20d9c FW |
2682 | switch (spec.type) { |
2683 | case FORMAT_TYPE_NONE: { | |
2684 | int copy = read; | |
2685 | if (str < end) { | |
2686 | if (copy > end - str) | |
2687 | copy = end - str; | |
2688 | memcpy(str, old_fmt, copy); | |
4370aa4a | 2689 | } |
fef20d9c FW |
2690 | str += read; |
2691 | break; | |
4370aa4a LJ |
2692 | } |
2693 | ||
ed681a91 | 2694 | case FORMAT_TYPE_WIDTH: |
4d72ba01 | 2695 | set_field_width(&spec, get_arg(int)); |
fef20d9c | 2696 | break; |
4370aa4a | 2697 | |
fef20d9c | 2698 | case FORMAT_TYPE_PRECISION: |
4d72ba01 | 2699 | set_precision(&spec, get_arg(int)); |
fef20d9c | 2700 | break; |
4370aa4a | 2701 | |
d4be151b AGR |
2702 | case FORMAT_TYPE_CHAR: { |
2703 | char c; | |
2704 | ||
fef20d9c FW |
2705 | if (!(spec.flags & LEFT)) { |
2706 | while (--spec.field_width > 0) { | |
4370aa4a LJ |
2707 | if (str < end) |
2708 | *str = ' '; | |
2709 | ++str; | |
2710 | } | |
2711 | } | |
2712 | c = (unsigned char) get_arg(char); | |
2713 | if (str < end) | |
2714 | *str = c; | |
2715 | ++str; | |
fef20d9c | 2716 | while (--spec.field_width > 0) { |
4370aa4a LJ |
2717 | if (str < end) |
2718 | *str = ' '; | |
2719 | ++str; | |
2720 | } | |
fef20d9c | 2721 | break; |
d4be151b | 2722 | } |
4370aa4a | 2723 | |
fef20d9c | 2724 | case FORMAT_TYPE_STR: { |
4370aa4a | 2725 | const char *str_arg = args; |
d4be151b | 2726 | args += strlen(str_arg) + 1; |
fef20d9c FW |
2727 | str = string(str, end, (char *)str_arg, spec); |
2728 | break; | |
4370aa4a LJ |
2729 | } |
2730 | ||
fef20d9c | 2731 | case FORMAT_TYPE_PTR: |
ffbfed03 | 2732 | str = pointer(fmt, str, end, get_arg(void *), spec); |
fef20d9c | 2733 | while (isalnum(*fmt)) |
4370aa4a | 2734 | fmt++; |
fef20d9c | 2735 | break; |
4370aa4a | 2736 | |
fef20d9c | 2737 | case FORMAT_TYPE_PERCENT_CHAR: |
4370aa4a LJ |
2738 | if (str < end) |
2739 | *str = '%'; | |
2740 | ++str; | |
fef20d9c FW |
2741 | break; |
2742 | ||
b006f19b RV |
2743 | case FORMAT_TYPE_INVALID: |
2744 | goto out; | |
2745 | ||
d4be151b AGR |
2746 | default: { |
2747 | unsigned long long num; | |
2748 | ||
fef20d9c FW |
2749 | switch (spec.type) { |
2750 | ||
2751 | case FORMAT_TYPE_LONG_LONG: | |
2752 | num = get_arg(long long); | |
2753 | break; | |
2754 | case FORMAT_TYPE_ULONG: | |
fef20d9c FW |
2755 | case FORMAT_TYPE_LONG: |
2756 | num = get_arg(unsigned long); | |
2757 | break; | |
2758 | case FORMAT_TYPE_SIZE_T: | |
2759 | num = get_arg(size_t); | |
2760 | break; | |
2761 | case FORMAT_TYPE_PTRDIFF: | |
2762 | num = get_arg(ptrdiff_t); | |
2763 | break; | |
a4e94ef0 Z |
2764 | case FORMAT_TYPE_UBYTE: |
2765 | num = get_arg(unsigned char); | |
2766 | break; | |
2767 | case FORMAT_TYPE_BYTE: | |
2768 | num = get_arg(signed char); | |
2769 | break; | |
fef20d9c FW |
2770 | case FORMAT_TYPE_USHORT: |
2771 | num = get_arg(unsigned short); | |
2772 | break; | |
2773 | case FORMAT_TYPE_SHORT: | |
2774 | num = get_arg(short); | |
2775 | break; | |
2776 | case FORMAT_TYPE_UINT: | |
2777 | num = get_arg(unsigned int); | |
2778 | break; | |
2779 | default: | |
2780 | num = get_arg(int); | |
2781 | } | |
2782 | ||
2783 | str = number(str, end, num, spec); | |
d4be151b AGR |
2784 | } /* default: */ |
2785 | } /* switch(spec.type) */ | |
2786 | } /* while(*fmt) */ | |
fef20d9c | 2787 | |
b006f19b | 2788 | out: |
4370aa4a LJ |
2789 | if (size > 0) { |
2790 | if (str < end) | |
2791 | *str = '\0'; | |
2792 | else | |
2793 | end[-1] = '\0'; | |
2794 | } | |
fef20d9c | 2795 | |
4370aa4a LJ |
2796 | #undef get_arg |
2797 | ||
2798 | /* the trailing null byte doesn't count towards the total */ | |
2799 | return str - buf; | |
2800 | } | |
2801 | EXPORT_SYMBOL_GPL(bstr_printf); | |
2802 | ||
2803 | /** | |
2804 | * bprintf - Parse a format string and place args' binary value in a buffer | |
2805 | * @bin_buf: The buffer to place args' binary value | |
2806 | * @size: The size of the buffer(by words(32bits), not characters) | |
2807 | * @fmt: The format string to use | |
2808 | * @...: Arguments for the format string | |
2809 | * | |
2810 | * The function returns the number of words(u32) written | |
2811 | * into @bin_buf. | |
2812 | */ | |
2813 | int bprintf(u32 *bin_buf, size_t size, const char *fmt, ...) | |
2814 | { | |
2815 | va_list args; | |
2816 | int ret; | |
2817 | ||
2818 | va_start(args, fmt); | |
2819 | ret = vbin_printf(bin_buf, size, fmt, args); | |
2820 | va_end(args); | |
7b9186f5 | 2821 | |
4370aa4a LJ |
2822 | return ret; |
2823 | } | |
2824 | EXPORT_SYMBOL_GPL(bprintf); | |
2825 | ||
2826 | #endif /* CONFIG_BINARY_PRINTF */ | |
2827 | ||
1da177e4 LT |
2828 | /** |
2829 | * vsscanf - Unformat a buffer into a list of arguments | |
2830 | * @buf: input buffer | |
2831 | * @fmt: format of buffer | |
2832 | * @args: arguments | |
2833 | */ | |
7b9186f5 | 2834 | int vsscanf(const char *buf, const char *fmt, va_list args) |
1da177e4 LT |
2835 | { |
2836 | const char *str = buf; | |
2837 | char *next; | |
2838 | char digit; | |
2839 | int num = 0; | |
ef0658f3 | 2840 | u8 qualifier; |
53809751 JB |
2841 | unsigned int base; |
2842 | union { | |
2843 | long long s; | |
2844 | unsigned long long u; | |
2845 | } val; | |
ef0658f3 | 2846 | s16 field_width; |
d4be151b | 2847 | bool is_sign; |
1da177e4 | 2848 | |
da99075c | 2849 | while (*fmt) { |
1da177e4 LT |
2850 | /* skip any white space in format */ |
2851 | /* white space in format matchs any amount of | |
2852 | * white space, including none, in the input. | |
2853 | */ | |
2854 | if (isspace(*fmt)) { | |
e7d2860b AGR |
2855 | fmt = skip_spaces(++fmt); |
2856 | str = skip_spaces(str); | |
1da177e4 LT |
2857 | } |
2858 | ||
2859 | /* anything that is not a conversion must match exactly */ | |
2860 | if (*fmt != '%' && *fmt) { | |
2861 | if (*fmt++ != *str++) | |
2862 | break; | |
2863 | continue; | |
2864 | } | |
2865 | ||
2866 | if (!*fmt) | |
2867 | break; | |
2868 | ++fmt; | |
7b9186f5 | 2869 | |
1da177e4 LT |
2870 | /* skip this conversion. |
2871 | * advance both strings to next white space | |
2872 | */ | |
2873 | if (*fmt == '*') { | |
da99075c JB |
2874 | if (!*str) |
2875 | break; | |
f9310b2f JY |
2876 | while (!isspace(*fmt) && *fmt != '%' && *fmt) { |
2877 | /* '%*[' not yet supported, invalid format */ | |
2878 | if (*fmt == '[') | |
2879 | return num; | |
1da177e4 | 2880 | fmt++; |
f9310b2f | 2881 | } |
1da177e4 LT |
2882 | while (!isspace(*str) && *str) |
2883 | str++; | |
2884 | continue; | |
2885 | } | |
2886 | ||
2887 | /* get field width */ | |
2888 | field_width = -1; | |
53809751 | 2889 | if (isdigit(*fmt)) { |
1da177e4 | 2890 | field_width = skip_atoi(&fmt); |
53809751 JB |
2891 | if (field_width <= 0) |
2892 | break; | |
2893 | } | |
1da177e4 LT |
2894 | |
2895 | /* get conversion qualifier */ | |
2896 | qualifier = -1; | |
75fb8f26 | 2897 | if (*fmt == 'h' || _tolower(*fmt) == 'l' || |
5b5e0928 | 2898 | *fmt == 'z') { |
1da177e4 LT |
2899 | qualifier = *fmt++; |
2900 | if (unlikely(qualifier == *fmt)) { | |
2901 | if (qualifier == 'h') { | |
2902 | qualifier = 'H'; | |
2903 | fmt++; | |
2904 | } else if (qualifier == 'l') { | |
2905 | qualifier = 'L'; | |
2906 | fmt++; | |
2907 | } | |
2908 | } | |
2909 | } | |
1da177e4 | 2910 | |
da99075c JB |
2911 | if (!*fmt) |
2912 | break; | |
2913 | ||
2914 | if (*fmt == 'n') { | |
2915 | /* return number of characters read so far */ | |
2916 | *va_arg(args, int *) = str - buf; | |
2917 | ++fmt; | |
2918 | continue; | |
2919 | } | |
2920 | ||
2921 | if (!*str) | |
1da177e4 LT |
2922 | break; |
2923 | ||
d4be151b | 2924 | base = 10; |
3f623eba | 2925 | is_sign = false; |
d4be151b | 2926 | |
7b9186f5 | 2927 | switch (*fmt++) { |
1da177e4 LT |
2928 | case 'c': |
2929 | { | |
7b9186f5 | 2930 | char *s = (char *)va_arg(args, char*); |
1da177e4 LT |
2931 | if (field_width == -1) |
2932 | field_width = 1; | |
2933 | do { | |
2934 | *s++ = *str++; | |
2935 | } while (--field_width > 0 && *str); | |
2936 | num++; | |
2937 | } | |
2938 | continue; | |
2939 | case 's': | |
2940 | { | |
7b9186f5 AGR |
2941 | char *s = (char *)va_arg(args, char *); |
2942 | if (field_width == -1) | |
4be929be | 2943 | field_width = SHRT_MAX; |
1da177e4 | 2944 | /* first, skip leading white space in buffer */ |
e7d2860b | 2945 | str = skip_spaces(str); |
1da177e4 LT |
2946 | |
2947 | /* now copy until next white space */ | |
7b9186f5 | 2948 | while (*str && !isspace(*str) && field_width--) |
1da177e4 | 2949 | *s++ = *str++; |
1da177e4 LT |
2950 | *s = '\0'; |
2951 | num++; | |
2952 | } | |
2953 | continue; | |
f9310b2f JY |
2954 | /* |
2955 | * Warning: This implementation of the '[' conversion specifier | |
2956 | * deviates from its glibc counterpart in the following ways: | |
2957 | * (1) It does NOT support ranges i.e. '-' is NOT a special | |
2958 | * character | |
2959 | * (2) It cannot match the closing bracket ']' itself | |
2960 | * (3) A field width is required | |
2961 | * (4) '%*[' (discard matching input) is currently not supported | |
2962 | * | |
2963 | * Example usage: | |
2964 | * ret = sscanf("00:0a:95","%2[^:]:%2[^:]:%2[^:]", | |
2965 | * buf1, buf2, buf3); | |
2966 | * if (ret < 3) | |
2967 | * // etc.. | |
2968 | */ | |
2969 | case '[': | |
2970 | { | |
2971 | char *s = (char *)va_arg(args, char *); | |
2972 | DECLARE_BITMAP(set, 256) = {0}; | |
2973 | unsigned int len = 0; | |
2974 | bool negate = (*fmt == '^'); | |
2975 | ||
2976 | /* field width is required */ | |
2977 | if (field_width == -1) | |
2978 | return num; | |
2979 | ||
2980 | if (negate) | |
2981 | ++fmt; | |
2982 | ||
2983 | for ( ; *fmt && *fmt != ']'; ++fmt, ++len) | |
2984 | set_bit((u8)*fmt, set); | |
2985 | ||
2986 | /* no ']' or no character set found */ | |
2987 | if (!*fmt || !len) | |
2988 | return num; | |
2989 | ++fmt; | |
2990 | ||
2991 | if (negate) { | |
2992 | bitmap_complement(set, set, 256); | |
2993 | /* exclude null '\0' byte */ | |
2994 | clear_bit(0, set); | |
2995 | } | |
2996 | ||
2997 | /* match must be non-empty */ | |
2998 | if (!test_bit((u8)*str, set)) | |
2999 | return num; | |
3000 | ||
3001 | while (test_bit((u8)*str, set) && field_width--) | |
3002 | *s++ = *str++; | |
3003 | *s = '\0'; | |
3004 | ++num; | |
3005 | } | |
3006 | continue; | |
1da177e4 LT |
3007 | case 'o': |
3008 | base = 8; | |
3009 | break; | |
3010 | case 'x': | |
3011 | case 'X': | |
3012 | base = 16; | |
3013 | break; | |
3014 | case 'i': | |
7b9186f5 | 3015 | base = 0; |
1da177e4 | 3016 | case 'd': |
3f623eba | 3017 | is_sign = true; |
1da177e4 LT |
3018 | case 'u': |
3019 | break; | |
3020 | case '%': | |
3021 | /* looking for '%' in str */ | |
7b9186f5 | 3022 | if (*str++ != '%') |
1da177e4 LT |
3023 | return num; |
3024 | continue; | |
3025 | default: | |
3026 | /* invalid format; stop here */ | |
3027 | return num; | |
3028 | } | |
3029 | ||
3030 | /* have some sort of integer conversion. | |
3031 | * first, skip white space in buffer. | |
3032 | */ | |
e7d2860b | 3033 | str = skip_spaces(str); |
1da177e4 LT |
3034 | |
3035 | digit = *str; | |
3036 | if (is_sign && digit == '-') | |
3037 | digit = *(str + 1); | |
3038 | ||
3039 | if (!digit | |
7b9186f5 AGR |
3040 | || (base == 16 && !isxdigit(digit)) |
3041 | || (base == 10 && !isdigit(digit)) | |
3042 | || (base == 8 && (!isdigit(digit) || digit > '7')) | |
3043 | || (base == 0 && !isdigit(digit))) | |
3044 | break; | |
1da177e4 | 3045 | |
53809751 JB |
3046 | if (is_sign) |
3047 | val.s = qualifier != 'L' ? | |
3048 | simple_strtol(str, &next, base) : | |
3049 | simple_strtoll(str, &next, base); | |
3050 | else | |
3051 | val.u = qualifier != 'L' ? | |
3052 | simple_strtoul(str, &next, base) : | |
3053 | simple_strtoull(str, &next, base); | |
3054 | ||
3055 | if (field_width > 0 && next - str > field_width) { | |
3056 | if (base == 0) | |
3057 | _parse_integer_fixup_radix(str, &base); | |
3058 | while (next - str > field_width) { | |
3059 | if (is_sign) | |
3060 | val.s = div_s64(val.s, base); | |
3061 | else | |
3062 | val.u = div_u64(val.u, base); | |
3063 | --next; | |
3064 | } | |
3065 | } | |
3066 | ||
7b9186f5 | 3067 | switch (qualifier) { |
1da177e4 | 3068 | case 'H': /* that's 'hh' in format */ |
53809751 JB |
3069 | if (is_sign) |
3070 | *va_arg(args, signed char *) = val.s; | |
3071 | else | |
3072 | *va_arg(args, unsigned char *) = val.u; | |
1da177e4 LT |
3073 | break; |
3074 | case 'h': | |
53809751 JB |
3075 | if (is_sign) |
3076 | *va_arg(args, short *) = val.s; | |
3077 | else | |
3078 | *va_arg(args, unsigned short *) = val.u; | |
1da177e4 LT |
3079 | break; |
3080 | case 'l': | |
53809751 JB |
3081 | if (is_sign) |
3082 | *va_arg(args, long *) = val.s; | |
3083 | else | |
3084 | *va_arg(args, unsigned long *) = val.u; | |
1da177e4 LT |
3085 | break; |
3086 | case 'L': | |
53809751 JB |
3087 | if (is_sign) |
3088 | *va_arg(args, long long *) = val.s; | |
3089 | else | |
3090 | *va_arg(args, unsigned long long *) = val.u; | |
1da177e4 | 3091 | break; |
1da177e4 | 3092 | case 'z': |
53809751 JB |
3093 | *va_arg(args, size_t *) = val.u; |
3094 | break; | |
1da177e4 | 3095 | default: |
53809751 JB |
3096 | if (is_sign) |
3097 | *va_arg(args, int *) = val.s; | |
3098 | else | |
3099 | *va_arg(args, unsigned int *) = val.u; | |
1da177e4 LT |
3100 | break; |
3101 | } | |
3102 | num++; | |
3103 | ||
3104 | if (!next) | |
3105 | break; | |
3106 | str = next; | |
3107 | } | |
c6b40d16 | 3108 | |
1da177e4 LT |
3109 | return num; |
3110 | } | |
1da177e4 LT |
3111 | EXPORT_SYMBOL(vsscanf); |
3112 | ||
3113 | /** | |
3114 | * sscanf - Unformat a buffer into a list of arguments | |
3115 | * @buf: input buffer | |
3116 | * @fmt: formatting of buffer | |
3117 | * @...: resulting arguments | |
3118 | */ | |
7b9186f5 | 3119 | int sscanf(const char *buf, const char *fmt, ...) |
1da177e4 LT |
3120 | { |
3121 | va_list args; | |
3122 | int i; | |
3123 | ||
7b9186f5 AGR |
3124 | va_start(args, fmt); |
3125 | i = vsscanf(buf, fmt, args); | |
1da177e4 | 3126 | va_end(args); |
7b9186f5 | 3127 | |
1da177e4 LT |
3128 | return i; |
3129 | } | |
1da177e4 | 3130 | EXPORT_SYMBOL(sscanf); |