[openfirmware] r916 - clients/lib

Author: wmb
Date: 2008-09-02 23:18:48 +0200 (Tue, 02 Sep 2008)
New Revision: 916

Modified:
   clients/lib/printf.c
Log:
Client library - support printf field width specifiers.

Modified: clients/lib/printf.c
===================================================================
--- clients/lib/printf.c	2008-09-02 21:18:01 UTC (rev 915)
+++ clients/lib/printf.c	2008-09-02 21:18:48 UTC (rev 916)
@@ -40,30 +40,39 @@
 }

STATIC int
-printbase(ULONG x, int base)
+printbase(ULONG x, int base, int fieldlen, char padchar, int upcase)
 {
-	static char itoa[] = "0123456789abcdef";
+	static char lc_digits[] = "0123456789abcdef";
+	static char uc_digits[] = "0123456789ABCDEF";
    ULONG j;
-	char buf[16], *s = buf;
+	char buf[32], *s = buf;
    int n = 0;

-	if (x == 0) {
-		putchar('0');
-		n++;
-		return (n);
+	memset(buf, 32, 0);
+
+	if (base == 10 && (LONG) x < 0) {
+		*s++ = '-';
+		x = -x;
    }
-	memset(buf, 16, 0);
-	while (x) {
+
+	do {
    	j = x % base;
-		*s++ = itoa[j];
+		*s++ = upcase ? uc_digits[j] : lc_digits[j];
    	x -= j;
    	x /= base;
+	} while (x);
+
+cvtdone:
+	for (fieldlen -= (s-buf); fieldlen > 0; --fieldlen) {
+		putchar(padchar);
+		n++;
    }

for (--s; s >= buf; --s) {
    	putchar(*s);
    	n++;
    }
+
    return (n);
 }

@@ -73,6 +82,8 @@
    ULONG x;
    char c, *s;
    int n = 0;
+        int fieldlen;
+	char padchar;

while (c = *fmt++) {
    	if (c != '%') {
@@ -80,23 +91,43 @@
    		n++;
    		continue;
    	}
-		switch (c = *fmt++) {
+                if ((c = *fmt++) == '\0')
+			goto out;
+		
+		if (c == '.')        // Ignore the numeric grouping flag
+			if ((c = *fmt++) == '\0')
+				goto out;
+
+		padchar = ' ';
+		if (c == '0') {
+			padchar = c;
+			if ((c = *fmt++) == '\0')
+				goto out;
+		}
+
+                fieldlen = 0;
+                while (c >= '0' && c <= '9') {
+			fieldlen = (fieldlen * 10) + (c - '0');
+			if ((c = *fmt++) == '\0')
+				goto out;
+		}
+
+		switch (c) {
    	case 'x':
    		x = va_arg(args, ULONG);
-			n += printbase(x, 16);
+			n += printbase(x, 16, fieldlen, padchar, 0);
    		break;
+		case 'X':
+			x = va_arg(args, ULONG);
+			n += printbase(x, 16, fieldlen, padchar, 1);
+			break;
    	case 'o':
    		x = va_arg(args, ULONG);
-			n += printbase(x, 8);
+			n += printbase(x, 8, fieldlen, padchar, 0);
    		break;
    	case 'd':
    		x = va_arg(args, ULONG);
-			if ((LONG) x < 0) {
-				putchar('-');
-				n++;
-				x = -x;
-			}
-			n += printbase(x, 10);
+			n += printbase(x, 10, fieldlen, padchar, 0);
    		break;
    	case 'c':
    		c = va_arg(args, int);
@@ -116,6 +147,7 @@
    		break;
    	}
    }
+out:
    return(n);
 }