diff --git a/sys/kern/subr_prf.c b/sys/kern/subr_prf.c index 7219af9292ad..c12d7a2b5bb5 100644 --- a/sys/kern/subr_prf.c +++ b/sys/kern/subr_prf.c @@ -1,4 +1,4 @@ -/* $NetBSD: subr_prf.c,v 1.44 1997/09/19 13:56:41 leo Exp $ */ +/* $NetBSD: subr_prf.c,v 1.45 1997/10/24 18:14:25 chuck Exp $ */ /*- * Copyright (c) 1986, 1988, 1991, 1993 @@ -58,53 +58,91 @@ #include /* - * Note that stdarg.h and the ANSI style va_start macro is used for both - * ANSI and traditional C compilers. - * XXX: This requires that stdarg.h defines: va_alist, va_dcl + * note that stdarg.h and the ansi style va_start macro is used for both + * ansi and traditional c complers. + * XXX: this requires that stdarg.h define: va_alist and va_dcl */ #include #include "ipkdb.h" -#ifdef KADB -#include -#endif #ifdef KGDB #include #include #endif +#ifdef DDB +#include /* db_printf, db_putchar prototypes */ +extern int db_radix; /* XXX: for non-standard '%r' format */ +#endif -#define TOCONS 0x01 -#define TOTTY 0x02 -#define TOLOG 0x04 /* - * This is the size of the buffer that should be passed to ksnprintn(). - * It's the length of a long in base 8, plus NULL. + * defines */ -#define KSNPRINTN_BUFSIZE (sizeof(quad_t) * NBBY / 3 + 2) -struct tty *constty; /* pointer to console "window" tty */ +/* flags for kprintf */ +#define TOCONS 0x01 /* to the console */ +#define TOTTY 0x02 /* to the process' tty */ +#define TOLOG 0x04 /* to the kernel message buffer */ +#define TOBUFONLY 0x08 /* to the buffer (only) [for sprintf] */ +#define TODDB 0x10 /* to ddb console */ -void (*v_putc) __P((int)) = cnputc; /* routine to putc on virtual console */ +/* max size buffer kprintf needs to print quad_t [size in base 8 + \0] */ +#define KPRINTF_BUFSIZE (sizeof(quad_t) * NBBY / 3 + 2) -static void putchar __P((int, int, struct tty *)); -static char *ksnprintn __P((u_quad_t, int, int *, char *, size_t)); -void kprintf __P((const char *, int, struct tty *, va_list)); - -int consintr = 1; /* Ok to handle console interrupts? */ /* - * Variable panicstr contains argument to first call to panic; used as flag - * to indicate that the kernel has already called panic. + * local prototypes */ -const char *panicstr; + +static int kprintf __P((const char *, int, struct tty *, + char *, va_list)); +static void putchar __P((int, int, struct tty *)); + /* - * Panic is called on unresolvable fatal errors. It prints "panic: mesg", - * and then reboots. If we are called twice, then we avoid trying to sync - * the disks as this often leads to recursive panics. + * globals */ + +struct tty *constty; /* pointer to console "window" tty */ +int consintr = 1; /* ok to handle console interrupts? */ +extern int log_open; /* subr_log: is /dev/klog open? */ +const char *panicstr; /* arg to first call to panic (used as a flag + to indicate that panic has already been called). */ + +/* + * v_putc: routine to putc on virtual console + * + * the v_putc pointer can be used to redirect the console cnputc elsewhere + * [e.g. to a "virtual console"]. + */ + +void (*v_putc) __P((int)) = cnputc; /* start with cnputc (normal cons) */ + + +/* + * functions + */ + +/* + * tablefull: warn that a system table is full + */ + +void +tablefull(tab) + const char *tab; +{ + log(LOG_ERR, "%s: table is full\n", tab); +} + +/* + * panic: handle an unresolvable fatal error + * + * prints "panic: " and reboots. if called twice (i.e. recursive + * call) we avoid trying to sync the disk and just reboot (to avoid + * recursive panics). + */ + void #ifdef __STDC__ panic(const char *fmt, ...) @@ -124,13 +162,9 @@ panic(fmt, va_alist) panicstr = fmt; va_start(ap, fmt); -#ifdef __powerpc__ /* XXX */ - printf("panic: "); /* XXX */ - vprintf(fmt, ap); /* XXX */ - printf("\n"); /* XXX */ -#else /* XXX */ - printf("panic: %:\n", fmt, ap); /* XXX */ -#endif /* XXX */ + printf("panic: "); + vprintf(fmt, ap); + printf("\n"); va_end(ap); #if NIPKDB > 0 @@ -151,120 +185,16 @@ panic(fmt, va_alist) } /* - * Warn that a system table is full. + * kernel logging functions: log, logpri, addlog */ -void -tablefull(tab) - const char *tab; -{ - - log(LOG_ERR, "%s: table is full\n", tab); -} /* - * Uprintf prints to the controlling terminal for the current process. - * It may block if the tty queue is overfull. No message is printed if - * the queue does not clear in a reasonable time. + * log: write to the log buffer + * + * => will not sleep [so safe to call from interrupt] + * => will log to console if /dev/klog isn't open */ -void -#ifdef __STDC__ -uprintf(const char *fmt, ...) -#else -uprintf(fmt, va_alist) - char *fmt; - va_dcl -#endif -{ - register struct proc *p = curproc; - va_list ap; - if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) { - va_start(ap, fmt); - kprintf(fmt, TOTTY, p->p_session->s_ttyp, ap); - va_end(ap); - } -} - -tpr_t -tprintf_open(p) - register struct proc *p; -{ - - if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) { - SESSHOLD(p->p_session); - return ((tpr_t) p->p_session); - } - return ((tpr_t) NULL); -} - -void -tprintf_close(sess) - tpr_t sess; -{ - - if (sess) - SESSRELE((struct session *) sess); -} - -/* - * tprintf prints on the controlling terminal associated - * with the given session. - */ -void -#ifdef __STDC__ -tprintf(tpr_t tpr, const char *fmt, ...) -#else -tprintf(tpr, fmt, va_alist) - tpr_t tpr; - char *fmt; - va_dcl -#endif -{ - register struct session *sess = (struct session *)tpr; - struct tty *tp = NULL; - int flags = TOLOG; - va_list ap; - - logpri(LOG_INFO); - if (sess && sess->s_ttyvp && ttycheckoutq(sess->s_ttyp, 0)) { - flags |= TOTTY; - tp = sess->s_ttyp; - } - va_start(ap, fmt); - kprintf(fmt, flags, tp, ap); - va_end(ap); - logwakeup(); -} - -/* - * Ttyprintf displays a message on a tty; it should be used only by - * the tty driver, or anything that knows the underlying tty will not - * be revoke(2)'d away. Other callers should use tprintf. - */ -void -#ifdef __STDC__ -ttyprintf(struct tty *tp, const char *fmt, ...) -#else -ttyprintf(tp, fmt, va_alist) - struct tty *tp; - char *fmt; - va_dcl -#endif -{ - va_list ap; - - va_start(ap, fmt); - kprintf(fmt, TOTTY, tp, ap); - va_end(ap); -} - -extern int log_open; - -/* - * Log writes to the log buffer, and guarantees not to sleep (so can be - * called by interrupt routines). If there is no process reading the - * log yet, it writes to the console also. - */ void #ifdef __STDC__ log(int level, const char *fmt, ...) @@ -279,34 +209,41 @@ log(level, fmt, va_alist) va_list ap; s = splhigh(); - logpri(level); + logpri(level); /* log the level first */ va_start(ap, fmt); - kprintf(fmt, TOLOG, NULL, ap); + kprintf(fmt, TOLOG, NULL, NULL, ap); splx(s); va_end(ap); if (!log_open) { va_start(ap, fmt); - kprintf(fmt, TOCONS, NULL, ap); + kprintf(fmt, TOCONS, NULL, NULL, ap); va_end(ap); } - logwakeup(); + logwakeup(); /* wake up anyone waiting for log msgs */ } -void +/* + * logpri: log the priority level to the klog + */ + +void /* XXXCDC: should be static? */ logpri(level) int level; { - register int ch; - register char *p; - char snbuf[KSNPRINTN_BUFSIZE]; + char *p; + char snbuf[KPRINTF_BUFSIZE]; putchar('<', TOLOG, NULL); - for (p = ksnprintn((u_long)level, 10, NULL, snbuf, sizeof(snbuf)); - (ch = *p--) != 0;) - putchar(ch, TOLOG, NULL); + sprintf(snbuf, "%d", level); + for (p = snbuf ; *p ; p++) + putchar(*p, TOLOG, NULL); putchar('>', TOLOG, NULL); } +/* + * addlog: add info to previous log message + */ + void #ifdef __STDC__ addlog(const char *fmt, ...) @@ -321,231 +258,23 @@ addlog(fmt, va_alist) s = splhigh(); va_start(ap, fmt); - kprintf(fmt, TOLOG, NULL, ap); + kprintf(fmt, TOLOG, NULL, NULL, ap); splx(s); va_end(ap); if (!log_open) { va_start(ap, fmt); - kprintf(fmt, TOCONS, NULL, ap); + kprintf(fmt, TOCONS, NULL, NULL, ap); va_end(ap); } logwakeup(); } -void -#ifdef __STDC__ -printf(const char *fmt, ...) -#else -printf(fmt, va_alist) - char *fmt; - va_dcl -#endif -{ - va_list ap; - register int savintr; - - savintr = consintr; /* disable interrupts */ - consintr = 0; - va_start(ap, fmt); - kprintf(fmt, TOCONS | TOLOG, NULL, ap); - va_end(ap); - if (!panicstr) - logwakeup(); - consintr = savintr; /* reenable interrupts */ -} - -#ifdef __powerpc__ /* XXX XXX XXX */ -void -vprintf(fmt, ap) - const char *fmt; - va_list ap; -{ - register int savintr; - - savintr = consintr; /* disable interrupts */ - consintr = 0; - kprintf(fmt, TOCONS | TOLOG, NULL, ap); - if (!panicstr) - logwakeup(); - consintr = savintr; /* reenable interrupts */ -} -#endif /* __powerpc__ */ /* XXX XXX XXX */ /* - * Scaled down version of printf(3). + * putchar: print a single character on console or user terminal. * - * Two additional formats: - * - * The format %b is supported to decode error registers. - * Its usage is: - * - * printf("reg=%b\n", regval, "*"); - * - * where is the output base expressed as a control character, e.g. - * \10 gives octal; \20 gives hex. Each arg is a sequence of characters, - * the first of which gives the bit number to be inspected (origin 1), and - * the next characters (up to a control character, i.e. a character <= 32), - * give the name of the register. Thus: - * - * kprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n"); - * - * would produce output: - * - * reg=3 - * - * The format %: passes an additional format string and argument list - * recursively. Its usage is: - * - * fn(char *fmt, ...) - * { - * va_list ap; - * va_start(ap, fmt); - * printf("prefix: %: suffix\n", fmt, ap); - * va_end(ap); - * } - * - * Space or zero padding and a field width are supported for the numeric - * formats only. - */ -#define LONGINT 0x010 /* long integer */ -#define QUADINT 0x020 /* quad integer */ -#define SARG() \ - (flags&QUADINT ? va_arg(ap, quad_t) : \ - flags&LONGINT ? va_arg(ap, long) : \ - (long)va_arg(ap, int)) -#define UARG() \ - (flags&QUADINT ? va_arg(ap, u_quad_t) : \ - flags&LONGINT ? va_arg(ap, u_long) : \ - (u_long)va_arg(ap, u_int)) -void -kprintf(fmt, oflags, tp, ap) - register const char *fmt; - int oflags; - struct tty *tp; - va_list ap; -{ - register char *p, *q; - register int ch, n; - u_quad_t ul; - int base, flags, tmp, width; - char padc, snbuf[KSNPRINTN_BUFSIZE]; - - for (;;) { - padc = ' '; - width = 0; - while ((ch = *(const u_char *)fmt++) != '%') { - if (ch == '\0') - return; - putchar(ch, oflags, tp); - } - flags = 0; -reswitch: switch (ch = *(const u_char *)fmt++) { - case '\0': - /* XXX Print the last format character? */ - return; - case '0': - case '.': - padc = '0'; - goto reswitch; - case '1': case '2': case '3': case '4': - case '5': case '6': case '7': case '8': case '9': - for (width = 0;; ++fmt) { - width = width * 10 + ch - '0'; - ch = *fmt; - if (ch < '0' || ch > '9') - break; - } - goto reswitch; - case 'l': - flags |= LONGINT; - goto reswitch; - case 'q': - flags |= QUADINT; - goto reswitch; - case 'b': - ul = va_arg(ap, int); - p = va_arg(ap, char *); - for (q = ksnprintn(ul, *p++, NULL, snbuf, - sizeof(snbuf)); (ch = *q--) != 0;) - putchar(ch, oflags, tp); - - if (!ul) - break; - - for (tmp = 0; (n = *p++) != 0;) { - if (ul & (1 << (n - 1))) { - putchar(tmp ? ',' : '<', oflags, tp); - for (; (n = *p) > ' '; ++p) - putchar(n, oflags, tp); - tmp = 1; - } else - for (; *p > ' '; ++p) - continue; - } - if (tmp) - putchar('>', oflags, tp); - break; - case 'c': - putchar(va_arg(ap, int), oflags, tp); - break; -#ifndef __powerpc__ /* XXX XXX XXX */ - case ':': - p = va_arg(ap, char *); - kprintf(p, oflags, tp, va_arg(ap, va_list)); - break; -#endif /* __powerpc__ */ /* XXX XXX XXX */ - case 's': - if ((p = va_arg(ap, char *)) == NULL) - p = "(null)"; - while ((ch = *p++) != 0) - putchar(ch, oflags, tp); - break; - case 'd': - ul = SARG(); - if ((quad_t)ul < 0) { - putchar('-', oflags, tp); - ul = -ul; - } - base = 10; - goto number; - case 'o': - ul = UARG(); - base = 8; - goto number; - case 'u': - ul = UARG(); - base = 10; - goto number; - case 'p': - putchar('0', oflags, tp); - putchar('x', oflags, tp); - ul = (u_long)va_arg(ap, void *); - base = 16; - goto number; - case 'x': - ul = UARG(); - base = 16; -number: p = ksnprintn(ul, base, &tmp, snbuf, sizeof(snbuf)); - if (width && (width -= tmp) > 0) - while (width--) - putchar(padc, oflags, tp); - while ((ch = *p--) != 0) - putchar(ch, oflags, tp); - break; - default: - putchar('%', oflags, tp); - /* flags??? */ - /* FALLTHROUGH */ - case '%': - putchar(ch, oflags, tp); - } - } -} - -/* - * Print a character on console or users terminal. If destination is - * the console then the last MSGBUFS characters are saved in msgbuf for - * inspection later. + * => if console, then the last MSGBUFS chars are saved in msgbuf + * for inspection later (e.g. dmesg/syslog) */ static void putchar(c, flags, tp) @@ -586,152 +315,239 @@ putchar(c, flags, tp) } if ((flags & TOCONS) && constty == NULL && c != '\0') (*v_putc)(c); +#ifdef DDB + if (flags & TODDB) + db_putchar(c); +#endif } + /* - * Scaled down version of sprintf(3). + * uprintf: print to the controlling tty of the current process + * + * => we may block if the tty queue is full + * => no message is printed if the queue doesn't clear in a reasonable + * time */ -int + +void #ifdef __STDC__ -sprintf(char *buf, const char *cfmt, ...) +uprintf(const char *fmt, ...) #else -sprintf(buf, cfmt, va_alist) - char *buf; - const char *cfmt; +uprintf(fmt, va_alist) + char *fmt; va_dcl #endif { - register const char *fmt = cfmt; - register char *p, *bp; - register int ch, base; - u_quad_t ul; - int flags, tmp, width; + register struct proc *p = curproc; va_list ap; - char padc, snbuf[KSNPRINTN_BUFSIZE]; - va_start(ap, cfmt); - for (bp = buf; ; ) { - padc = ' '; - width = 0; - while ((ch = *(const u_char *)fmt++) != '%') - if ((*bp++ = ch) == '\0') - return ((bp - buf) - 1); - - flags = 0; -reswitch: switch (ch = *(const u_char *)fmt++) { - case '\0': - /* XXX Store the last format character? */ - *bp++ = '\0'; - return ((bp - buf) - 1); - case '0': - padc = '0'; - goto reswitch; - case '1': case '2': case '3': case '4': - case '5': case '6': case '7': case '8': case '9': - for (width = 0;; ++fmt) { - width = width * 10 + ch - '0'; - ch = *fmt; - if (ch < '0' || ch > '9') - break; - } - goto reswitch; - case 'l': - flags |= LONGINT; - goto reswitch; - case 'q': - flags |= QUADINT; - goto reswitch; - /* case 'b': ... break; XXX */ - case 'c': - *bp++ = va_arg(ap, int); - break; - /* case 'r': ... break; XXX */ - case 's': - p = va_arg(ap, char *); - while ((*bp++ = *p++) != 0) - continue; - --bp; - break; - case 'd': - ul = SARG(); - if ((quad_t)ul < 0) { - *bp++ = '-'; - ul = -ul; - } - base = 10; - goto number; - case 'o': - ul = UARG(); - base = 8; - goto number; - case 'u': - ul = UARG(); - base = 10; - goto number; - case 'p': - *bp++ = '0'; - *bp++ = 'x'; - ul = (u_long)va_arg(ap, void *); - base = 16; - goto number; - case 'x': - ul = UARG(); - base = 16; -number: p = ksnprintn(ul, base, &tmp, snbuf, sizeof(snbuf)); - if (width && (width -= tmp) > 0) - while (width--) - *bp++ = padc; - while ((ch = *p--) != 0) - *bp++ = ch; - break; - default: - *bp++ = '%'; - /* flags??? */ - /* FALLTHROUGH */ - case '%': - *bp++ = ch; - } + if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) { + va_start(ap, fmt); + kprintf(fmt, TOTTY, p->p_session->s_ttyp, NULL, ap); + va_end(ap); } +} + +/* + * tprintf functions: used to send messages to a specific process + * + * usage: + * get a tpr_t handle on a process "p" by using "tprintf_open(p)" + * use the handle when calling "tprintf" + * when done, do a "tprintf_close" to drop the handle + */ + +/* + * tprintf_open: get a tprintf handle on a process "p" + * + * => returns NULL if process can't be printed to + */ + +tpr_t +tprintf_open(p) + register struct proc *p; +{ + + if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) { + SESSHOLD(p->p_session); + return ((tpr_t) p->p_session); + } + return ((tpr_t) NULL); +} + +/* + * tprintf_close: dispose of a tprintf handle obtained with tprintf_open + */ + +void +tprintf_close(sess) + tpr_t sess; +{ + + if (sess) + SESSRELE((struct session *) sess); +} + +/* + * tprintf: given tprintf handle to a process [obtained with tprintf_open], + * send a message to the controlling tty for that process. + * + * => also sends message to /dev/klog + */ +void +#ifdef __STDC__ +tprintf(tpr_t tpr, const char *fmt, ...) +#else +tprintf(tpr, fmt, va_alist) + tpr_t tpr; + char *fmt; + va_dcl +#endif +{ + register struct session *sess = (struct session *)tpr; + struct tty *tp = NULL; + int flags = TOLOG; + va_list ap; + + logpri(LOG_INFO); + if (sess && sess->s_ttyvp && ttycheckoutq(sess->s_ttyp, 0)) { + flags |= TOTTY; + tp = sess->s_ttyp; + } + va_start(ap, fmt); + kprintf(fmt, flags, tp, NULL, ap); + va_end(ap); + logwakeup(); +} + + +/* + * ttyprintf: send a message to a specific tty + * + * => should be used only by tty driver or anything that knows the + * underlying tty will not be revoked(2)'d away. [otherwise, + * use tprintf] + */ +void +#ifdef __STDC__ +ttyprintf(struct tty *tp, const char *fmt, ...) +#else +ttyprintf(tp, fmt, va_alist) + struct tty *tp; + char *fmt; + va_dcl +#endif +{ + va_list ap; + + va_start(ap, fmt); + kprintf(fmt, TOTTY, tp, NULL, ap); va_end(ap); } +#ifdef DDB + /* - * Put a number (base <= 16) in a buffer in reverse order; return an - * optional length and a pointer to the NULL terminated (preceded?) - * buffer. + * db_printf: printf for DDB (via db_putchar) */ -static char * -ksnprintn(ul, base, lenp, buf, buflen) - register u_quad_t ul; - register int base, *lenp; - char *buf; - size_t buflen; + +void +#ifdef __STDC__ +db_printf(const char *fmt, ...) +#else +db_printf(fmt, va_alist) + char *fmt; + va_dcl +#endif { - register char *p; + va_list ap; - p = buf; - *p = '\0'; /* ensure NULL `termination' */ + va_start(ap, fmt); + kprintf(fmt, TODDB, NULL, NULL, ap); + va_end(ap); +} - /* - * Don't even bother of the buffer's not big enough. No - * value at all is better than a wrong value, and we - * have a lot of control over the buffer that's passed - * to this function, since it's not exported. - */ - if (buflen < KSNPRINTN_BUFSIZE) - return (p); +#endif /* DDB */ - do { - *++p = "0123456789abcdef"[ul % base]; - } while (ul /= base); - if (lenp) - *lenp = p - buf; - return (p); + +/* + * normal kernel printf functions: printf, vprintf, sprintf + */ + +/* + * printf: print a message to the console and the log + */ +void +#ifdef __STDC__ +printf(const char *fmt, ...) +#else +printf(fmt, va_alist) + char *fmt; + va_dcl +#endif +{ + va_list ap; + int savintr; + + savintr = consintr; /* disable interrupts */ + consintr = 0; + va_start(ap, fmt); + kprintf(fmt, TOCONS | TOLOG, NULL, NULL, ap); + va_end(ap); + if (!panicstr) + logwakeup(); + consintr = savintr; /* reenable interrupts */ } /* - * Print a bitmask into the provided buffer, and return a pointer - * to that buffer. + * vprintf: print a message to the console and the log [already have + * va_alist] + */ + +void +vprintf(fmt, ap) + const char *fmt; + va_list ap; +{ + int savintr; + + savintr = consintr; /* disable interrupts */ + consintr = 0; + kprintf(fmt, TOCONS | TOLOG, NULL, NULL, ap); + if (!panicstr) + logwakeup(); + consintr = savintr; /* reenable interrupts */ +} + +/* + * sprintf: print a message to a buffer + */ +int +#ifdef __STDC__ +sprintf(char *buf, const char *fmt, ...) +#else +sprintf(buf, fmt, va_alist) + char *buf; + const char *cfmt; + va_dcl +#endif +{ + int retval; + va_list ap; + + va_start(ap, fmt); + retval = kprintf(fmt, TOBUFONLY, NULL, buf, ap); + va_end(ap); + *(buf + retval) = 0; /* null terminate */ + return(retval); +} + +/* + * bitmask_snprintf: print a kernel-printf "%b" message to a buffer + * + * => returns pointer to the buffer + * => XXX: useful vs. kernel %b? */ char * bitmask_snprintf(ul, p, buf, buflen) @@ -743,8 +559,8 @@ bitmask_snprintf(ul, p, buf, buflen) char *bp, *q; size_t left; register int n; - int ch, tmp; - char snbuf[KSNPRINTN_BUFSIZE]; + int tmp; + char snbuf[KPRINTF_BUFSIZE]; bp = buf; bzero(buf, buflen); @@ -758,12 +574,21 @@ bitmask_snprintf(ul, p, buf, buflen) * Print the value into the buffer. Abort if there's not * enough room. */ - if (buflen < KSNPRINTN_BUFSIZE) + if (buflen < KPRINTF_BUFSIZE) return (buf); - for (q = ksnprintn(ul, *p++, NULL, snbuf, sizeof(snbuf)); - (ch = *q--) != 0;) { - *bp++ = ch; + if (*p == 8) + sprintf(snbuf,"%lo", ul); + else if (*p == 10) + sprintf(snbuf, "%ld", ul); + else if (*p == 16) + sprintf(snbuf, "%lx", ul); + else + return(buf); /* punt if not oct, dec, or hex */ + p++; + + for (q = snbuf ; *q ; q++) { + *bp++ = *q; left--; } @@ -798,3 +623,552 @@ bitmask_snprintf(ul, p, buf, buflen) out: return (buf); } + +/* + * kprintf: scaled down version of printf(3). + * + * this version based on vfprintf() from libc which was derived from + * software contributed to Berkeley by Chris Torek. + * + * Two additional formats: + * + * The format %b is supported to decode error registers. + * Its usage is: + * + * printf("reg=%b\n", regval, "*"); + * + * where is the output base expressed as a control character, e.g. + * \10 gives octal; \20 gives hex. Each arg is a sequence of characters, + * the first of which gives the bit number to be inspected (origin 1), and + * the next characters (up to a control character, i.e. a character <= 32), + * give the name of the register. Thus: + * + * kprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n"); + * + * would produce output: + * + * reg=3 + * + * The format %: passes an additional format string and argument list + * recursively. Its usage is: + * + * fn(char *fmt, ...) + * { + * va_list ap; + * va_start(ap, fmt); + * printf("prefix: %: suffix\n", fmt, ap); + * va_end(ap); + * } + * + * this is the actual printf innards + * + * This code is large and complicated... + */ + +/* + * macros for converting digits to letters and vice versa + */ +#define to_digit(c) ((c) - '0') +#define is_digit(c) ((unsigned)to_digit(c) <= 9) +#define to_char(n) ((n) + '0') + +/* + * flags used during conversion. + */ +#define ALT 0x001 /* alternate form */ +#define HEXPREFIX 0x002 /* add 0x or 0X prefix */ +#define LADJUST 0x004 /* left adjustment */ +#define LONGDBL 0x008 /* long double; unimplemented */ +#define LONGINT 0x010 /* long integer */ +#define QUADINT 0x020 /* quad integer */ +#define SHORTINT 0x040 /* short integer */ +#define ZEROPAD 0x080 /* zero (as opposed to blank) pad */ +#define FPT 0x100 /* Floating point number */ + + /* + * To extend shorts properly, we need both signed and unsigned + * argument extraction methods. + */ +#define SARG() \ + (flags&QUADINT ? va_arg(ap, quad_t) : \ + flags&LONGINT ? va_arg(ap, long) : \ + flags&SHORTINT ? (long)(short)va_arg(ap, int) : \ + (long)va_arg(ap, int)) +#define UARG() \ + (flags&QUADINT ? va_arg(ap, u_quad_t) : \ + flags&LONGINT ? va_arg(ap, u_long) : \ + flags&SHORTINT ? (u_long)(u_short)va_arg(ap, int) : \ + (u_long)va_arg(ap, u_int)) + +#define KPRINTF_PUTCHAR(C) \ + (oflags == TOBUFONLY) ? *sbuf++ = (C) : putchar((C), oflags, tp); + +int +kprintf(fmt0, oflags, tp, sbuf, ap) + const char *fmt0; + int oflags; + struct tty *tp; + char *sbuf; + va_list ap; +{ + char *fmt; /* format string */ + int ch; /* character from fmt */ + int n; /* handy integer (short term usage) */ + char *cp; /* handy char pointer (short term usage) */ + int flags; /* flags as above */ + int ret; /* return value accumulator */ + int width; /* width from format (%8d), or 0 */ + int prec; /* precision from format (%.3d), or -1 */ + char sign; /* sign prefix (' ', '+', '-', or \0) */ + + u_quad_t _uquad; /* integer arguments %[diouxX] */ + enum { OCT, DEC, HEX } base;/* base for [diouxX] conversion */ + int dprec; /* a copy of prec if [diouxX], 0 otherwise */ + int realsz; /* field size expanded by dprec */ + int size; /* size of converted field or string */ + char *xdigs; /* digits for [xX] conversion */ + char buf[KPRINTF_BUFSIZE]; /* space for %c, %[diouxX] */ + + cp = NULL; /* XXX: shutup gcc */ + size = 0; /* XXX: shutup gcc */ + + fmt = (char *)fmt0; + ret = 0; + + xdigs = NULL; /* XXX: shut up gcc warning */ + + /* + * Scan the format for conversions (`%' character). + */ + for (;;) { + while (*fmt != '%' && *fmt) { + KPRINTF_PUTCHAR(*fmt++); + ret++; + } + if (*fmt == 0) + goto done; + + fmt++; /* skip over '%' */ + + flags = 0; + dprec = 0; + width = 0; + prec = -1; + sign = '\0'; + +rflag: ch = *fmt++; +reswitch: switch (ch) { + /* XXX: non-standard '%:' format */ +#ifndef __powerpc__ + case ':': + if (oflags != TOBUFONLY) { + cp = va_arg(ap, char *); + kprintf(cp, oflags, tp, + NULL, va_arg(ap, va_list)); + } + continue; /* no output */ +#endif + /* XXX: non-standard '%b' format */ + case 'b': { + char *b, *z; + int tmp; + _uquad = va_arg(ap, int); + b = va_arg(ap, char *); + if (*b == 8) + sprintf(buf, "%qo", _uquad); + else if (*b == 10) + sprintf(buf, "%qd", _uquad); + else if (*b == 16) + sprintf(buf, "%qx", _uquad); + else + break; + b++; + + z = buf; + while (*z) { + KPRINTF_PUTCHAR(*z++); + ret++; + } + + if (_uquad) { + tmp = 0; + while ((n = *b++) != 0) { + if (_uquad & (1 << (n - 1))) { + KPRINTF_PUTCHAR(tmp ? ',':'<'); + ret++; + while ((n = *b) > ' ') { + KPRINTF_PUTCHAR(n); + ret++; + b++; + } + tmp = 1; + } else { + while(*b > ' ') + b++; + } + } + if (tmp) { + KPRINTF_PUTCHAR('>'); + ret++; + } + } + continue; /* no output */ + } + +#ifdef DDB + /* XXX: non-standard '%r' format (print int in db_radix) */ + case 'r': + if ((oflags & TODDB) == 0) + goto default_case; + + if (db_radix == 16) + goto case_z; /* signed hex */ + _uquad = SARG(); + if ((quad_t)_uquad < 0) { + _uquad = -_uquad; + sign = '-'; + } + base = (db_radix == 8) ? OCT : DEC; + goto number; + + + /* XXX: non-standard '%z' format ("signed hex", a "hex %i")*/ + case 'z': + case_z: + if ((oflags & TODDB) == 0) + goto default_case; + + xdigs = "0123456789abcdef"; + ch = 'x'; /* the 'x' in '0x' (below) */ + _uquad = SARG(); + base = HEX; + /* leading 0x/X only if non-zero */ + if (flags & ALT && _uquad != 0) + flags |= HEXPREFIX; + if ((quad_t)_uquad < 0) { + _uquad = -_uquad; + sign = '-'; + } + goto number; +#endif + + case ' ': + /* + * ``If the space and + flags both appear, the space + * flag will be ignored.'' + * -- ANSI X3J11 + */ + if (!sign) + sign = ' '; + goto rflag; + case '#': + flags |= ALT; + goto rflag; + case '*': + /* + * ``A negative field width argument is taken as a + * - flag followed by a positive field width.'' + * -- ANSI X3J11 + * They don't exclude field widths read from args. + */ + if ((width = va_arg(ap, int)) >= 0) + goto rflag; + width = -width; + /* FALLTHROUGH */ + case '-': + flags |= LADJUST; + goto rflag; + case '+': + sign = '+'; + goto rflag; + case '.': + if ((ch = *fmt++) == '*') { + n = va_arg(ap, int); + prec = n < 0 ? -1 : n; + goto rflag; + } + n = 0; + while (is_digit(ch)) { + n = 10 * n + to_digit(ch); + ch = *fmt++; + } + prec = n < 0 ? -1 : n; + goto reswitch; + case '0': + /* + * ``Note that 0 is taken as a flag, not as the + * beginning of a field width.'' + * -- ANSI X3J11 + */ + flags |= ZEROPAD; + goto rflag; + case '1': case '2': case '3': case '4': + case '5': case '6': case '7': case '8': case '9': + n = 0; + do { + n = 10 * n + to_digit(ch); + ch = *fmt++; + } while (is_digit(ch)); + width = n; + goto reswitch; + case 'h': + flags |= SHORTINT; + goto rflag; + case 'l': + if (*fmt == 'l') { + fmt++; + flags |= QUADINT; + } else { + flags |= LONGINT; + } + goto rflag; + case 'q': + flags |= QUADINT; + goto rflag; + case 'c': + *(cp = buf) = va_arg(ap, int); + size = 1; + sign = '\0'; + break; + case 'D': + flags |= LONGINT; + /*FALLTHROUGH*/ + case 'd': + case 'i': + _uquad = SARG(); + if ((quad_t)_uquad < 0) { + _uquad = -_uquad; + sign = '-'; + } + base = DEC; + goto number; + case 'n': +#ifdef DDB + /* XXX: non-standard '%n' format */ + /* + * XXX: HACK! DDB wants '%n' to be a '%u' printed + * in db_radix format. this should die since '%n' + * is already defined in standard printf to write + * the number of chars printed so far to the arg (which + * should be a pointer. + */ + if (oflags & TODDB) { + if (db_radix == 16) + ch = 'x'; /* convert to %x */ + else if (db_radix == 8) + ch = 'o'; /* convert to %o */ + else + ch = 'u'; /* convert to %u */ + + /* ... and start again */ + goto reswitch; + } + +#endif + if (flags & QUADINT) + *va_arg(ap, quad_t *) = ret; + else if (flags & LONGINT) + *va_arg(ap, long *) = ret; + else if (flags & SHORTINT) + *va_arg(ap, short *) = ret; + else + *va_arg(ap, int *) = ret; + continue; /* no output */ + case 'O': + flags |= LONGINT; + /*FALLTHROUGH*/ + case 'o': + _uquad = UARG(); + base = OCT; + goto nosign; + case 'p': + /* + * ``The argument shall be a pointer to void. The + * value of the pointer is converted to a sequence + * of printable characters, in an implementation- + * defined manner.'' + * -- ANSI X3J11 + */ + /* NOSTRICT */ + _uquad = (u_long)va_arg(ap, void *); + base = HEX; + xdigs = "0123456789abcdef"; + flags |= HEXPREFIX; + ch = 'x'; + goto nosign; + case 's': + if ((cp = va_arg(ap, char *)) == NULL) + cp = "(null)"; + if (prec >= 0) { + /* + * can't use strlen; can only look for the + * NUL in the first `prec' characters, and + * strlen() will go further. + */ + char *p = memchr(cp, 0, prec); + + if (p != NULL) { + size = p - cp; + if (size > prec) + size = prec; + } else + size = prec; + } else + size = strlen(cp); + sign = '\0'; + break; + case 'U': + flags |= LONGINT; + /*FALLTHROUGH*/ + case 'u': + _uquad = UARG(); + base = DEC; + goto nosign; + case 'X': + xdigs = "0123456789ABCDEF"; + goto hex; + case 'x': + xdigs = "0123456789abcdef"; +hex: _uquad = UARG(); + base = HEX; + /* leading 0x/X only if non-zero */ + if (flags & ALT && _uquad != 0) + flags |= HEXPREFIX; + + /* unsigned conversions */ +nosign: sign = '\0'; + /* + * ``... diouXx conversions ... if a precision is + * specified, the 0 flag will be ignored.'' + * -- ANSI X3J11 + */ +number: if ((dprec = prec) >= 0) + flags &= ~ZEROPAD; + + /* + * ``The result of converting a zero value with an + * explicit precision of zero is no characters.'' + * -- ANSI X3J11 + */ + cp = buf + KPRINTF_BUFSIZE; + if (_uquad != 0 || prec != 0) { + /* + * Unsigned mod is hard, and unsigned mod + * by a constant is easier than that by + * a variable; hence this switch. + */ + switch (base) { + case OCT: + do { + *--cp = to_char(_uquad & 7); + _uquad >>= 3; + } while (_uquad); + /* handle octal leading 0 */ + if (flags & ALT && *cp != '0') + *--cp = '0'; + break; + + case DEC: + /* many numbers are 1 digit */ + while (_uquad >= 10) { + *--cp = to_char(_uquad % 10); + _uquad /= 10; + } + *--cp = to_char(_uquad); + break; + + case HEX: + do { + *--cp = xdigs[_uquad & 15]; + _uquad >>= 4; + } while (_uquad); + break; + + default: + cp = "bug in kprintf: bad base"; + size = strlen(cp); + goto skipsize; + } + } + size = buf + KPRINTF_BUFSIZE - cp; + skipsize: + break; + default: /* "%?" prints ?, unless ? is NUL */ +#ifdef DDB + default_case: /* DDB */ +#endif + if (ch == '\0') + goto done; + /* pretend it was %c with argument ch */ + cp = buf; + *cp = ch; + size = 1; + sign = '\0'; + break; + } + + /* + * All reasonable formats wind up here. At this point, `cp' + * points to a string which (if not flags&LADJUST) should be + * padded out to `width' places. If flags&ZEROPAD, it should + * first be prefixed by any sign or other prefix; otherwise, + * it should be blank padded before the prefix is emitted. + * After any left-hand padding and prefixing, emit zeroes + * required by a decimal [diouxX] precision, then print the + * string proper, then emit zeroes required by any leftover + * floating precision; finally, if LADJUST, pad with blanks. + * + * Compute actual size, so we know how much to pad. + * size excludes decimal prec; realsz includes it. + */ + realsz = dprec > size ? dprec : size; + if (sign) + realsz++; + else if (flags & HEXPREFIX) + realsz+= 2; + + /* right-adjusting blank padding */ + if ((flags & (LADJUST|ZEROPAD)) == 0) { + n = width - realsz; + while (n-- > 0) + KPRINTF_PUTCHAR(' '); + } + + /* prefix */ + if (sign) { + KPRINTF_PUTCHAR(sign); + } else if (flags & HEXPREFIX) { + KPRINTF_PUTCHAR('0'); + KPRINTF_PUTCHAR(ch); + } + + /* right-adjusting zero padding */ + if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD) { + n = width - realsz; + while (n-- > 0) + KPRINTF_PUTCHAR('0'); + } + + /* leading zeroes from decimal precision */ + n = dprec - size; + while (n-- > 0) + KPRINTF_PUTCHAR('0'); + + /* the string or number proper */ + while (size--) + KPRINTF_PUTCHAR(*cp++); + /* left-adjusting padding (always blank) */ + if (flags & LADJUST) { + n = width - realsz; + while (n-- > 0) + KPRINTF_PUTCHAR(' '); + } + + /* finally, adjust ret */ + ret += width > realsz ? width : realsz; + + } +done: + return (ret); + /* NOTREACHED */ +}