]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - armsrc/printf.c
6060870dc3587cb5b2a6faf9ee8c98128229a991
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
37 typedef unsigned long size_t;
40 typedef unsigned long long uintmax_t;
41 typedef long long intmax_t;
43 typedef unsigned int uintmax_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
;
52 typedef unsigned long uintptr_t;
53 typedef long ptrdiff_t;
54 #define NULL ((void*)0)
55 #define NBBY 8 /* number of bits in a byte */
56 char const hex2ascii_data
[] = "0123456789abcdefghijklmnopqrstuvwxyz";
57 #define hex2ascii(hex) (hex2ascii_data[hex])
58 #define va_list __builtin_va_list
59 #define va_start __builtin_va_start
60 #define va_arg __builtin_va_arg
61 #define va_end __builtin_va_end
62 #define toupper(c) ((c) - 0x20 * (((c) >= 'a') && ((c) <= 'z')))
72 /* Max number conversion buffer length: a u_quad_t in base 2, plus NUL byte. */
73 #define MAXNBUF (sizeof(intmax_t) * NBBY + 1)
76 * Put a NUL-terminated ASCII number (base <= 36) in a buffer in reverse
77 * order; return an optional length and a pointer to the last character
78 * written in the buffer (i.e., the first character of the string).
79 * The buffer pointed to by `nbuf' must have length >= MAXNBUF.
82 ksprintn(char *nbuf
, uintmax_t num
, int base
, int *lenp
, int upper
)
89 c
= hex2ascii(num
% base
);
90 *++p
= upper
? toupper(c
) : c
;
91 } while (num
/= base
);
98 * Scaled down version of printf(3).
100 * Two additional formats:
102 * The format %b is supported to decode error registers.
105 * printf("reg=%b\n", regval, "*");
107 * where is the output base expressed as a control character, e.g.
108 * \10 gives octal; \20 gives hex. Each arg is a sequence of characters,
109 * the first of which gives the bit number to be inspected (origin 1), and
110 * the next characters (up to a control character, i.e. a character <= 32),
111 * give the name of the register. Thus:
113 * kvprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n");
115 * would produce output:
119 * XXX: %D -- Hexdump, takes pointer and separator string:
120 * ("%6D", ptr, ":") -> XX:XX:XX:XX:XX:XX
121 * ("%*D", len, ptr, " " -> XX XX XX XX ...
124 kvsprintf(char const *fmt
, void *arg
, int radix
, va_list ap
)
126 #define PCHAR(c) {int cc=(c); *d++ = cc; retval++; }
129 const char *p
, *percent
, *q
;
133 int base
, lflag
, qflag
, tmp
, width
, ladjust
, sharpflag
, neg
, sign
, dot
;
134 int cflag
, hflag
, jflag
, tflag
, zflag
;
137 int stop
= 0, retval
= 0;
143 fmt
= "(fmt null)\n";
145 if (radix
< 2 || radix
> 36)
151 while ((ch
= (u_char
)*fmt
++) != '%' || stop
) {
157 qflag
= 0; lflag
= 0; ladjust
= 0; sharpflag
= 0; neg
= 0;
158 sign
= 0; dot
= 0; dwidth
= 0; upper
= 0;
159 cflag
= 0; hflag
= 0; jflag
= 0; tflag
= 0; zflag
= 0;
160 reswitch
: switch (ch
= (u_char
)*fmt
++) {
178 width
= va_arg(ap
, int);
184 dwidth
= va_arg(ap
, int);
192 case '1': case '2': case '3': case '4':
193 case '5': case '6': case '7': case '8': case '9':
194 for (n
= 0;; ++fmt
) {
195 n
= n
* 10 + ch
- '0';
197 if (ch
< '0' || ch
> '9')
206 num
= (u_int
)va_arg(ap
, int);
207 p
= va_arg(ap
, char *);
208 for (q
= ksprintn(nbuf
, num
, *p
++, NULL
, 0); *q
;)
216 if (num
& (1 << (n
- 1))) {
217 PCHAR(tmp
? ',' : '<');
218 for (; (n
= *p
) > ' '; ++p
)
222 for (; *p
> ' '; ++p
)
229 PCHAR(va_arg(ap
, int));
232 up
= va_arg(ap
, u_char
*);
233 p
= va_arg(ap
, char *);
237 PCHAR(hex2ascii(*up
>> 4));
238 PCHAR(hex2ascii(*up
& 0x0f));
269 *(va_arg(ap
, intmax_t *)) = retval
;
271 *(va_arg(ap
, quad_t
*)) = retval
;
273 *(va_arg(ap
, long *)) = retval
;
275 *(va_arg(ap
, size_t *)) = retval
;
277 *(va_arg(ap
, short *)) = retval
;
279 *(va_arg(ap
, char *)) = retval
;
281 *(va_arg(ap
, int *)) = retval
;
288 sharpflag
= (width
== 0);
290 num
= (uintptr_t)va_arg(ap
, void *);
301 p
= va_arg(ap
, char *);
307 for (n
= 0; n
< dwidth
&& p
[n
]; n
++)
312 if (!ladjust
&& width
> 0)
317 if (ladjust
&& width
> 0)
342 num
= va_arg(ap
, uintmax_t);
344 num
= va_arg(ap
, u_quad_t
);
346 num
= va_arg(ap
, ptrdiff_t);
348 num
= va_arg(ap
, u_long
);
350 num
= va_arg(ap
, size_t);
352 num
= (u_short
)va_arg(ap
, int);
354 num
= (u_char
)va_arg(ap
, int);
356 num
= va_arg(ap
, u_int
);
360 num
= va_arg(ap
, intmax_t);
362 num
= va_arg(ap
, quad_t
);
364 num
= va_arg(ap
, ptrdiff_t);
366 num
= va_arg(ap
, long);
368 num
= va_arg(ap
, ssize_t
);
370 num
= (short)va_arg(ap
, int);
372 num
= (char)va_arg(ap
, int);
374 num
= va_arg(ap
, int);
376 if (sign
&& (intmax_t)num
< 0) {
378 num
= -(intmax_t)num
;
380 p
= ksprintn(nbuf
, num
, base
, &tmp
, upper
);
381 if (sharpflag
&& num
!= 0) {
390 if (!ladjust
&& padc
!= '0' && width
391 && (width
-= tmp
) > 0)
396 if (sharpflag
&& num
!= 0) {
399 } else if (base
== 16) {
404 if (!ladjust
&& width
&& (width
-= tmp
) > 0)
411 if (ladjust
&& width
&& (width
-= tmp
) > 0)
417 while (percent
< fmt
)
420 * Since we ignore an formatting argument it is no
421 * longer safe to obey the remaining formatting
422 * arguments as the arguments will no longer match
435 sprintf(char *dest
, const char *fmt
, ...)
437 /* http://www.pagetable.com/?p=298 */
442 retval
= kvsprintf(fmt
, dest
, 10, ap
);