cueOS  2.4
cueOS - Universal Show Control OS for ARM
printf-stdarg.c
1/*
2 Copyright 2001, 2002 Georges Menie (www.menie.org)
3 stdarg version contributed by Christian Ettinger
4
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU Lesser General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
9
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU Lesser General Public License for more details.
14
15 You should have received a copy of the GNU Lesser General Public License
16 along with this program; if not, write to the Free Software
17 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18*/
19
20/*
21 putchar is the only external dependency for this file,
22 if you have a working putchar, leave it commented out.
23 If not, uncomment the define below and
24 replace outbyte(c) by your own function call.
25
26*/
27
28#include <stdio.h>
29#include <stdarg.h>
30#include <stdint.h>
31#include "printf-stdarg.h"
32
33static void printchar(char **str, int c)
34{
35 if (str) {
36 **str = (char)c;
37 ++(*str);
38 }
39 else
40 {
41 (void)putchar(c);
42 }
43}
44
45int puts(const char *s)
46{
47 while(*s)
48 putchar(*s++);
49 return 1;
50}
51
52#define PAD_RIGHT 1
53#define PAD_ZERO 2
54
55static int prints(char **out, const char *string, int width, int pad)
56{
57 register int pc = 0, padchar = ' ';
58
59 if (width > 0) {
60 register int len = 0;
61 register const char *ptr;
62 for (ptr = string; *ptr; ++ptr) ++len;
63 if (len >= width) width = 0;
64 else width -= len;
65 if (pad & PAD_ZERO) padchar = '0';
66 }
67 if (!(pad & PAD_RIGHT)) {
68 for ( ; width > 0; --width) {
69 printchar (out, padchar);
70 ++pc;
71 }
72 }
73 for ( ; *string ; ++string) {
74 printchar (out, *string);
75 ++pc;
76 }
77 for ( ; width > 0; --width) {
78 printchar (out, padchar);
79 ++pc;
80 }
81
82 return pc;
83}
84
85/* the following should be enough for 32 bit int */
86#define PRINT_BUF_LEN 12
87
88static int printi(char **out, int i, int b, int sg, int width, int pad, int letbase)
89{
90 char print_buf[PRINT_BUF_LEN];
91 register char *s;
92 register int t, neg = 0, pc = 0;
93 register unsigned int u = (unsigned int)i;
94
95 if (i == 0) {
96 print_buf[0] = '0';
97 print_buf[1] = '\0';
98 return prints (out, print_buf, width, pad);
99 }
100
101 if (sg && b == 10 && i < 0) {
102 neg = 1;
103 u = (unsigned int)-i;
104 }
105
106 s = print_buf + PRINT_BUF_LEN-1;
107 *s = '\0';
108
109 while (u) {
110 t = (unsigned int)u % b;
111 if( t >= 10 )
112 t += letbase - '0' - 10;
113 *--s = (char)(t + '0');
114 u /= b;
115 }
116
117 if (neg) {
118 if( width && (pad & PAD_ZERO) ) {
119 printchar (out, '-');
120 ++pc;
121 --width;
122 }
123 else {
124 *--s = '-';
125 }
126 }
127
128 return pc + prints (out, s, width, pad);
129}
130
131static int print( char **out, const char *format, va_list args )
132{
133 register int width, pad;
134 register int pc = 0;
135 char scr[2];
136
137 for (; *format != 0; ++format) {
138 if (*format == '%') {
139 ++format;
140 width = pad = 0;
141 if (*format == '\0') break;
142 if (*format == '%') goto out;
143 if (*format == '-') {
144 ++format;
145 pad = PAD_RIGHT;
146 }
147 while (*format == '0') {
148 ++format;
149 pad |= PAD_ZERO;
150 }
151 for ( ; *format >= '0' && *format <= '9'; ++format) {
152 width *= 10;
153 width += *format - '0';
154 }
155 if( *format == 's' ) {
156 register char *s = (char *)va_arg( args, int );
157 pc += prints (out, s?s:"(null)", width, pad);
158 continue;
159 }
160 if( *format == 'l' ) {
161 ++format;
162 if( *format == 'd' ) {
163 pc += printi (out, va_arg( args, long ), 10, 1, width, pad, 'a');
164 continue;
165 }
166 if( *format == 'u' ) {
167 pc += printi (out, va_arg( args, long ), 10, 0, width, pad, 'a');
168 continue;
169 }
170 }
171 if( *format == 'd' ) {
172 pc += printi (out, va_arg( args, int ), 10, 1, width, pad, 'a');
173 continue;
174 }
175 if( *format == 'x' ) {
176 pc += printi (out, va_arg( args, int ), 16, 0, width, pad, 'a');
177 continue;
178 }
179 if( *format == 'p' ) {
180 pc += prints (out, "0x", width, pad);
181 pc += printi (out, va_arg( args, int ), 16, 0, 8, PAD_ZERO, 'a');
182 continue;
183 }
184 if( *format == 'X' ) {
185 pc += printi (out, va_arg( args, int ), 16, 0, width, pad, 'A');
186 continue;
187 }
188 if( *format == 'u' ) {
189 pc += printi (out, va_arg( args, int ), 10, 0, width, pad, 'a');
190 continue;
191 }
192 if( *format == 'c' ) {
193 /* char are converted to int then pushed on the stack */
194 scr[0] = (char)va_arg( args, int );
195 scr[1] = '\0';
196 pc += prints (out, scr, width, pad);
197 continue;
198 }
199 }
200 else {
201 out:
202 printchar (out, *format);
203 ++pc;
204 if('\n' == *format) {
205 printchar(out, '\r');
206 ++pc;
207 }
208 }
209 }
210 if (out) **out = '\0';
211 va_end( args );
212 return pc;
213}
214
215int printf(const char *format, ...)
216{
217 va_list args;
218
219 va_start( args, format );
220 return print( 0, format, args );
221}
222
223int sprintf(char *out, const char *format, ...)
224{
225 va_list args;
226
227 va_start( args, format );
228 return print( &out, format, args );
229}
230
231
232int snprintf( char *buf, unsigned int count, const char *format, ... )
233{
234 va_list args;
235
236 ( void ) count;
237
238 va_start( args, format );
239 return print( &buf, format, args );
240}
241
242
243#ifdef TEST_PRINTF
244int main(void)
245{
246 char *ptr = "Hello world!";
247 char *np = 0;
248 int i = 5;
249 unsigned int bs = sizeof(int)*8;
250 int mi;
251 char buf[80];
252
253 mi = (1 << (bs-1)) + 1;
254 printf("%s\n", ptr);
255 printf("printf test\n");
256 printf("%s is null pointer\n", np);
257 printf("%d = 5\n", i);
258 printf("%d = - max int\n", mi);
259 printf("char %c = 'a'\n", 'a');
260 printf("hex %x = ff\n", 0xff);
261 printf("hex %02x = 00\n", 0);
262 printf("signed %d = unsigned %u = hex %x\n", -3, -3, -3);
263 printf("%d %s(s)%", 0, "message");
264 printf("\n");
265 printf("%d %s(s) with %%\n", 0, "message");
266 sprintf(buf, "justif: \"%-10s\"\n", "left"); printf("%s", buf);
267 sprintf(buf, "justif: \"%10s\"\n", "right"); printf("%s", buf);
268 sprintf(buf, " 3: %04d zero padded\n", 3); printf("%s", buf);
269 sprintf(buf, " 3: %-4d left justif.\n", 3); printf("%s", buf);
270 sprintf(buf, " 3: %4d right justif.\n", 3); printf("%s", buf);
271 sprintf(buf, "-3: %04d zero padded\n", -3); printf("%s", buf);
272 sprintf(buf, "-3: %-4d left justif.\n", -3); printf("%s", buf);
273 sprintf(buf, "-3: %4d right justif.\n", -3); printf("%s", buf);
274
275 return 0;
276}
277
278/*
279 * if you compile this file with
280 * gcc -Wall $(YOUR_C_OPTIONS) -DTEST_PRINTF -c printf.c
281 * you will get a normal warning:
282 * printf.c:214: warning: spurious trailing `%' in format
283 * this line is testing an invalid % at the end of the format string.
284 *
285 * this should display (on 32bit int machine) :
286 *
287 * Hello world!
288 * printf test
289 * (null) is null pointer
290 * 5 = 5
291 * -2147483647 = - max int
292 * char a = 'a'
293 * hex ff = ff
294 * hex 00 = 00
295 * signed -3 = unsigned 4294967293 = hex fffffffd
296 * 0 message(s)
297 * 0 message(s) with %
298 * justif: "left "
299 * justif: " right"
300 * 3: 0003 zero padded
301 * 3: 3 left justif.
302 * 3: 3 right justif.
303 * -3: -003 zero padded
304 * -3: -3 left justif.
305 * -3: -3 right justif.
306 */
307
308#endif
309
310
311