]>
Commit | Line | Data |
---|---|---|
1 | /* $NetBSD: vsnprintf_ss.c,v 1.2.2.1 2007/05/07 19:49:09 pavel Exp $ */\r | |
2 | \r | |
3 | /*-\r | |
4 | * Copyright (c) 1990, 1993\r | |
5 | * The Regents of the University of California. All rights reserved.\r | |
6 | *\r | |
7 | * This code is derived from software contributed to Berkeley by\r | |
8 | * Chris Torek.\r | |
9 | *\r | |
10 | * Redistribution and use in source and binary forms, with or without\r | |
11 | * modification, are permitted provided that the following conditions\r | |
12 | * are met:\r | |
13 | * 1. Redistributions of source code must retain the above copyright\r | |
14 | * notice, this list of conditions and the following disclaimer.\r | |
15 | * 2. Redistributions in binary form must reproduce the above copyright\r | |
16 | * notice, this list of conditions and the following disclaimer in the\r | |
17 | * documentation and/or other materials provided with the distribution.\r | |
18 | * 3. Neither the name of the University nor the names of its contributors\r | |
19 | * may be used to endorse or promote products derived from this software\r | |
20 | * without specific prior written permission.\r | |
21 | *\r | |
22 | * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND\r | |
23 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE\r | |
24 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE\r | |
25 | * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE\r | |
26 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL\r | |
27 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS\r | |
28 | * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)\r | |
29 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT\r | |
30 | * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY\r | |
31 | * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF\r | |
32 | * SUCH DAMAGE.\r | |
33 | */\r | |
34 | #include <LibConfig.h>\r | |
35 | #include <sys/EfiCdefs.h>\r | |
36 | #if defined(LIBC_SCCS) && !defined(lint)\r | |
37 | #if 0\r | |
38 | static char sccsid[] = "@(#)vsnprintf.c 8.1 (Berkeley) 6/4/93";\r | |
39 | #else\r | |
40 | __RCSID("$NetBSD: vsnprintf_ss.c,v 1.2.2.1 2007/05/07 19:49:09 pavel Exp $");\r | |
41 | #endif\r | |
42 | #endif /* LIBC_SCCS and not lint */\r | |
43 | \r | |
44 | #include "namespace.h"\r | |
45 | \r | |
46 | #include <sys/types.h>\r | |
47 | #include <inttypes.h>\r | |
48 | #include <assert.h>\r | |
49 | #include <stdio.h>\r | |
50 | #include <errno.h>\r | |
51 | #include <stdarg.h>\r | |
52 | #include <string.h>\r | |
53 | #include "reentrant.h"\r | |
54 | #include "extern.h"\r | |
55 | #include "local.h"\r | |
56 | \r | |
57 | #ifdef __weak_alias\r | |
58 | __weak_alias(vsnprintf_ss,_vsnprintf_ss)\r | |
59 | #endif\r | |
60 | \r | |
61 | /*\r | |
62 | * vsnprintf_ss: scaled down version of printf(3).\r | |
63 | *\r | |
64 | * this version based on vfprintf() from libc which was derived from\r | |
65 | * software contributed to Berkeley by Chris Torek.\r | |
66 | *\r | |
67 | */\r | |
68 | \r | |
69 | /*\r | |
70 | * macros for converting digits to letters and vice versa\r | |
71 | */\r | |
72 | #define to_digit(c) ((c) - '0')\r | |
73 | #define is_digit(c) ((unsigned)to_digit(c) <= 9)\r | |
74 | #define to_char(n) (char)((n) + '0')\r | |
75 | \r | |
76 | /*\r | |
77 | * flags used during conversion.\r | |
78 | */\r | |
79 | #define ALT 0x001 /* alternate form */\r | |
80 | #define HEXPREFIX 0x002 /* add 0x or 0X prefix */\r | |
81 | #define LADJUST 0x004 /* left adjustment */\r | |
82 | #define LONGDBL 0x008 /* long double; unimplemented */\r | |
83 | #define LONGINT 0x010 /* long integer */\r | |
84 | #define QUADINT 0x020 /* quad integer */\r | |
85 | #define SHORTINT 0x040 /* short integer */\r | |
86 | #define MAXINT 0x080 /* intmax_t */\r | |
87 | #define PTRINT 0x100 /* intptr_t */\r | |
88 | #define SIZEINT 0x200 /* size_t */\r | |
89 | #define ZEROPAD 0x400 /* zero (as opposed to blank) pad */\r | |
90 | #define FPT 0x800 /* Floating point number */\r | |
91 | \r | |
92 | /*\r | |
93 | * To extend shorts properly, we need both signed and unsigned\r | |
94 | * argument extraction methods.\r | |
95 | */\r | |
96 | #define SARG() \\r | |
97 | ((INT64)(flags&MAXINT ? va_arg(ap, intmax_t) : \\r | |
98 | flags&PTRINT ? va_arg(ap, intptr_t) : \\r | |
99 | flags&SIZEINT ? va_arg(ap, ssize_t) : /* XXX */ \\r | |
100 | flags&QUADINT ? va_arg(ap, quad_t) : \\r | |
101 | flags&LONGINT ? va_arg(ap, long) : \\r | |
102 | flags&SHORTINT ? (short)va_arg(ap, int) : \\r | |
103 | va_arg(ap, int)))\r | |
104 | \r | |
105 | #define UARG() \\r | |
106 | ((UINT64)(flags&MAXINT ? va_arg(ap, uintmax_t) : \\r | |
107 | flags&PTRINT ? va_arg(ap, uintptr_t) : \\r | |
108 | flags&SIZEINT ? va_arg(ap, size_t) : \\r | |
109 | flags&QUADINT ? va_arg(ap, u_quad_t) : \\r | |
110 | flags&LONGINT ? va_arg(ap, unsigned long) : \\r | |
111 | flags&SHORTINT ? (u_short)va_arg(ap, int) : \\r | |
112 | va_arg(ap, u_int)))\r | |
113 | \r | |
114 | #define PUTCHAR(C) do { \\r | |
115 | if (sbuf < tailp) \\r | |
116 | *sbuf++ = (C); \\r | |
117 | } while (/*CONSTCOND*/0)\r | |
118 | \r | |
119 | int\r | |
120 | vsnprintf_ss(char *sbuf, size_t slen, const char *fmt0, va_list ap)\r | |
121 | {\r | |
122 | const char *fmt; /* format string */\r | |
123 | int ch; /* character from fmt */\r | |
124 | int n; /* handy integer (short term usage) */\r | |
125 | char *cp; /* handy char pointer (short term usage) */\r | |
126 | int flags; /* flags as above */\r | |
127 | int ret; /* return value accumulator */\r | |
128 | int width; /* width from format (%8d), or 0 */\r | |
129 | int prec; /* precision from format (%.3d), or -1 */\r | |
130 | char sign; /* sign prefix (' ', '+', '-', or \0) */\r | |
131 | \r | |
132 | u_quad_t _uquad; /* integer arguments %[diouxX] */\r | |
133 | enum { OCT, DEC, HEX } base;/* base for [diouxX] conversion */\r | |
134 | int dprec; /* a copy of prec if [diouxX], 0 otherwise */\r | |
135 | int realsz; /* field size expanded by dprec */\r | |
136 | int size; /* size of converted field or string */\r | |
137 | const char *xdigs; /* digits for [xX] conversion */\r | |
138 | char bf[128]; /* space for %c, %[diouxX] */\r | |
139 | char *tailp; /* tail pointer for snprintf */\r | |
140 | \r | |
141 | static const char xdigs_lower[16] = "0123456789abcdef";\r | |
142 | static const char xdigs_upper[16] = "0123456789ABCDEF";\r | |
143 | \r | |
144 | \r | |
145 | _DIAGASSERT(n == 0 || sbuf != NULL);\r | |
146 | _DIAGASSERT(fmt != NULL);\r | |
147 | \r | |
148 | tailp = sbuf + slen;\r | |
149 | \r | |
150 | cp = NULL; /* XXX: shutup gcc */\r | |
151 | size = 0; /* XXX: shutup gcc */\r | |
152 | \r | |
153 | fmt = fmt0;\r | |
154 | ret = 0;\r | |
155 | \r | |
156 | xdigs = NULL; /* XXX: shut up gcc warning */\r | |
157 | \r | |
158 | /*\r | |
159 | * Scan the format for conversions (`%' character).\r | |
160 | */\r | |
161 | for (;;) {\r | |
162 | while (*fmt != '%' && *fmt) {\r | |
163 | ret++;\r | |
164 | PUTCHAR(*fmt++);\r | |
165 | }\r | |
166 | if (*fmt == 0)\r | |
167 | goto done;\r | |
168 | \r | |
169 | fmt++; /* skip over '%' */\r | |
170 | \r | |
171 | flags = 0;\r | |
172 | dprec = 0;\r | |
173 | width = 0;\r | |
174 | prec = -1;\r | |
175 | sign = '\0';\r | |
176 | \r | |
177 | rflag: ch = *fmt++;\r | |
178 | reswitch: switch (ch) {\r | |
179 | case ' ':\r | |
180 | /*\r | |
181 | * ``If the space and + flags both appear, the space\r | |
182 | * flag will be ignored.''\r | |
183 | * -- ANSI X3J11\r | |
184 | */\r | |
185 | if (!sign)\r | |
186 | sign = ' ';\r | |
187 | goto rflag;\r | |
188 | case '#':\r | |
189 | flags |= ALT;\r | |
190 | goto rflag;\r | |
191 | case '*':\r | |
192 | /*\r | |
193 | * ``A negative field width argument is taken as a\r | |
194 | * - flag followed by a positive field width.''\r | |
195 | * -- ANSI X3J11\r | |
196 | * They don't exclude field widths read from args.\r | |
197 | */\r | |
198 | if ((width = va_arg(ap, int)) >= 0)\r | |
199 | goto rflag;\r | |
200 | width = -width;\r | |
201 | /* FALLTHROUGH */\r | |
202 | case '-':\r | |
203 | flags |= LADJUST;\r | |
204 | goto rflag;\r | |
205 | case '+':\r | |
206 | sign = '+';\r | |
207 | goto rflag;\r | |
208 | case '.':\r | |
209 | if ((ch = *fmt++) == '*') {\r | |
210 | n = va_arg(ap, int);\r | |
211 | prec = n < 0 ? -1 : n;\r | |
212 | goto rflag;\r | |
213 | }\r | |
214 | n = 0;\r | |
215 | while (is_digit(ch)) {\r | |
216 | n = 10 * n + to_digit(ch);\r | |
217 | ch = *fmt++;\r | |
218 | }\r | |
219 | prec = n < 0 ? -1 : n;\r | |
220 | goto reswitch;\r | |
221 | case '0':\r | |
222 | /*\r | |
223 | * ``Note that 0 is taken as a flag, not as the\r | |
224 | * beginning of a field width.''\r | |
225 | * -- ANSI X3J11\r | |
226 | */\r | |
227 | flags |= ZEROPAD;\r | |
228 | goto rflag;\r | |
229 | case '1': case '2': case '3': case '4':\r | |
230 | case '5': case '6': case '7': case '8': case '9':\r | |
231 | n = 0;\r | |
232 | do {\r | |
233 | n = 10 * n + to_digit(ch);\r | |
234 | ch = *fmt++;\r | |
235 | } while (is_digit(ch));\r | |
236 | width = n;\r | |
237 | goto reswitch;\r | |
238 | case 'h':\r | |
239 | flags |= SHORTINT;\r | |
240 | goto rflag;\r | |
241 | case 'j':\r | |
242 | flags |= MAXINT;\r | |
243 | goto rflag;\r | |
244 | case 'l':\r | |
245 | if (*fmt == 'l') {\r | |
246 | fmt++;\r | |
247 | flags |= QUADINT;\r | |
248 | } else {\r | |
249 | flags |= LONGINT;\r | |
250 | }\r | |
251 | goto rflag;\r | |
252 | case 'q':\r | |
253 | flags |= QUADINT;\r | |
254 | goto rflag;\r | |
255 | case 't':\r | |
256 | flags |= PTRINT;\r | |
257 | goto rflag;\r | |
258 | case 'z':\r | |
259 | flags |= SIZEINT;\r | |
260 | goto rflag;\r | |
261 | case 'c':\r | |
262 | *(cp = bf) = va_arg(ap, int);\r | |
263 | size = 1;\r | |
264 | sign = '\0';\r | |
265 | break;\r | |
266 | case 'D':\r | |
267 | flags |= LONGINT;\r | |
268 | /*FALLTHROUGH*/\r | |
269 | case 'd':\r | |
270 | case 'i':\r | |
271 | _uquad = SARG();\r | |
272 | if ((quad_t)_uquad < 0) {\r | |
273 | _uquad = -_uquad;\r | |
274 | sign = '-';\r | |
275 | }\r | |
276 | base = DEC;\r | |
277 | goto number;\r | |
278 | case 'n':\r | |
279 | if (flags & MAXINT)\r | |
280 | *va_arg(ap, intmax_t *) = ret;\r | |
281 | else if (flags & PTRINT)\r | |
282 | *va_arg(ap, intptr_t *) = ret;\r | |
283 | else if (flags & SIZEINT)\r | |
284 | *va_arg(ap, ssize_t *) = ret;\r | |
285 | else if (flags & QUADINT)\r | |
286 | *va_arg(ap, quad_t *) = ret;\r | |
287 | else if (flags & LONGINT)\r | |
288 | *va_arg(ap, long *) = (long)ret;\r | |
289 | else if (flags & SHORTINT)\r | |
290 | *va_arg(ap, short *) = (short)ret;\r | |
291 | else\r | |
292 | *va_arg(ap, int *) = ret;\r | |
293 | continue; /* no output */\r | |
294 | case 'O':\r | |
295 | flags |= LONGINT;\r | |
296 | /*FALLTHROUGH*/\r | |
297 | case 'o':\r | |
298 | _uquad = UARG();\r | |
299 | base = OCT;\r | |
300 | goto nosign;\r | |
301 | case 'p':\r | |
302 | /*\r | |
303 | * ``The argument shall be a pointer to void. The\r | |
304 | * value of the pointer is converted to a sequence\r | |
305 | * of printable characters, in an implementation-\r | |
306 | * defined manner.''\r | |
307 | * -- ANSI X3J11\r | |
308 | */\r | |
309 | /* NOSTRICT */\r | |
310 | _uquad = (u_long)va_arg(ap, void *);\r | |
311 | base = HEX;\r | |
312 | xdigs = xdigs_lower;\r | |
313 | flags |= HEXPREFIX;\r | |
314 | ch = 'x';\r | |
315 | goto nosign;\r | |
316 | case 's':\r | |
317 | if ((cp = va_arg(ap, char *)) == NULL)\r | |
318 | /*XXXUNCONST*/\r | |
319 | cp = __UNCONST("(null)");\r | |
320 | if (prec >= 0) {\r | |
321 | /*\r | |
322 | * can't use strlen; can only look for the\r | |
323 | * NUL in the first `prec' characters, and\r | |
324 | * strlen() will go further.\r | |
325 | */\r | |
326 | char *p = memchr(cp, 0, (size_t)prec);\r | |
327 | \r | |
328 | if (p != NULL) {\r | |
329 | size = p - cp;\r | |
330 | if (size > prec)\r | |
331 | size = prec;\r | |
332 | } else\r | |
333 | size = prec;\r | |
334 | } else\r | |
335 | size = strlen(cp);\r | |
336 | sign = '\0';\r | |
337 | break;\r | |
338 | case 'U':\r | |
339 | flags |= LONGINT;\r | |
340 | /*FALLTHROUGH*/\r | |
341 | case 'u':\r | |
342 | _uquad = UARG();\r | |
343 | base = DEC;\r | |
344 | goto nosign;\r | |
345 | case 'X':\r | |
346 | xdigs = xdigs_upper;\r | |
347 | goto hex;\r | |
348 | case 'x':\r | |
349 | xdigs = xdigs_lower;\r | |
350 | hex: _uquad = UARG();\r | |
351 | base = HEX;\r | |
352 | /* leading 0x/X only if non-zero */\r | |
353 | if (flags & ALT && _uquad != 0)\r | |
354 | flags |= HEXPREFIX;\r | |
355 | \r | |
356 | /* unsigned conversions */\r | |
357 | nosign: sign = '\0';\r | |
358 | /*\r | |
359 | * ``... diouXx conversions ... if a precision is\r | |
360 | * specified, the 0 flag will be ignored.''\r | |
361 | * -- ANSI X3J11\r | |
362 | */\r | |
363 | number: if ((dprec = prec) >= 0)\r | |
364 | flags &= ~ZEROPAD;\r | |
365 | \r | |
366 | /*\r | |
367 | * ``The result of converting a zero value with an\r | |
368 | * explicit precision of zero is no characters.''\r | |
369 | * -- ANSI X3J11\r | |
370 | */\r | |
371 | cp = bf + sizeof(bf);\r | |
372 | if (_uquad != 0 || prec != 0) {\r | |
373 | /*\r | |
374 | * Unsigned mod is hard, and unsigned mod\r | |
375 | * by a constant is easier than that by\r | |
376 | * a variable; hence this switch.\r | |
377 | */\r | |
378 | switch (base) {\r | |
379 | case OCT:\r | |
380 | do {\r | |
381 | *--cp = to_char(_uquad & 7);\r | |
382 | _uquad >>= 3;\r | |
383 | } while (_uquad);\r | |
384 | /* handle octal leading 0 */\r | |
385 | if (flags & ALT && *cp != '0')\r | |
386 | *--cp = '0';\r | |
387 | break;\r | |
388 | \r | |
389 | case DEC:\r | |
390 | /* many numbers are 1 digit */\r | |
391 | while (_uquad >= 10) {\r | |
392 | *--cp = to_char(_uquad % 10);\r | |
393 | _uquad /= 10;\r | |
394 | }\r | |
395 | *--cp = to_char(_uquad);\r | |
396 | break;\r | |
397 | \r | |
398 | case HEX:\r | |
399 | do {\r | |
400 | *--cp = xdigs[(size_t)_uquad & 15];\r | |
401 | _uquad >>= 4;\r | |
402 | } while (_uquad);\r | |
403 | break;\r | |
404 | \r | |
405 | default:\r | |
406 | /*XXXUNCONST*/\r | |
407 | cp = __UNCONST("bug bad base");\r | |
408 | size = strlen(cp);\r | |
409 | goto skipsize;\r | |
410 | }\r | |
411 | }\r | |
412 | size = bf + sizeof(bf) - cp;\r | |
413 | skipsize:\r | |
414 | break;\r | |
415 | default: /* "%?" prints ?, unless ? is NUL */\r | |
416 | if (ch == '\0')\r | |
417 | goto done;\r | |
418 | /* pretend it was %c with argument ch */\r | |
419 | cp = bf;\r | |
420 | *cp = ch;\r | |
421 | size = 1;\r | |
422 | sign = '\0';\r | |
423 | break;\r | |
424 | }\r | |
425 | \r | |
426 | /*\r | |
427 | * All reasonable formats wind up here. At this point, `cp'\r | |
428 | * points to a string which (if not flags&LADJUST) should be\r | |
429 | * padded out to `width' places. If flags&ZEROPAD, it should\r | |
430 | * first be prefixed by any sign or other prefix; otherwise,\r | |
431 | * it should be blank padded before the prefix is emitted.\r | |
432 | * After any left-hand padding and prefixing, emit zeroes\r | |
433 | * required by a decimal [diouxX] precision, then print the\r | |
434 | * string proper, then emit zeroes required by any leftover\r | |
435 | * floating precision; finally, if LADJUST, pad with blanks.\r | |
436 | *\r | |
437 | * Compute actual size, so we know how much to pad.\r | |
438 | * size excludes decimal prec; realsz includes it.\r | |
439 | */\r | |
440 | realsz = dprec > size ? dprec : size;\r | |
441 | if (sign)\r | |
442 | realsz++;\r | |
443 | else if (flags & HEXPREFIX)\r | |
444 | realsz+= 2;\r | |
445 | \r | |
446 | /* adjust ret */\r | |
447 | ret += width > realsz ? width : realsz;\r | |
448 | \r | |
449 | /* right-adjusting blank padding */\r | |
450 | if ((flags & (LADJUST|ZEROPAD)) == 0) {\r | |
451 | n = width - realsz;\r | |
452 | while (n-- > 0)\r | |
453 | PUTCHAR(' ');\r | |
454 | }\r | |
455 | \r | |
456 | /* prefix */\r | |
457 | if (sign) {\r | |
458 | PUTCHAR(sign);\r | |
459 | } else if (flags & HEXPREFIX) {\r | |
460 | PUTCHAR('0');\r | |
461 | PUTCHAR(ch);\r | |
462 | }\r | |
463 | \r | |
464 | /* right-adjusting zero padding */\r | |
465 | if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD) {\r | |
466 | n = width - realsz;\r | |
467 | while (n-- > 0)\r | |
468 | PUTCHAR('0');\r | |
469 | }\r | |
470 | \r | |
471 | /* leading zeroes from decimal precision */\r | |
472 | n = dprec - size;\r | |
473 | while (n-- > 0)\r | |
474 | PUTCHAR('0');\r | |
475 | \r | |
476 | /* the string or number proper */\r | |
477 | while (size--)\r | |
478 | PUTCHAR(*cp++);\r | |
479 | /* left-adjusting padding (always blank) */\r | |
480 | if (flags & LADJUST) {\r | |
481 | n = width - realsz;\r | |
482 | while (n-- > 0)\r | |
483 | PUTCHAR(' ');\r | |
484 | }\r | |
485 | }\r | |
486 | \r | |
487 | done:\r | |
488 | if (sbuf == tailp)\r | |
489 | sbuf[-1] = '\0';\r | |
490 | else\r | |
491 | *sbuf = '\0';\r | |
492 | return (ret);\r | |
493 | /* NOTREACHED */\r | |
494 | }\r |