2 * Copyright (C) 2001 MontaVista Software Inc.
3 * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2 of the License, or (at your
8 * option) any later version.
14 extern void board_putc(int ch);
16 /* this is the maximum width for a variable */
17 #define LP_MAX_BUF 256
20 #define IsDigit(x) ( ((x) >= '0') && ((x) <= '9') )
21 #define Ctod(x) ( (x) - '0')
23 /* forward declaration */
24 static int PrintChar(char *, char, int, int);
25 static int PrintString(char *, char *, int, int);
26 static int PrintNum(char *, unsigned long, int, int, int, int, char, int);
28 /* private variable */
29 static const char theFatalMsg[] = "fatal error in lp_Print!";
32 * A low level printf() function.
35 lp_Print(void (*output)(void *, char *, int),
41 #define OUTPUT(arg, s, l) \
42 { if (((l) < 0) || ((l) > LP_MAX_BUF)) { \
43 (*output)(arg, (char*)theFatalMsg, sizeof(theFatalMsg)-1); for(;;); \
45 (*output)(arg, s, l); \
66 /* scan for the next '%' */
68 while ( (*fmt != '\0') && (*fmt != '%')) {
72 /* flush the string found so far */
73 OUTPUT(arg, fmtStart, fmt-fmtStart);
75 /* are we hitting the end? */
76 if (*fmt == '\0') break;
90 /* check for other prefixes */
107 while (IsDigit(*fmt)) {
108 width = 10 * width + Ctod(*fmt++);
116 while (IsDigit(*fmt)) {
117 prec = prec*10 + Ctod(*fmt++);
123 /* check format flag */
128 num = va_arg(ap, long int);
130 num = va_arg(ap, int);
132 length = PrintNum(buf, num, 2, 0, width, ladjust, padc, 0);
133 OUTPUT(arg, buf, length);
139 num = va_arg(ap, long int);
141 num = va_arg(ap, int);
147 length = PrintNum(buf, num, 10, negFlag, width, ladjust, padc, 0);
148 OUTPUT(arg, buf, length);
154 num = va_arg(ap, long int);
156 num = va_arg(ap, int);
158 length = PrintNum(buf, num, 8, 0, width, ladjust, padc, 0);
159 OUTPUT(arg, buf, length);
165 num = va_arg(ap, long int);
167 num = va_arg(ap, int);
169 length = PrintNum(buf, num, 10, 0, width, ladjust, padc, 0);
170 OUTPUT(arg, buf, length);
175 num = va_arg(ap, long int);
177 num = va_arg(ap, int);
179 length = PrintNum(buf, num, 16, 0, width, ladjust, padc, 0);
180 OUTPUT(arg, buf, length);
185 num = va_arg(ap, long int);
187 num = va_arg(ap, int);
189 length = PrintNum(buf, num, 16, 0, width, ladjust, padc, 1);
190 OUTPUT(arg, buf, length);
194 c = (char)va_arg(ap, int);
195 length = PrintChar(buf, c, width, ladjust);
196 OUTPUT(arg, buf, length);
200 s = (char*)va_arg(ap, char *);
201 length = PrintString(buf, s, width, ladjust);
202 OUTPUT(arg, buf, length);
210 /* output this char as it is */
212 } /* switch (*fmt) */
217 /* special termination call */
218 OUTPUT(arg, "\0", 1);
222 /* --------------- local help functions --------------------- */
224 PrintChar(char * buf, char c, int length, int ladjust)
228 if (length < 1) length = 1;
231 for (i=1; i< length; i++) buf[i] = ' ';
233 for (i=0; i< length-1; i++) buf[i] = ' ';
240 PrintString(char * buf, char* s, int length, int ladjust)
246 if (length < len) length = len;
249 for (i=0; i< len; i++) buf[i] = s[i];
250 for (i=len; i< length; i++) buf[i] = ' ';
252 for (i=0; i< length-len; i++) buf[i] = ' ';
253 for (i=length-len; i < length; i++) buf[i] = s[i-length+len];
259 PrintNum(char * buf, unsigned long u, int base, int negFlag,
260 int length, int ladjust, char padc, int upcase)
263 * 1. prints the number from left to right in reverse form.
264 * 2. fill the remaining spaces with padc if length is longer than
266 * TRICKY : if left adjusted, no "0" padding.
267 * if negtive, insert "0" padding between "0" and number.
268 * 3. if (!ladjust) we reverse the whole string including paddings
269 * 4. otherwise we only reverse the actual string representing the num.
281 *p++ = 'A' + tmp - 10;
283 *p++ = 'a' + tmp - 10;
292 /* figure out actual length and adjust the maximum length */
293 actualLength = p - buf;
294 if (length < actualLength) length = actualLength;
300 if (negFlag && !ladjust && (padc == '0')) {
301 for (i = actualLength-1; i< length-1; i++) buf[i] = padc;
302 buf[length -1] = '-';
304 for (i = actualLength; i< length; i++) buf[i] = padc;
308 /* prepare to reverse the string */
313 end = actualLength - 1;
318 while (end > begin) {
319 char tmp = buf[begin];
320 buf[begin] = buf[end];
327 /* adjust the string pointer */
331 static void printf_output(void *arg, char *s, int l)
335 // special termination call
336 if ((l==1) && (s[0] == '\0')) return;
338 for (i=0; i< l; i++) {
340 if (s[i] == '\n') board_putc('\r');
344 void printf(char *fmt, ...)
348 lp_Print(printf_output, 0, fmt, ap);