]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - armsrc/printf.c
d5e61798a3516f82ee932922f8b63e1a81139ef2
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 uint32_t uintmax_t;
44 typedef int32_t intmax_t;
46 typedef unsigned char u_char
;
47 typedef unsigned int u_int
;
48 typedef unsigned long u_long
;
49 typedef unsigned short u_short
;
50 typedef unsigned long long u_quad_t
;
51 typedef long long quad_t
;
55 #define NBBY 8 /* number of bits in a byte */
57 char const hex2ascii_data
[] = "0123456789abcdefghijklmnopqrstuvwxyz";
58 #define hex2ascii(hex) (hex2ascii_data[hex])
59 #define toupper(c) ((c) - 0x20 * (((c) >= 'a') && ((c) <= 'z')))
61 /* Max number conversion buffer length: a u_quad_t in base 2, plus NUL byte. */
62 #define MAXNBUF (sizeof(intmax_t) * NBBY + 1)
65 * Put a NUL-terminated ASCII number (base <= 36) in a buffer in reverse
66 * order; return an optional length and a pointer to the last character
67 * written in the buffer (i.e., the first character of the string).
68 * The buffer pointed to by `nbuf' must have length >= MAXNBUF.
71 ksprintn(char *nbuf
, uintmax_t num
, int base
, int *lenp
, int upper
)
78 c
= hex2ascii(num
% base
);
79 *++p
= upper
? toupper(c
) : c
;
80 } while (num
/= base
);
87 * Scaled down version of printf(3).
89 * Two additional formats:
91 * The format %b is supported to decode error registers.
94 * printf("reg=%b\n", regval, "*");
96 * where is the output base expressed as a control character, e.g.
97 * \10 gives octal; \20 gives hex. Each arg is a sequence of characters,
98 * the first of which gives the bit number to be inspected (origin 1), and
99 * the next characters (up to a control character, i.e. a character <= 32),
100 * give the name of the register. Thus:
102 * kvprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n");
104 * would produce output:
108 * XXX: %D -- Hexdump, takes pointer and separator string:
109 * ("%6D", ptr, ":") -> XX:XX:XX:XX:XX:XX
110 * ("%*D", len, ptr, " " -> XX XX XX XX ...
113 kvsprintf(char const *fmt
, void *arg
, int radix
, va_list ap
)
115 #define PCHAR(c) {int cc=(c); *d++ = cc; retval++; }
118 const char *p
, *percent
, *q
;
122 int base
, lflag
, qflag
, tmp
, width
, ladjust
, sharpflag
, neg
, sign
, dot
;
123 int cflag
, hflag
, jflag
, tflag
, zflag
;
126 int stop
= 0, retval
= 0;
132 fmt
= "(fmt null)\n";
134 if (radix
< 2 || radix
> 36)
140 while ((ch
= (u_char
)*fmt
++) != '%' || stop
) {
146 qflag
= 0; lflag
= 0; ladjust
= 0; sharpflag
= 0; neg
= 0;
147 sign
= 0; dot
= 0; dwidth
= 0; upper
= 0;
148 cflag
= 0; hflag
= 0; jflag
= 0; tflag
= 0; zflag
= 0;
149 reswitch
: switch (ch
= (u_char
)*fmt
++) {
167 width
= va_arg(ap
, int);
173 dwidth
= va_arg(ap
, int);
181 case '1': case '2': case '3': case '4':
182 case '5': case '6': case '7': case '8': case '9':
183 for (n
= 0;; ++fmt
) {
184 n
= n
* 10 + ch
- '0';
186 if (ch
< '0' || ch
> '9')
195 num
= (u_int
)va_arg(ap
, int);
196 p
= va_arg(ap
, char *);
197 for (q
= ksprintn(nbuf
, num
, *p
++, NULL
, 0); *q
;)
205 if (num
& (1 << (n
- 1))) {
206 PCHAR(tmp
? ',' : '<');
207 for (; (n
= *p
) > ' '; ++p
)
211 for (; *p
> ' '; ++p
)
218 PCHAR(va_arg(ap
, int));
221 up
= va_arg(ap
, u_char
*);
222 p
= va_arg(ap
, char *);
226 PCHAR(hex2ascii(*up
>> 4));
227 PCHAR(hex2ascii(*up
& 0x0f));
258 *(va_arg(ap
, intmax_t *)) = retval
;
260 *(va_arg(ap
, quad_t
*)) = retval
;
262 *(va_arg(ap
, long *)) = retval
;
264 *(va_arg(ap
, size_t *)) = retval
;
266 *(va_arg(ap
, short *)) = retval
;
268 *(va_arg(ap
, char *)) = retval
;
270 *(va_arg(ap
, int *)) = retval
;
277 sharpflag
= (width
== 0);
279 num
= (uintptr_t)va_arg(ap
, void *);
290 p
= va_arg(ap
, char *);
296 for (n
= 0; n
< dwidth
&& p
[n
]; n
++)
301 if (!ladjust
&& width
> 0)
306 if (ladjust
&& width
> 0)
331 num
= va_arg(ap
, uintmax_t);
333 num
= va_arg(ap
, u_quad_t
);
335 num
= va_arg(ap
, ptrdiff_t);
337 num
= va_arg(ap
, u_long
);
339 num
= va_arg(ap
, size_t);
341 num
= (u_short
)va_arg(ap
, int);
343 num
= (u_char
)va_arg(ap
, int);
345 num
= va_arg(ap
, u_int
);
349 num
= va_arg(ap
, intmax_t);
351 num
= va_arg(ap
, quad_t
);
353 num
= va_arg(ap
, ptrdiff_t);
355 num
= va_arg(ap
, long);
357 num
= va_arg(ap
, ssize_t
);
359 num
= (short)va_arg(ap
, int);
361 num
= (char)va_arg(ap
, int);
363 num
= va_arg(ap
, int);
365 if (sign
&& (intmax_t)num
< 0) {
367 num
= -(intmax_t)num
;
369 p
= ksprintn(nbuf
, num
, base
, &tmp
, upper
);
370 if (sharpflag
&& num
!= 0) {
379 if (!ladjust
&& padc
!= '0' && width
380 && (width
-= tmp
) > 0)
385 if (sharpflag
&& num
!= 0) {
388 } else if (base
== 16) {
393 if (!ladjust
&& width
&& (width
-= tmp
) > 0)
400 if (ladjust
&& width
&& (width
-= tmp
) > 0)
406 while (percent
< fmt
)
409 * Since we ignore an formatting argument it is no
410 * longer safe to obey the remaining formatting
411 * arguments as the arguments will no longer match
423 int vsprintf(char *dest
, const char *fmt
, va_list ap
)
425 return kvsprintf(fmt
, dest
, 10, ap
);
429 sprintf(char *dest
, const char *fmt
, ...)
431 /* http://www.pagetable.com/?p=298 */
436 retval
= kvsprintf(fmt
, dest
, 10, ap
);