comparison gsm-fw/sprintf/old/doprnt.c @ 145:7e45ada9c365

gsm-fw: sprintf overhaul in preparation for adding %f format support
author Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date Thu, 14 Nov 2013 17:51:33 +0000
parents gsm-fw/sprintf/doprnt.c@afceeeb2cba1
children
comparison
equal deleted inserted replaced
144:ea819b60fe0d 145:7e45ada9c365
1 /* the guts of printf - this implementation came from 4.3BSD-Tahoe */
2
3 #include <sys/types.h>
4 #include <ctype.h>
5 #include <stdarg.h>
6
7 #define PUTC(ch) (*(*outptrp)++ = (ch))
8
9 #define ARG() \
10 _ulong = flags&LONGINT ? va_arg(argp, long) : va_arg(argp, int);
11
12 #define BUF 256
13
14 #define todigit(c) ((c) - '0')
15 #define tochar(n) ((n) + '0')
16
17 /* have to deal with the negative buffer count kludge */
18 #define NEGATIVE_COUNT_KLUDGE
19
20 #define LONGINT 0x01 /* long integer */
21 #define LONGDBL 0x02 /* long double; unimplemented */
22 #define SHORTINT 0x04 /* short integer */
23 #define ALT 0x08 /* alternate form */
24 #define LADJUST 0x10 /* left adjustment */
25 #define ZEROPAD 0x20 /* zero (as opposed to blank) pad */
26 #define HEXPREFIX 0x40 /* add 0x or 0X prefix */
27
28 _doprnt(fmt0, argp, outptrp)
29 u_char *fmt0;
30 va_list argp;
31 char **outptrp;
32 {
33 register u_char *fmt; /* format string */
34 register int ch; /* character from fmt */
35 register int cnt; /* return value accumulator */
36 register int n; /* random handy integer */
37 register char *t; /* buffer pointer */
38 u_long _ulong; /* integer arguments %[diouxX] */
39 int base; /* base for [diouxX] conversion */
40 int dprec; /* decimal precision in [diouxX] */
41 int fieldsz; /* field size expanded by sign, etc */
42 int flags; /* flags as above */
43 int prec; /* precision from format (%.3d), or -1 */
44 int realsz; /* field size expanded by decimal precision */
45 int size; /* size of converted field or string */
46 int width; /* width from format (%8d), or 0 */
47 char sign; /* sign prefix (' ', '+', '-', or \0) */
48 char softsign; /* temporary negative sign for floats */
49 char *digs; /* digits for [diouxX] conversion */
50 char buf[BUF]; /* space for %c, %[diouxX], %[eEfgG] */
51
52 fmt = fmt0;
53 digs = "0123456789abcdef";
54 for (cnt = 0;; ++fmt) {
55 for (; (ch = *fmt) && ch != '%'; ++cnt, ++fmt)
56 PUTC(ch);
57 if (!ch)
58 return (cnt);
59
60 flags = 0; dprec = 0; width = 0;
61 prec = -1;
62 sign = '\0';
63
64 rflag: switch (*++fmt) {
65 case ' ':
66 /*
67 * ``If the space and + flags both appear, the space
68 * flag will be ignored.''
69 * -- ANSI X3J11
70 */
71 if (!sign)
72 sign = ' ';
73 goto rflag;
74 case '#':
75 flags |= ALT;
76 goto rflag;
77 case '*':
78 /*
79 * ``A negative field width argument is taken as a
80 * - flag followed by a positive field width.''
81 * -- ANSI X3J11
82 * They don't exclude field widths read from args.
83 */
84 if ((width = va_arg(argp, int)) >= 0)
85 goto rflag;
86 width = -width;
87 /* FALLTHROUGH */
88 case '-':
89 flags |= LADJUST;
90 goto rflag;
91 case '+':
92 sign = '+';
93 goto rflag;
94 case '.':
95 if (*++fmt == '*')
96 n = va_arg(argp, int);
97 else {
98 n = 0;
99 while (isascii(*fmt) && isdigit(*fmt))
100 n = 10 * n + todigit(*fmt++);
101 --fmt;
102 }
103 prec = n < 0 ? -1 : n;
104 goto rflag;
105 case '0':
106 /*
107 * ``Note that 0 is taken as a flag, not as the
108 * beginning of a field width.''
109 * -- ANSI X3J11
110 */
111 flags |= ZEROPAD;
112 goto rflag;
113 case '1': case '2': case '3': case '4':
114 case '5': case '6': case '7': case '8': case '9':
115 n = 0;
116 do {
117 n = 10 * n + todigit(*fmt);
118 } while (isascii(*++fmt) && isdigit(*fmt));
119 width = n;
120 --fmt;
121 goto rflag;
122 case 'L':
123 flags |= LONGDBL;
124 goto rflag;
125 case 'h':
126 flags |= SHORTINT;
127 goto rflag;
128 case 'l':
129 flags |= LONGINT;
130 goto rflag;
131 case 'c':
132 *(t = buf) = va_arg(argp, int);
133 size = 1;
134 sign = '\0';
135 goto pforw;
136 case 'D':
137 flags |= LONGINT;
138 /*FALLTHROUGH*/
139 case 'd':
140 case 'i':
141 ARG();
142 if ((long)_ulong < 0) {
143 _ulong = -_ulong;
144 sign = '-';
145 }
146 base = 10;
147 goto number;
148 case 'n':
149 if (flags & LONGINT)
150 *va_arg(argp, long *) = cnt;
151 else if (flags & SHORTINT)
152 *va_arg(argp, short *) = cnt;
153 else
154 *va_arg(argp, int *) = cnt;
155 break;
156 case 'O':
157 flags |= LONGINT;
158 /*FALLTHROUGH*/
159 case 'o':
160 ARG();
161 base = 8;
162 goto nosign;
163 case 'p':
164 /*
165 * ``The argument shall be a pointer to void. The
166 * value of the pointer is converted to a sequence
167 * of printable characters, in an implementation-
168 * defined manner.''
169 * -- ANSI X3J11
170 */
171 /* NOSTRICT */
172 _ulong = (u_long)va_arg(argp, void *);
173 base = 16;
174 goto nosign;
175 case 's':
176 if (!(t = va_arg(argp, char *)))
177 t = "(null)";
178 if (prec >= 0) {
179 /*
180 * can't use strlen; can only look for the
181 * NUL in the first `prec' characters, and
182 * strlen() will go further.
183 */
184 char *p;
185
186 for (p = t, size = 0; size < prec; p++, size++)
187 if (*p == '\0')
188 break;
189 } else
190 size = strlen(t);
191 sign = '\0';
192 goto pforw;
193 case 'U':
194 flags |= LONGINT;
195 /*FALLTHROUGH*/
196 case 'u':
197 ARG();
198 base = 10;
199 goto nosign;
200 case 'X':
201 digs = "0123456789ABCDEF";
202 /* FALLTHROUGH */
203 case 'x':
204 ARG();
205 base = 16;
206 /* leading 0x/X only if non-zero */
207 if (flags & ALT && _ulong != 0)
208 flags |= HEXPREFIX;
209
210 /* unsigned conversions */
211 nosign: sign = '\0';
212 /*
213 * ``... diouXx conversions ... if a precision is
214 * specified, the 0 flag will be ignored.''
215 * -- ANSI X3J11
216 */
217 number: if ((dprec = prec) >= 0)
218 flags &= ~ZEROPAD;
219
220 /*
221 * ``The result of converting a zero value with an
222 * explicit precision of zero is no characters.''
223 * -- ANSI X3J11
224 */
225 t = buf + BUF;
226 if (_ulong != 0 || prec != 0) {
227 do {
228 *--t = digs[_ulong % base];
229 _ulong /= base;
230 } while (_ulong);
231 digs = "0123456789abcdef";
232 if (flags & ALT && base == 8 && *t != '0')
233 *--t = '0'; /* octal leading 0 */
234 }
235 size = buf + BUF - t;
236
237 pforw:
238 /*
239 * All reasonable formats wind up here. At this point,
240 * `t' points to a string which (if not flags&LADJUST)
241 * should be padded out to `width' places. If
242 * flags&ZEROPAD, it should first be prefixed by any
243 * sign or other prefix; otherwise, it should be blank
244 * padded before the prefix is emitted. After any
245 * left-hand padding and prefixing, emit zeroes
246 * required by a decimal [diouxX] precision, then print
247 * the string proper, then emit zeroes required by any
248 * leftover floating precision; finally, if LADJUST,
249 * pad with blanks.
250 */
251
252 /*
253 * compute actual size, so we know how much to pad
254 * fieldsz excludes decimal prec; realsz includes it
255 */
256 fieldsz = size;
257 if (sign)
258 fieldsz++;
259 if (flags & HEXPREFIX)
260 fieldsz += 2;
261 realsz = dprec > fieldsz ? dprec : fieldsz;
262
263 /* right-adjusting blank padding */
264 if ((flags & (LADJUST|ZEROPAD)) == 0 && width)
265 for (n = realsz; n < width; n++)
266 PUTC(' ');
267 /* prefix */
268 if (sign)
269 PUTC(sign);
270 if (flags & HEXPREFIX) {
271 PUTC('0');
272 PUTC((char)*fmt);
273 }
274 /* right-adjusting zero padding */
275 if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD)
276 for (n = realsz; n < width; n++)
277 PUTC('0');
278 /* leading zeroes from decimal precision */
279 for (n = fieldsz; n < dprec; n++)
280 PUTC('0');
281
282 for (n = size; --n >= 0; )
283 PUTC(*t++);
284 /* left-adjusting padding (always blank) */
285 if (flags & LADJUST)
286 for (n = realsz; n < width; n++)
287 PUTC(' ');
288 /* finally, adjust cnt */
289 cnt += width > realsz ? width : realsz;
290 break;
291 case '\0': /* "%?" prints ?, unless ? is NULL */
292 return (cnt);
293 default:
294 PUTC((char)*fmt);
295 cnt++;
296 }
297 }
298 /* NOTREACHED */
299 }