]>
git.zerfleddert.de Git - proxmark3-svn/blob - armsrc/printf.c
2 * Copyright (c) 1986, 1988, 1991, 1993
3 * The Regents of the University of California. All rights reserved.
4 * (c) UNIX System Laboratories, Inc.
5 * All or some portions of this file are derived from material licensed
6 * to the University of California by American Telephone and Telegraph
7 * Co. or Unix System Laboratories, Inc. and are reproduced herein with
8 * the permission of UNIX System Laboratories, Inc.
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 4. Neither the name of the University nor the names of its contributors
19 * may be used to endorse or promote products derived from this software
20 * without specific prior written permission.
22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34 * @(#)subr_prf.c 8.3 (Berkeley) 1/21/94
43 typedef unsigned char u_char
;
44 typedef unsigned int u_int
;
45 typedef unsigned long u_long
;
46 typedef unsigned short u_short
;
47 typedef unsigned long long u_quad_t
;
48 typedef long long quad_t
;
52 #define NBBY 8 /* number of bits in a byte */
54 char const hex2ascii_data
[] = "0123456789abcdefghijklmnopqrstuvwxyz";
55 #define hex2ascii(hex) (hex2ascii_data[hex])
56 #define toupper(c) ((c) - 0x20 * (((c) >= 'a') && ((c) <= 'z')))
58 /* Max number conversion buffer length: a u_quad_t in base 2, plus NUL byte. */
59 #define MAXNBUF (sizeof(intmax_t) * NBBY + 1)
62 * Put a NUL-terminated ASCII number (base <= 36) in a buffer in reverse
63 * order; return an optional length and a pointer to the last character
64 * written in the buffer (i.e., the first character of the string).
65 * The buffer pointed to by `nbuf' must have length >= MAXNBUF.
68 ksprintn(char *nbuf
, uintmax_t num
, int base
, int *lenp
, int upper
)
75 c
= hex2ascii(num
% base
);
76 *++p
= upper
? toupper(c
) : c
;
77 } while (num
/= base
);
84 * Scaled down version of printf(3).
86 * Two additional formats:
88 * The format %b is supported to decode error registers.
91 * printf("reg=%b\n", regval, "*");
93 * where is the output base expressed as a control character, e.g.
94 * \10 gives octal; \20 gives hex. Each arg is a sequence of characters,
95 * the first of which gives the bit number to be inspected (origin 1), and
96 * the next characters (up to a control character, i.e. a character <= 32),
97 * give the name of the register. Thus:
99 * kvprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n");
101 * would produce output:
105 * XXX: %D -- Hexdump, takes pointer and separator string:
106 * ("%6D", ptr, ":") -> XX:XX:XX:XX:XX:XX
107 * ("%*D", len, ptr, " " -> XX XX XX XX ...
110 kvsprintf(char const *fmt
, void *arg
, int radix
, va_list ap
)
112 #define PCHAR(c) {int cc=(c); *d++ = cc; retval++; }
115 const char *p
, *percent
, *q
;
119 int base
, lflag
, qflag
, tmp
, width
, ladjust
, sharpflag
, neg
, sign
, dot
;
120 int cflag
, hflag
, jflag
, tflag
, zflag
;
123 int stop
= 0, retval
= 0;
129 fmt
= "(fmt null)\n";
131 if (radix
< 2 || radix
> 36)
137 while ((ch
= (u_char
)*fmt
++) != '%' || stop
) {
143 qflag
= 0; lflag
= 0; ladjust
= 0; sharpflag
= 0; neg
= 0;
144 sign
= 0; dot
= 0; dwidth
= 0; upper
= 0;
145 cflag
= 0; hflag
= 0; jflag
= 0; tflag
= 0; zflag
= 0;
146 reswitch
: switch (ch
= (u_char
)*fmt
++) {
164 width
= va_arg(ap
, int);
170 dwidth
= va_arg(ap
, int);
178 // intentionally fall through to next case
179 case '1': case '2': case '3': case '4':
180 case '5': case '6': case '7': case '8': case '9':
181 for (n
= 0;; ++fmt
) {
182 n
= n
* 10 + ch
- '0';
184 if (ch
< '0' || ch
> '9')
193 num
= (u_int
)va_arg(ap
, int);
194 p
= va_arg(ap
, char *);
195 for (q
= ksprintn(nbuf
, num
, *p
++, NULL
, 0); *q
;)
203 if (num
& (1 << (n
- 1))) {
204 PCHAR(tmp
? ',' : '<');
205 for (; (n
= *p
) > ' '; ++p
)
209 for (; *p
> ' '; ++p
)
216 PCHAR(va_arg(ap
, int));
219 up
= va_arg(ap
, u_char
*);
220 p
= va_arg(ap
, char *);
224 PCHAR(hex2ascii(*up
>> 4));
225 PCHAR(hex2ascii(*up
& 0x0f));
256 *(va_arg(ap
, intmax_t *)) = retval
;
258 *(va_arg(ap
, quad_t
*)) = retval
;
260 *(va_arg(ap
, long *)) = retval
;
262 *(va_arg(ap
, size_t *)) = retval
;
264 *(va_arg(ap
, short *)) = retval
;
266 *(va_arg(ap
, char *)) = retval
;
268 *(va_arg(ap
, int *)) = retval
;
275 sharpflag
= (width
== 0);
277 num
= (uintptr_t)va_arg(ap
, void *);
288 p
= va_arg(ap
, char *);
294 for (n
= 0; n
< dwidth
&& p
[n
]; n
++)
299 if (!ladjust
&& width
> 0)
304 if (ladjust
&& width
> 0)
329 num
= va_arg(ap
, uintmax_t);
331 num
= va_arg(ap
, u_quad_t
);
333 num
= va_arg(ap
, ptrdiff_t);
335 num
= va_arg(ap
, u_long
);
337 num
= va_arg(ap
, size_t);
339 num
= (u_short
)va_arg(ap
, int);
341 num
= (u_char
)va_arg(ap
, int);
343 num
= va_arg(ap
, u_int
);
347 num
= va_arg(ap
, intmax_t);
349 num
= va_arg(ap
, quad_t
);
351 num
= va_arg(ap
, ptrdiff_t);
353 num
= va_arg(ap
, long);
355 num
= va_arg(ap
, ssize_t
);
357 num
= (short)va_arg(ap
, int);
359 num
= (char)va_arg(ap
, int);
361 num
= va_arg(ap
, int);
363 if (sign
&& (intmax_t)num
< 0) {
365 num
= -(intmax_t)num
;
367 p
= ksprintn(nbuf
, num
, base
, &tmp
, upper
);
368 if (sharpflag
&& num
!= 0) {
377 if (!ladjust
&& padc
!= '0' && width
378 && (width
-= tmp
) > 0)
383 if (sharpflag
&& num
!= 0) {
386 } else if (base
== 16) {
391 if (!ladjust
&& width
&& (width
-= tmp
) > 0)
398 if (ladjust
&& width
&& (width
-= tmp
) > 0)
404 while (percent
< fmt
)
407 * Since we ignore an formatting argument it is no
408 * longer safe to obey the remaining formatting
409 * arguments as the arguments will no longer match
421 int vsprintf(char *dest
, const char *fmt
, va_list ap
)
423 return kvsprintf(fmt
, dest
, 10, ap
);
427 sprintf(char *dest
, const char *fmt
, ...)
429 /* http://www.pagetable.com/?p=298 */
434 retval
= kvsprintf(fmt
, dest
, 10, ap
);