[BACK]Return to subr_prf.c CVS log [TXT][DIR] Up to [local] / sys / kern

Annotation of sys/kern/subr_prf.c, Revision 1.1.1.1

1.1       nbrk        1: /*     $OpenBSD: subr_prf.c,v 1.70 2007/04/26 20:28:25 deraadt Exp $   */
                      2: /*     $NetBSD: subr_prf.c,v 1.45 1997/10/24 18:14:25 chuck Exp $      */
                      3:
                      4: /*-
                      5:  * Copyright (c) 1986, 1988, 1991, 1993
                      6:  *     The Regents of the University of California.  All rights reserved.
                      7:  * (c) UNIX System Laboratories, Inc.
                      8:  * All or some portions of this file are derived from material licensed
                      9:  * to the University of California by American Telephone and Telegraph
                     10:  * Co. or Unix System Laboratories, Inc. and are reproduced herein with
                     11:  * the permission of UNIX System Laboratories, Inc.
                     12:  *
                     13:  * Redistribution and use in source and binary forms, with or without
                     14:  * modification, are permitted provided that the following conditions
                     15:  * are met:
                     16:  * 1. Redistributions of source code must retain the above copyright
                     17:  *    notice, this list of conditions and the following disclaimer.
                     18:  * 2. Redistributions in binary form must reproduce the above copyright
                     19:  *    notice, this list of conditions and the following disclaimer in the
                     20:  *    documentation and/or other materials provided with the distribution.
                     21:  * 3. Neither the name of the University nor the names of its contributors
                     22:  *    may be used to endorse or promote products derived from this software
                     23:  *    without specific prior written permission.
                     24:  *
                     25:  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
                     26:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     27:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     28:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
                     29:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     30:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     31:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     32:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     33:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     34:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     35:  * SUCH DAMAGE.
                     36:  *
                     37:  *     @(#)subr_prf.c  8.3 (Berkeley) 1/21/94
                     38:  */
                     39:
                     40: #include <sys/param.h>
                     41: #include <sys/systm.h>
                     42: #include <sys/buf.h>
                     43: #include <sys/conf.h>
                     44: #include <sys/reboot.h>
                     45: #include <sys/msgbuf.h>
                     46: #include <sys/proc.h>
                     47: #include <sys/ioctl.h>
                     48: #include <sys/vnode.h>
                     49: #include <sys/file.h>
                     50: #include <sys/tty.h>
                     51: #include <sys/tprintf.h>
                     52: #include <sys/syslog.h>
                     53: #include <sys/malloc.h>
                     54: #include <sys/pool.h>
                     55: #include <sys/mutex.h>
                     56:
                     57: #include <dev/cons.h>
                     58:
                     59: /*
                     60:  * note that stdarg.h and the ansi style va_start macro is used for both
                     61:  * ansi and traditional c compilers.
                     62:  */
                     63: #include <sys/stdarg.h>
                     64:
                     65: #ifdef KGDB
                     66: #include <sys/kgdb.h>
                     67: #include <machine/cpu.h>
                     68: #endif
                     69: #ifdef DDB
                     70: #include <ddb/db_output.h>     /* db_printf, db_putchar prototypes */
                     71: #include <ddb/db_var.h>                /* db_log, db_radix */
                     72: #endif
                     73: #if defined(UVM_SWAP_ENCRYPT)
                     74: extern int uvm_doswapencrypt;
                     75: #endif
                     76:
                     77:
                     78: /*
                     79:  * defines
                     80:  */
                     81:
                     82: /* flags for kprintf */
                     83: #define TOCONS         0x01    /* to the console */
                     84: #define TOTTY          0x02    /* to the process' tty */
                     85: #define TOLOG          0x04    /* to the kernel message buffer */
                     86: #define TOBUFONLY      0x08    /* to the buffer (only) [for snprintf] */
                     87: #define TODDB          0x10    /* to ddb console */
                     88: #define TOCOUNT                0x20    /* act like [v]snprintf */
                     89:
                     90: /* max size buffer kprintf needs to print quad_t [size in base 8 + \0] */
                     91: #define KPRINTF_BUFSIZE                (sizeof(quad_t) * NBBY / 3 + 2)
                     92:
                     93:
                     94: /*
                     95:  * local prototypes
                     96:  */
                     97:
                     98: int     kprintf(const char *, int, void *, char *, va_list);
                     99: void    kputchar(int, int, struct tty *);
                    100:
                    101: struct mutex kprintf_mutex = MUTEX_INITIALIZER(IPL_HIGH);
                    102:
                    103: /*
                    104:  * globals
                    105:  */
                    106:
                    107: extern struct  tty *constty;   /* pointer to console "window" tty */
                    108: int    consintr = 1;   /* ok to handle console interrupts? */
                    109: extern int log_open;   /* subr_log: is /dev/klog open? */
                    110: const  char *panicstr; /* arg to first call to panic (used as a flag
                    111:                           to indicate that panic has already been called). */
                    112: #ifdef DDB
                    113: /*
                    114:  * Enter ddb on panic.
                    115:  */
                    116: int    db_panic = 1;
                    117:
                    118: /*
                    119:  * db_console controls if we can be able to enter ddb by a special key
                    120:  * combination (machine dependent).
                    121:  * If DDB_SAFE_CONSOLE is defined in the kernel configuration it allows
                    122:  * to break into console during boot. It's _really_ useful when debugging
                    123:  * some things in the kernel that can cause init(8) to crash.
                    124:  */
                    125: #ifdef DDB_SAFE_CONSOLE
                    126: int    db_console = 1;
                    127: #else
                    128: int    db_console = 0;
                    129: #endif
                    130: #endif
                    131:
                    132: /*
                    133:  * panic on spl assertion failure?
                    134:  */
                    135: int splassert_ctl = 1;
                    136:
                    137: /*
                    138:  * v_putc: routine to putc on virtual console
                    139:  *
                    140:  * the v_putc pointer can be used to redirect the console cnputc elsewhere
                    141:  * [e.g. to a "virtual console"].
                    142:  */
                    143:
                    144: void (*v_putc)(int) = cnputc;  /* start with cnputc (normal cons) */
                    145:
                    146:
                    147: /*
                    148:  * functions
                    149:  */
                    150:
                    151: /*
                    152:  *     Partial support (the failure case) of the assertion facility
                    153:  *     commonly found in userland.
                    154:  */
                    155: void
                    156: __assert(const char *t, const char *f, int l, const char *e)
                    157: {
                    158:
                    159:        panic("kernel %sassertion \"%s\" failed: file \"%s\", line %d",
                    160:                t, e, f, l);
                    161: }
                    162:
                    163: /*
                    164:  * tablefull: warn that a system table is full
                    165:  */
                    166:
                    167: void
                    168: tablefull(const char *tab)
                    169: {
                    170:        log(LOG_ERR, "%s: table is full\n", tab);
                    171: }
                    172:
                    173: /*
                    174:  * panic: handle an unresolvable fatal error
                    175:  *
                    176:  * prints "panic: <message>" and reboots.   if called twice (i.e. recursive
                    177:  * call) we avoid trying to sync the disk and just reboot (to avoid
                    178:  * recursive panics).
                    179:  */
                    180:
                    181: void
                    182: panic(const char *fmt, ...)
                    183: {
                    184:        static char panicbuf[512];
                    185:        int bootopt;
                    186:        va_list ap;
                    187:
                    188:        bootopt = RB_AUTOBOOT | RB_DUMP;
                    189: #if defined(UVM_SWAP_ENCRYPT)
                    190:        if (uvm_doswapencrypt)
                    191:                bootopt &= ~RB_DUMP;
                    192: #endif
                    193:        va_start(ap, fmt);
                    194:        if (panicstr)
                    195:                bootopt |= RB_NOSYNC;
                    196:        else {
                    197:                vsnprintf(panicbuf, sizeof panicbuf, fmt, ap);
                    198:                panicstr = panicbuf;
                    199:        }
                    200:        va_end(ap);
                    201:
                    202:        printf("panic: ");
                    203:        va_start(ap, fmt);
                    204:        vprintf(fmt, ap);
                    205:        printf("\n");
                    206:        va_end(ap);
                    207:
                    208: #ifdef KGDB
                    209:        kgdb_panic();
                    210: #endif
                    211: #ifdef KADB
                    212:        if (boothowto & RB_KDB)
                    213:                kdbpanic();
                    214: #endif
                    215: #ifdef DDB
                    216:        if (db_panic)
                    217:                Debugger();
                    218:        else
                    219:                db_stack_dump();
                    220: #endif
                    221:        boot(bootopt);
                    222: }
                    223:
                    224: /*
                    225:  * We print only the function name. The file name is usually very long and
                    226:  * would eat tons of space in the kernel.
                    227:  */
                    228: void
                    229: splassert_fail(int wantipl, int haveipl, const char *func)
                    230: {
                    231:
                    232:        printf("splassert: %s: want %d have %d\n", func, wantipl, haveipl);
                    233:        switch (splassert_ctl) {
                    234:        case 1:
                    235:                break;
                    236:        case 2:
                    237: #ifdef DDB
                    238:                db_stack_dump();
                    239: #endif
                    240:                break;
                    241:        case 3:
                    242: #ifdef DDB
                    243:                db_stack_dump();
                    244:                Debugger();
                    245: #endif
                    246:                break;
                    247:        default:
                    248:                panic("spl assertion failure in %s", func);
                    249:        }
                    250: }
                    251:
                    252: /*
                    253:  * kernel logging functions: log, logpri, addlog
                    254:  */
                    255:
                    256: /*
                    257:  * log: write to the log buffer
                    258:  *
                    259:  * => will not sleep [so safe to call from interrupt]
                    260:  * => will log to console if /dev/klog isn't open
                    261:  */
                    262:
                    263: void
                    264: log(int level, const char *fmt, ...)
                    265: {
                    266:        int s;
                    267:        va_list ap;
                    268:
                    269:        s = splhigh();
                    270:        logpri(level);          /* log the level first */
                    271:        va_start(ap, fmt);
                    272:        kprintf(fmt, TOLOG, NULL, NULL, ap);
                    273:        va_end(ap);
                    274:        splx(s);
                    275:        if (!log_open) {
                    276:                va_start(ap, fmt);
                    277:                kprintf(fmt, TOCONS, NULL, NULL, ap);
                    278:                va_end(ap);
                    279:        }
                    280:        logwakeup();            /* wake up anyone waiting for log msgs */
                    281: }
                    282:
                    283: /*
                    284:  * logpri: log the priority level to the klog
                    285:  */
                    286:
                    287: void
                    288: logpri(int level)
                    289: {
                    290:        char *p;
                    291:        char snbuf[KPRINTF_BUFSIZE];
                    292:
                    293:        kputchar('<', TOLOG, NULL);
                    294:        snprintf(snbuf, sizeof snbuf, "%d", level);
                    295:        for (p = snbuf ; *p ; p++)
                    296:                kputchar(*p, TOLOG, NULL);
                    297:        kputchar('>', TOLOG, NULL);
                    298: }
                    299:
                    300: /*
                    301:  * addlog: add info to previous log message
                    302:  */
                    303:
                    304: int
                    305: addlog(const char *fmt, ...)
                    306: {
                    307:        int s;
                    308:        va_list ap;
                    309:
                    310:        s = splhigh();
                    311:        va_start(ap, fmt);
                    312:        kprintf(fmt, TOLOG, NULL, NULL, ap);
                    313:        va_end(ap);
                    314:        splx(s);
                    315:        if (!log_open) {
                    316:                va_start(ap, fmt);
                    317:                kprintf(fmt, TOCONS, NULL, NULL, ap);
                    318:                va_end(ap);
                    319:        }
                    320:        logwakeup();
                    321:        return(0);
                    322: }
                    323:
                    324:
                    325: /*
                    326:  * kputchar: print a single character on console or user terminal.
                    327:  *
                    328:  * => if console, then the last MSGBUFS chars are saved in msgbuf
                    329:  *     for inspection later (e.g. dmesg/syslog)
                    330:  */
                    331: void
                    332: kputchar(int c, int flags, struct tty *tp)
                    333: {
                    334:        extern int msgbufmapped;
                    335:
                    336:        if (panicstr)
                    337:                constty = NULL;
                    338:        if ((flags & TOCONS) && tp == NULL && constty) {
                    339:                tp = constty;
                    340:                flags |= TOTTY;
                    341:        }
                    342:        if ((flags & TOTTY) && tp && tputchar(c, tp) < 0 &&
                    343:            (flags & TOCONS) && tp == constty)
                    344:                constty = NULL;
                    345:        if ((flags & TOLOG) &&
                    346:            c != '\0' && c != '\r' && c != 0177 && msgbufmapped)
                    347:                msgbuf_putchar(c);
                    348:        if ((flags & TOCONS) && constty == NULL && c != '\0')
                    349:                (*v_putc)(c);
                    350: #ifdef DDB
                    351:        if (flags & TODDB)
                    352:                db_putchar(c);
                    353: #endif
                    354: }
                    355:
                    356:
                    357: /*
                    358:  * uprintf: print to the controlling tty of the current process
                    359:  *
                    360:  * => we may block if the tty queue is full
                    361:  * => no message is printed if the queue doesn't clear in a reasonable
                    362:  *     time
                    363:  */
                    364:
                    365: void
                    366: uprintf(const char *fmt, ...)
                    367: {
                    368:        struct proc *p = curproc;
                    369:        va_list ap;
                    370:
                    371:        if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) {
                    372:                va_start(ap, fmt);
                    373:                kprintf(fmt, TOTTY, p->p_session->s_ttyp, NULL, ap);
                    374:                va_end(ap);
                    375:        }
                    376: }
                    377:
                    378: #if defined(NFSSERVER) || defined(NFSCLIENT)
                    379:
                    380: /*
                    381:  * tprintf functions: used to send messages to a specific process
                    382:  *
                    383:  * usage:
                    384:  *   get a tpr_t handle on a process "p" by using "tprintf_open(p)"
                    385:  *   use the handle when calling "tprintf"
                    386:  *   when done, do a "tprintf_close" to drop the handle
                    387:  */
                    388:
                    389: /*
                    390:  * tprintf_open: get a tprintf handle on a process "p"
                    391:  *
                    392:  * => returns NULL if process can't be printed to
                    393:  */
                    394:
                    395: tpr_t
                    396: tprintf_open(struct proc *p)
                    397: {
                    398:
                    399:        if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) {
                    400:                SESSHOLD(p->p_session);
                    401:                return ((tpr_t) p->p_session);
                    402:        }
                    403:        return ((tpr_t) NULL);
                    404: }
                    405:
                    406: /*
                    407:  * tprintf_close: dispose of a tprintf handle obtained with tprintf_open
                    408:  */
                    409:
                    410: void
                    411: tprintf_close(tpr_t sess)
                    412: {
                    413:
                    414:        if (sess)
                    415:                SESSRELE((struct session *) sess);
                    416: }
                    417:
                    418: /*
                    419:  * tprintf: given tprintf handle to a process [obtained with tprintf_open],
                    420:  * send a message to the controlling tty for that process.
                    421:  *
                    422:  * => also sends message to /dev/klog
                    423:  */
                    424: void
                    425: tprintf(tpr_t tpr, const char *fmt, ...)
                    426: {
                    427:        struct session *sess = (struct session *)tpr;
                    428:        struct tty *tp = NULL;
                    429:        int flags = TOLOG;
                    430:        va_list ap;
                    431:
                    432:        logpri(LOG_INFO);
                    433:        if (sess && sess->s_ttyvp && ttycheckoutq(sess->s_ttyp, 0)) {
                    434:                flags |= TOTTY;
                    435:                tp = sess->s_ttyp;
                    436:        }
                    437:        va_start(ap, fmt);
                    438:        kprintf(fmt, flags, tp, NULL, ap);
                    439:        va_end(ap);
                    440:        logwakeup();
                    441: }
                    442:
                    443: #endif /* NFSSERVER || NFSCLIENT */
                    444:
                    445:
                    446: /*
                    447:  * ttyprintf: send a message to a specific tty
                    448:  *
                    449:  * => should be used only by tty driver or anything that knows the
                    450:  *     underlying tty will not be revoked(2)'d away.  [otherwise,
                    451:  *     use tprintf]
                    452:  */
                    453: void
                    454: ttyprintf(struct tty *tp, const char *fmt, ...)
                    455: {
                    456:        va_list ap;
                    457:
                    458:        va_start(ap, fmt);
                    459:        kprintf(fmt, TOTTY, tp, NULL, ap);
                    460:        va_end(ap);
                    461: }
                    462:
                    463: #ifdef DDB
                    464:
                    465: /*
                    466:  * db_printf: printf for DDB (via db_putchar)
                    467:  */
                    468:
                    469: int
                    470: db_printf(const char *fmt, ...)
                    471: {
                    472:        va_list ap;
                    473:        int flags, retval;
                    474:
                    475:        flags = TODDB;
                    476:        if (db_log)
                    477:                flags |= TOLOG;
                    478:        va_start(ap, fmt);
                    479:        retval = kprintf(fmt, flags, NULL, NULL, ap);
                    480:        va_end(ap);
                    481:        return(retval);
                    482: }
                    483:
                    484: #endif /* DDB */
                    485:
                    486:
                    487: /*
                    488:  * normal kernel printf functions: printf, vprintf, snprintf
                    489:  */
                    490:
                    491: /*
                    492:  * printf: print a message to the console and the log
                    493:  */
                    494: int
                    495: printf(const char *fmt, ...)
                    496: {
                    497:        va_list ap;
                    498:        int savintr, retval;
                    499:
                    500:        mtx_enter(&kprintf_mutex);
                    501:
                    502:        savintr = consintr;             /* disable interrupts */
                    503:        consintr = 0;
                    504:        va_start(ap, fmt);
                    505:        retval = kprintf(fmt, TOCONS | TOLOG, NULL, NULL, ap);
                    506:        va_end(ap);
                    507:        if (!panicstr)
                    508:                logwakeup();
                    509:        consintr = savintr;             /* reenable interrupts */
                    510:
                    511:        mtx_leave(&kprintf_mutex);
                    512:
                    513:        return(retval);
                    514: }
                    515:
                    516: /*
                    517:  * vprintf: print a message to the console and the log [already have a
                    518:  *     va_list]
                    519:  */
                    520:
                    521: int
                    522: vprintf(const char *fmt, va_list ap)
                    523: {
                    524:        int savintr, retval;
                    525:
                    526:        mtx_enter(&kprintf_mutex);
                    527:
                    528:        savintr = consintr;             /* disable interrupts */
                    529:        consintr = 0;
                    530:        retval = kprintf(fmt, TOCONS | TOLOG, NULL, NULL, ap);
                    531:        if (!panicstr)
                    532:                logwakeup();
                    533:        consintr = savintr;             /* reenable interrupts */
                    534:
                    535:        mtx_leave(&kprintf_mutex);
                    536:
                    537:        return (retval);
                    538: }
                    539:
                    540: /*
                    541:  * snprintf: print a message to a buffer
                    542:  */
                    543: int
                    544: snprintf(char *buf, size_t size, const char *fmt, ...)
                    545: {
                    546:        int retval;
                    547:        va_list ap;
                    548:        char *p;
                    549:
                    550:        p = buf + size - 1;
                    551:        if (size < 1)
                    552:                p = buf;
                    553:        va_start(ap, fmt);
                    554:        retval = kprintf(fmt, TOBUFONLY | TOCOUNT, &p, buf, ap);
                    555:        va_end(ap);
                    556:        if (size > 0)
                    557:                *(p) = 0;       /* null terminate */
                    558:        return(retval);
                    559: }
                    560:
                    561: /*
                    562:  * vsnprintf: print a message to a buffer [already have va_alist]
                    563:  */
                    564: int
                    565: vsnprintf(char *buf, size_t size, const char *fmt, va_list ap)
                    566: {
                    567:        int retval;
                    568:        char *p;
                    569:
                    570:        p = buf + size - 1;
                    571:        if (size < 1)
                    572:                p = buf;
                    573:        retval = kprintf(fmt, TOBUFONLY | TOCOUNT, &p, buf, ap);
                    574:        if (size > 0)
                    575:                *(p) = 0;       /* null terminate */
                    576:        return(retval);
                    577: }
                    578:
                    579: /*
                    580:  * kprintf: scaled down version of printf(3).
                    581:  *
                    582:  * this version based on vfprintf() from libc which was derived from
                    583:  * software contributed to Berkeley by Chris Torek.
                    584:  *
                    585:  * Two additional formats:
                    586:  *
                    587:  * The format %b is supported to decode error registers.
                    588:  * Its usage is:
                    589:  *
                    590:  *     printf("reg=%b\n", regval, "<base><arg>*");
                    591:  *
                    592:  * where <base> is the output base expressed as a control character, e.g.
                    593:  * \10 gives octal; \20 gives hex.  Each arg is a sequence of characters,
                    594:  * the first of which gives the bit number to be inspected (origin 1), and
                    595:  * the next characters (up to a control character, i.e. a character <= 32),
                    596:  * give the name of the register.  Thus:
                    597:  *
                    598:  *     kprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n");
                    599:  *
                    600:  * would produce output:
                    601:  *
                    602:  *     reg=3<BITTWO,BITONE>
                    603:  *
                    604:  * To support larger integers (> 32 bits), %b formatting will also accept
                    605:  * control characters in the region 0x80 - 0xff.  0x80 refers to bit 0,
                    606:  * 0x81 refers to bit 1, and so on.  The equivalent string to the above is:
                    607:  *
                    608:  *     kprintf("reg=%b\n", 3, "\10\201BITTWO\200BITONE\n");
                    609:  *
                    610:  * and would produce the same output.
                    611:  *
                    612:  * Like the rest of printf, %b can be prefixed to handle various size
                    613:  * modifiers, eg. %b is for "int", %lb is for "long", and %llb supports
                    614:  * "long long".
                    615:  *
                    616:  * This code is large and complicated...
                    617:  */
                    618:
                    619: /*
                    620:  * macros for converting digits to letters and vice versa
                    621:  */
                    622: #define        to_digit(c)     ((c) - '0')
                    623: #define is_digit(c)    ((unsigned)to_digit(c) <= 9)
                    624: #define        to_char(n)      ((n) + '0')
                    625:
                    626: /*
                    627:  * flags used during conversion.
                    628:  */
                    629: #define        ALT             0x001           /* alternate form */
                    630: #define        HEXPREFIX       0x002           /* add 0x or 0X prefix */
                    631: #define        LADJUST         0x004           /* left adjustment */
                    632: #define        LONGDBL         0x008           /* long double; unimplemented */
                    633: #define        LONGINT         0x010           /* long integer */
                    634: #define        QUADINT         0x020           /* quad integer */
                    635: #define        SHORTINT        0x040           /* short integer */
                    636: #define        ZEROPAD         0x080           /* zero (as opposed to blank) pad */
                    637: #define FPT            0x100           /* Floating point number */
                    638:
                    639:        /*
                    640:         * To extend shorts properly, we need both signed and unsigned
                    641:         * argument extraction methods.
                    642:         */
                    643: #define        SARG() \
                    644:        (flags&QUADINT ? va_arg(ap, quad_t) : \
                    645:            flags&LONGINT ? va_arg(ap, long) : \
                    646:            flags&SHORTINT ? (long)(short)va_arg(ap, int) : \
                    647:            (long)va_arg(ap, int))
                    648: #define        UARG() \
                    649:        (flags&QUADINT ? va_arg(ap, u_quad_t) : \
                    650:            flags&LONGINT ? va_arg(ap, u_long) : \
                    651:            flags&SHORTINT ? (u_long)(u_short)va_arg(ap, int) : \
                    652:            (u_long)va_arg(ap, u_int))
                    653:
                    654: #define KPRINTF_PUTCHAR(C) do {                                        \
                    655:        int chr = (C);                                                  \
                    656:        ret += 1;                                                       \
                    657:        if (oflags & TOBUFONLY) {                                       \
                    658:                if ((vp != NULL) && (sbuf == tailp)) {                  \
                    659:                        if (!(oflags & TOCOUNT))                                \
                    660:                                goto overflow;                          \
                    661:                } else                                                  \
                    662:                        *sbuf++ = chr;                                  \
                    663:        } else {                                                        \
                    664:                kputchar(chr, oflags, (struct tty *)vp);                        \
                    665:        }                                                               \
                    666: } while(0)
                    667:
                    668: int
                    669: kprintf(const char *fmt0, int oflags, void *vp, char *sbuf, va_list ap)
                    670: {
                    671:        char *fmt;              /* format string */
                    672:        int ch;                 /* character from fmt */
                    673:        int n;                  /* handy integer (short term usage) */
                    674:        char *cp = NULL;        /* handy char pointer (short term usage) */
                    675:        int flags;              /* flags as above */
                    676:        int ret;                /* return value accumulator */
                    677:        int width;              /* width from format (%8d), or 0 */
                    678:        int prec;               /* precision from format (%.3d), or -1 */
                    679:        char sign;              /* sign prefix (' ', '+', '-', or \0) */
                    680:
                    681:        u_quad_t _uquad;        /* integer arguments %[diouxX] */
                    682:        enum { OCT, DEC, HEX } base;/* base for [diouxX] conversion */
                    683:        int dprec;              /* a copy of prec if [diouxX], 0 otherwise */
                    684:        int realsz;             /* field size expanded by dprec */
                    685:        int size = 0;           /* size of converted field or string */
                    686:        char *xdigs = NULL;     /* digits for [xX] conversion */
                    687:        char buf[KPRINTF_BUFSIZE]; /* space for %c, %[diouxX] */
                    688:        char *tailp = NULL;     /* tail pointer for snprintf */
                    689:
                    690:        if ((oflags & TOBUFONLY) && (vp != NULL))
                    691:                tailp = *(char **)vp;
                    692:
                    693:        fmt = (char *)fmt0;
                    694:        ret = 0;
                    695:
                    696:        /*
                    697:         * Scan the format for conversions (`%' character).
                    698:         */
                    699:        for (;;) {
                    700:                while (*fmt != '%' && *fmt) {
                    701:                        KPRINTF_PUTCHAR(*fmt++);
                    702:                }
                    703:                if (*fmt == 0)
                    704:                        goto done;
                    705:
                    706:                fmt++;          /* skip over '%' */
                    707:
                    708:                flags = 0;
                    709:                dprec = 0;
                    710:                width = 0;
                    711:                prec = -1;
                    712:                sign = '\0';
                    713:
                    714: rflag:         ch = *fmt++;
                    715: reswitch:      switch (ch) {
                    716:                /* XXX: non-standard '%b' format */
                    717:                case 'b': {
                    718:                        char *b, *z;
                    719:                        int tmp;
                    720:                        _uquad = UARG();
                    721:                        b = va_arg(ap, char *);
                    722:                        if (*b == 8)
                    723:                                snprintf(buf, sizeof buf, "%llo", _uquad);
                    724:                        else if (*b == 10)
                    725:                                snprintf(buf, sizeof buf, "%lld", _uquad);
                    726:                        else if (*b == 16)
                    727:                                snprintf(buf, sizeof buf, "%llx", _uquad);
                    728:                        else
                    729:                                break;
                    730:                        b++;
                    731:
                    732:                        z = buf;
                    733:                        while (*z) {
                    734:                                KPRINTF_PUTCHAR(*z++);
                    735:                        }
                    736:
                    737:                        if (_uquad) {
                    738:                                tmp = 0;
                    739:                                while ((n = *b++) != 0) {
                    740:                                        if (n & 0x80)
                    741:                                                n &= 0x7f;
                    742:                                        else if (n <= ' ')
                    743:                                                n = n - 1;
                    744:                                        if (_uquad & (1LL << n)) {
                    745:                                                KPRINTF_PUTCHAR(tmp ? ',':'<');
                    746:                                                while (*b > ' ' &&
                    747:                                                    (*b & 0x80) == 0) {
                    748:                                                        KPRINTF_PUTCHAR(*b);
                    749:                                                        b++;
                    750:                                                }
                    751:                                                tmp = 1;
                    752:                                        } else {
                    753:                                                while (*b > ' ' &&
                    754:                                                    (*b & 0x80) == 0)
                    755:                                                        b++;
                    756:                                        }
                    757:                                }
                    758:                                if (tmp) {
                    759:                                        KPRINTF_PUTCHAR('>');
                    760:                                }
                    761:                        }
                    762:                        continue;       /* no output */
                    763:                }
                    764:
                    765: #ifdef DDB
                    766:                /* XXX: non-standard '%r' format (print int in db_radix) */
                    767:                case 'r':
                    768:                        if ((oflags & TODDB) == 0)
                    769:                                goto default_case;
                    770:
                    771:                        if (db_radix == 16)
                    772:                                goto case_z;    /* signed hex */
                    773:                        _uquad = SARG();
                    774:                        if ((quad_t)_uquad < 0) {
                    775:                                _uquad = -_uquad;
                    776:                                sign = '-';
                    777:                        }
                    778:                        base = (db_radix == 8) ? OCT : DEC;
                    779:                        goto number;
                    780:
                    781:
                    782:                /* XXX: non-standard '%z' format ("signed hex", a "hex %i")*/
                    783:                case 'z':
                    784:                case_z:
                    785:                        if ((oflags & TODDB) == 0)
                    786:                                goto default_case;
                    787:
                    788:                        xdigs = "0123456789abcdef";
                    789:                        ch = 'x';       /* the 'x' in '0x' (below) */
                    790:                        _uquad = SARG();
                    791:                        base = HEX;
                    792:                        /* leading 0x/X only if non-zero */
                    793:                        if (flags & ALT && _uquad != 0)
                    794:                                flags |= HEXPREFIX;
                    795:                        if ((quad_t)_uquad < 0) {
                    796:                                _uquad = -_uquad;
                    797:                                sign = '-';
                    798:                        }
                    799:                        goto number;
                    800: #endif
                    801:
                    802:                case ' ':
                    803:                        /*
                    804:                         * ``If the space and + flags both appear, the space
                    805:                         * flag will be ignored.''
                    806:                         *      -- ANSI X3J11
                    807:                         */
                    808:                        if (!sign)
                    809:                                sign = ' ';
                    810:                        goto rflag;
                    811:                case '#':
                    812:                        flags |= ALT;
                    813:                        goto rflag;
                    814:                case '*':
                    815:                        /*
                    816:                         * ``A negative field width argument is taken as a
                    817:                         * - flag followed by a positive field width.''
                    818:                         *      -- ANSI X3J11
                    819:                         * They don't exclude field widths read from args.
                    820:                         */
                    821:                        if ((width = va_arg(ap, int)) >= 0)
                    822:                                goto rflag;
                    823:                        width = -width;
                    824:                        /* FALLTHROUGH */
                    825:                case '-':
                    826:                        flags |= LADJUST;
                    827:                        goto rflag;
                    828:                case '+':
                    829:                        sign = '+';
                    830:                        goto rflag;
                    831:                case '.':
                    832:                        if ((ch = *fmt++) == '*') {
                    833:                                n = va_arg(ap, int);
                    834:                                prec = n < 0 ? -1 : n;
                    835:                                goto rflag;
                    836:                        }
                    837:                        n = 0;
                    838:                        while (is_digit(ch)) {
                    839:                                n = 10 * n + to_digit(ch);
                    840:                                ch = *fmt++;
                    841:                        }
                    842:                        prec = n < 0 ? -1 : n;
                    843:                        goto reswitch;
                    844:                case '0':
                    845:                        /*
                    846:                         * ``Note that 0 is taken as a flag, not as the
                    847:                         * beginning of a field width.''
                    848:                         *      -- ANSI X3J11
                    849:                         */
                    850:                        flags |= ZEROPAD;
                    851:                        goto rflag;
                    852:                case '1': case '2': case '3': case '4':
                    853:                case '5': case '6': case '7': case '8': case '9':
                    854:                        n = 0;
                    855:                        do {
                    856:                                n = 10 * n + to_digit(ch);
                    857:                                ch = *fmt++;
                    858:                        } while (is_digit(ch));
                    859:                        width = n;
                    860:                        goto reswitch;
                    861:                case 'h':
                    862:                        flags |= SHORTINT;
                    863:                        goto rflag;
                    864:                case 'l':
                    865:                        if (*fmt == 'l') {
                    866:                                fmt++;
                    867:                                flags |= QUADINT;
                    868:                        } else {
                    869:                                flags |= LONGINT;
                    870:                        }
                    871:                        goto rflag;
                    872:                case 'q':
                    873:                        flags |= QUADINT;
                    874:                        goto rflag;
                    875:                case 'c':
                    876:                        *(cp = buf) = va_arg(ap, int);
                    877:                        size = 1;
                    878:                        sign = '\0';
                    879:                        break;
                    880:                case 'D':
                    881:                        flags |= LONGINT;
                    882:                        /*FALLTHROUGH*/
                    883:                case 'd':
                    884:                case 'i':
                    885:                        _uquad = SARG();
                    886:                        if ((quad_t)_uquad < 0) {
                    887:                                _uquad = -_uquad;
                    888:                                sign = '-';
                    889:                        }
                    890:                        base = DEC;
                    891:                        goto number;
                    892:                case 'n':
                    893: #ifdef DDB
                    894:                /* XXX: non-standard '%n' format */
                    895:                /*
                    896:                 * XXX: HACK!   DDB wants '%n' to be a '%u' printed
                    897:                 * in db_radix format.   this should die since '%n'
                    898:                 * is already defined in standard printf to write
                    899:                 * the number of chars printed so far to the arg (which
                    900:                 * should be a pointer.
                    901:                 */
                    902:                        if (oflags & TODDB) {
                    903:                                if (db_radix == 16)
                    904:                                        ch = 'x';       /* convert to %x */
                    905:                                else if (db_radix == 8)
                    906:                                        ch = 'o';       /* convert to %o */
                    907:                                else
                    908:                                        ch = 'u';       /* convert to %u */
                    909:
                    910:                                /* ... and start again */
                    911:                                goto reswitch;
                    912:                        }
                    913:
                    914: #endif
                    915:                        if (flags & QUADINT)
                    916:                                *va_arg(ap, quad_t *) = ret;
                    917:                        else if (flags & LONGINT)
                    918:                                *va_arg(ap, long *) = ret;
                    919:                        else if (flags & SHORTINT)
                    920:                                *va_arg(ap, short *) = ret;
                    921:                        else
                    922:                                *va_arg(ap, int *) = ret;
                    923:                        continue;       /* no output */
                    924:                case 'O':
                    925:                        flags |= LONGINT;
                    926:                        /*FALLTHROUGH*/
                    927:                case 'o':
                    928:                        _uquad = UARG();
                    929:                        base = OCT;
                    930:                        goto nosign;
                    931:                case 'p':
                    932:                        /*
                    933:                         * ``The argument shall be a pointer to void.  The
                    934:                         * value of the pointer is converted to a sequence
                    935:                         * of printable characters, in an implementation-
                    936:                         * defined manner.''
                    937:                         *      -- ANSI X3J11
                    938:                         */
                    939:                        /* NOSTRICT */
                    940:                        _uquad = (u_long)va_arg(ap, void *);
                    941:                        base = HEX;
                    942:                        xdigs = "0123456789abcdef";
                    943:                        flags |= HEXPREFIX;
                    944:                        ch = 'x';
                    945:                        goto nosign;
                    946:                case 's':
                    947:                        if ((cp = va_arg(ap, char *)) == NULL)
                    948:                                cp = "(null)";
                    949:                        if (prec >= 0) {
                    950:                                /*
                    951:                                 * can't use strlen; can only look for the
                    952:                                 * NUL in the first `prec' characters, and
                    953:                                 * strlen() will go further.
                    954:                                 */
                    955:                                char *p = memchr(cp, 0, prec);
                    956:
                    957:                                if (p != NULL) {
                    958:                                        size = p - cp;
                    959:                                        if (size > prec)
                    960:                                                size = prec;
                    961:                                } else
                    962:                                        size = prec;
                    963:                        } else
                    964:                                size = strlen(cp);
                    965:                        sign = '\0';
                    966:                        break;
                    967:                case 'U':
                    968:                        flags |= LONGINT;
                    969:                        /*FALLTHROUGH*/
                    970:                case 'u':
                    971:                        _uquad = UARG();
                    972:                        base = DEC;
                    973:                        goto nosign;
                    974:                case 'X':
                    975:                        xdigs = "0123456789ABCDEF";
                    976:                        goto hex;
                    977:                case 'x':
                    978:                        xdigs = "0123456789abcdef";
                    979: hex:                   _uquad = UARG();
                    980:                        base = HEX;
                    981:                        /* leading 0x/X only if non-zero */
                    982:                        if (flags & ALT && _uquad != 0)
                    983:                                flags |= HEXPREFIX;
                    984:
                    985:                        /* unsigned conversions */
                    986: nosign:                        sign = '\0';
                    987:                        /*
                    988:                         * ``... diouXx conversions ... if a precision is
                    989:                         * specified, the 0 flag will be ignored.''
                    990:                         *      -- ANSI X3J11
                    991:                         */
                    992: number:                        if ((dprec = prec) >= 0)
                    993:                                flags &= ~ZEROPAD;
                    994:
                    995:                        /*
                    996:                         * ``The result of converting a zero value with an
                    997:                         * explicit precision of zero is no characters.''
                    998:                         *      -- ANSI X3J11
                    999:                         */
                   1000:                        cp = buf + KPRINTF_BUFSIZE;
                   1001:                        if (_uquad != 0 || prec != 0) {
                   1002:                                /*
                   1003:                                 * Unsigned mod is hard, and unsigned mod
                   1004:                                 * by a constant is easier than that by
                   1005:                                 * a variable; hence this switch.
                   1006:                                 */
                   1007:                                switch (base) {
                   1008:                                case OCT:
                   1009:                                        do {
                   1010:                                                *--cp = to_char(_uquad & 7);
                   1011:                                                _uquad >>= 3;
                   1012:                                        } while (_uquad);
                   1013:                                        /* handle octal leading 0 */
                   1014:                                        if (flags & ALT && *cp != '0')
                   1015:                                                *--cp = '0';
                   1016:                                        break;
                   1017:
                   1018:                                case DEC:
                   1019:                                        /* many numbers are 1 digit */
                   1020:                                        while (_uquad >= 10) {
                   1021:                                                *--cp = to_char(_uquad % 10);
                   1022:                                                _uquad /= 10;
                   1023:                                        }
                   1024:                                        *--cp = to_char(_uquad);
                   1025:                                        break;
                   1026:
                   1027:                                case HEX:
                   1028:                                        do {
                   1029:                                                *--cp = xdigs[_uquad & 15];
                   1030:                                                _uquad >>= 4;
                   1031:                                        } while (_uquad);
                   1032:                                        break;
                   1033:
                   1034:                                default:
                   1035:                                        cp = "bug in kprintf: bad base";
                   1036:                                        size = strlen(cp);
                   1037:                                        goto skipsize;
                   1038:                                }
                   1039:                        }
                   1040:                        size = buf + KPRINTF_BUFSIZE - cp;
                   1041:                skipsize:
                   1042:                        break;
                   1043:                default:        /* "%?" prints ?, unless ? is NUL */
                   1044: #ifdef DDB
                   1045:                default_case:   /* DDB */
                   1046: #endif
                   1047:                        if (ch == '\0')
                   1048:                                goto done;
                   1049:                        /* pretend it was %c with argument ch */
                   1050:                        cp = buf;
                   1051:                        *cp = ch;
                   1052:                        size = 1;
                   1053:                        sign = '\0';
                   1054:                        break;
                   1055:                }
                   1056:
                   1057:                /*
                   1058:                 * All reasonable formats wind up here.  At this point, `cp'
                   1059:                 * points to a string which (if not flags&LADJUST) should be
                   1060:                 * padded out to `width' places.  If flags&ZEROPAD, it should
                   1061:                 * first be prefixed by any sign or other prefix; otherwise,
                   1062:                 * it should be blank padded before the prefix is emitted.
                   1063:                 * After any left-hand padding and prefixing, emit zeroes
                   1064:                 * required by a decimal [diouxX] precision, then print the
                   1065:                 * string proper, then emit zeroes required by any leftover
                   1066:                 * floating precision; finally, if LADJUST, pad with blanks.
                   1067:                 *
                   1068:                 * Compute actual size, so we know how much to pad.
                   1069:                 * size excludes decimal prec; realsz includes it.
                   1070:                 */
                   1071:                realsz = dprec > size ? dprec : size;
                   1072:                if (sign)
                   1073:                        realsz++;
                   1074:                else if (flags & HEXPREFIX)
                   1075:                        realsz+= 2;
                   1076:
                   1077:                /* right-adjusting blank padding */
                   1078:                if ((flags & (LADJUST|ZEROPAD)) == 0) {
                   1079:                        n = width - realsz;
                   1080:                        while (n-- > 0)
                   1081:                                KPRINTF_PUTCHAR(' ');
                   1082:                }
                   1083:
                   1084:                /* prefix */
                   1085:                if (sign) {
                   1086:                        KPRINTF_PUTCHAR(sign);
                   1087:                } else if (flags & HEXPREFIX) {
                   1088:                        KPRINTF_PUTCHAR('0');
                   1089:                        KPRINTF_PUTCHAR(ch);
                   1090:                }
                   1091:
                   1092:                /* right-adjusting zero padding */
                   1093:                if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD) {
                   1094:                        n = width - realsz;
                   1095:                        while (n-- > 0)
                   1096:                                KPRINTF_PUTCHAR('0');
                   1097:                }
                   1098:
                   1099:                /* leading zeroes from decimal precision */
                   1100:                n = dprec - size;
                   1101:                while (n-- > 0)
                   1102:                        KPRINTF_PUTCHAR('0');
                   1103:
                   1104:                /* the string or number proper */
                   1105:                while (size--)
                   1106:                        KPRINTF_PUTCHAR(*cp++);
                   1107:                /* left-adjusting padding (always blank) */
                   1108:                if (flags & LADJUST) {
                   1109:                        n = width - realsz;
                   1110:                        while (n-- > 0)
                   1111:                                KPRINTF_PUTCHAR(' ');
                   1112:                }
                   1113:        }
                   1114:
                   1115: done:
                   1116:        if ((oflags & TOBUFONLY) && (vp != NULL))
                   1117:                *(char **)vp = sbuf;
                   1118: overflow:
                   1119:        return (ret);
                   1120:        /* NOTREACHED */
                   1121: }
                   1122:
                   1123: #if __GNUC_PREREQ__(2,96)
                   1124: /*
                   1125:  * XXX - these functions shouldn't be in the kernel, but gcc 3.X feels like
                   1126:  *       translating some printf calls to puts and since it doesn't seem
                   1127:  *       possible to just turn off parts of those optimizations (some of
                   1128:  *       them are really useful), we have to provide a dummy puts and putchar
                   1129:  *      that are wrappers around printf.
                   1130:  */
                   1131: int    puts(const char *);
                   1132: int    putchar(int c);
                   1133:
                   1134: int
                   1135: puts(const char *str)
                   1136: {
                   1137:        printf("%s\n", str);
                   1138:
                   1139:        return (0);
                   1140: }
                   1141:
                   1142: int
                   1143: putchar(int c)
                   1144: {
                   1145:        printf("%c", c);
                   1146:
                   1147:        return (c);
                   1148: }
                   1149:
                   1150:
                   1151: #endif

CVSweb