Annotation of funnyos/libkern/printf.c, Revision 1.1
1.1 ! init 1: /* $Id: printf.c,v 1.1.1.1 2007/10/12 08:40:38 init Exp $ */
! 2: /* $OpenBSD: printf.c,v 1.24 2006/09/18 21:11:50 mpf Exp $ */
! 3: /* $NetBSD: printf.c,v 1.10 1996/11/30 04:19:21 gwr Exp $ */
! 4:
! 5: /*-
! 6: * Copyright (c) 1993
! 7: * The Regents of the University of California. All rights reserved.
! 8: *
! 9: * Redistribution and use in source and binary forms, with or without
! 10: * modification, are permitted provided that the following conditions
! 11: * are met:
! 12: * 1. Redistributions of source code must retain the above copyright
! 13: * notice, this list of conditions and the following disclaimer.
! 14: * 2. Redistributions in binary form must reproduce the above copyright
! 15: * notice, this list of conditions and the following disclaimer in the
! 16: * documentation and/or other materials provided with the distribution.
! 17: * 3. Neither the name of the University nor the names of its contributors
! 18: * may be used to endorse or promote products derived from this software
! 19: * without specific prior written permission.
! 20: *
! 21: * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
! 22: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 23: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 24: * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
! 25: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 26: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 27: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 28: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 29: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 30: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 31: * SUCH DAMAGE.
! 32: *
! 33: * @(#)printf.c 8.1 (Berkeley) 6/11/93
! 34: */
! 35:
! 36: /*
! 37: * Scaled down version of printf(3).
! 38: *
! 39: * One additional format:
! 40: *
! 41: * The format %b is supported to decode error registers.
! 42: * Its usage is:
! 43: *
! 44: * printf("reg=%b\n", regval, "<base><arg>*");
! 45: *
! 46: * where <base> is the output base expressed as a control character, e.g.
! 47: * \10 gives octal; \20 gives hex. Each arg is a sequence of characters,
! 48: * the first of which gives the bit number to be inspected (origin 1), and
! 49: * the next characters (up to a control character, i.e. a character <= 32),
! 50: * give the name of the register. Thus:
! 51: *
! 52: * printf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n");
! 53: *
! 54: * would produce output:
! 55: *
! 56: * reg=3<BITTWO,BITONE>
! 57: */
! 58:
! 59: #include <sys/types.h>
! 60: #include <sys/stdarg.h>
! 61: #include <libkern/printf.h>
! 62:
! 63:
! 64: void kdoprnt(void (*)(char), const char *, va_list);
! 65: void kprintn(void (*put)(char), unsigned long ul, int base);
! 66:
! 67: const char hexdig[] = "0123456789abcdef";
! 68:
! 69: /*
! 70: * putchar function; usually gets xxx_early_putc at startup and then gets fcons_putc after fcons attachment.
! 71: */
! 72: void (*putchar)(char);
! 73:
! 74:
! 75: void
! 76: kpanic(const char *fmt, ...)
! 77: {
! 78: /*
! 79: * System panic. Just disables interrupts, kills sheduler, prints alarm message and spins off forever.
! 80: */
! 81: va_list ap;
! 82:
! 83: /* XXX disable intrs & sched */
! 84:
! 85: putchar('\n');
! 86: putchar('S');
! 87: putchar('Y');
! 88: putchar('S');
! 89: putchar('T');
! 90: putchar('E');
! 91: putchar('M');
! 92: putchar(' ');
! 93: putchar('P');
! 94: putchar('A');
! 95: putchar('N');
! 96: putchar('I');
! 97: putchar('C');
! 98: putchar(' ');
! 99: putchar(':');
! 100: putchar(' ');
! 101:
! 102: va_start(ap, fmt);
! 103: kdoprnt(putchar, fmt, ap);
! 104: va_end(ap);
! 105:
! 106: while(1)
! 107: ;
! 108: /* NOTREACHED */
! 109: }
! 110:
! 111:
! 112: void
! 113: printf(const char *fmt, ...)
! 114: {
! 115: va_list ap;
! 116:
! 117: va_start(ap, fmt);
! 118: kdoprnt(putchar, fmt, ap);
! 119: va_end(ap);
! 120: }
! 121:
! 122: void
! 123: kdoprnt(void (*put)(char), const char *fmt, va_list ap)
! 124: {
! 125: #ifdef LIBSA_LONGLONG_PRINTF
! 126: u_int64_t ull;
! 127: #endif
! 128: unsigned long ul;
! 129: int ch, lflag;
! 130: char *p;
! 131:
! 132: for (;;) {
! 133: while ((ch = *fmt++) != '%') {
! 134: if (ch == '\0')
! 135: return;
! 136: put(ch);
! 137: }
! 138: lflag = 0;
! 139: reswitch: switch (ch = *fmt++) {
! 140: case 'l':
! 141: lflag++;
! 142: goto reswitch;
! 143: #ifndef STRIPPED
! 144: case 'b':
! 145: {
! 146: int set, n;
! 147:
! 148: ul = va_arg(ap, int);
! 149: p = va_arg(ap, char *);
! 150: kprintn(put, ul, *p++);
! 151:
! 152: if (!ul)
! 153: break;
! 154:
! 155: for (set = 0; (n = *p++);) {
! 156: if (ul & (1 << (n - 1))) {
! 157: put(set ? ',' : '<');
! 158: for (; (n = *p) > ' '; ++p)
! 159: put(n);
! 160: set = 1;
! 161: } else
! 162: for (; *p > ' '; ++p)
! 163: ;
! 164: }
! 165: if (set)
! 166: put('>');
! 167: }
! 168: break;
! 169: #endif
! 170: case 'c':
! 171: ch = va_arg(ap, int);
! 172: put(ch & 0x7f);
! 173: break;
! 174: case 's':
! 175: p = va_arg(ap, char *);
! 176: while ((ch = *p++))
! 177: put(ch);
! 178: break;
! 179: case 'd':
! 180: #ifdef LIBSA_LONGLONG_PRINTF
! 181: if (lflag > 1) {
! 182: ull = va_arg(ap, int64_t);
! 183: if ((int64_t)ull < 0) {
! 184: put('-');
! 185: ull = -(int64_t)ull;
! 186: }
! 187: kprintn64(put, ull, 10);
! 188: break;
! 189: }
! 190: #endif
! 191: ul = lflag ?
! 192: va_arg(ap, long) : va_arg(ap, int);
! 193: if ((long)ul < 0) {
! 194: put('-');
! 195: ul = -(long)ul;
! 196: }
! 197: kprintn(put, ul, 10);
! 198: break;
! 199: case 'o':
! 200: #ifdef LIBSA_LONGLONG_PRINTF
! 201: if (lflag > 1) {
! 202: ull = va_arg(ap, u_int64_t);
! 203: kprintn64(put, ull, 8);
! 204: break;
! 205: }
! 206: #endif
! 207: ul = lflag ?
! 208: va_arg(ap, u_long) : va_arg(ap, u_int);
! 209: kprintn(put, ul, 8);
! 210: break;
! 211: case 'u':
! 212: #ifdef LIBSA_LONGLONG_PRINTF
! 213: if (lflag > 1) {
! 214: ull = va_arg(ap, u_int64_t);
! 215: kprintn64(put, ull, 10);
! 216: break;
! 217: }
! 218: #endif
! 219: ul = lflag ?
! 220: va_arg(ap, u_long) : va_arg(ap, u_int);
! 221: kprintn(put, ul, 10);
! 222: break;
! 223: case 'p':
! 224: put('0');
! 225: put('x');
! 226: lflag += sizeof(void *)==sizeof(u_long)? 1 : 0;
! 227: case 'x':
! 228: #ifdef LIBSA_LONGLONG_PRINTF
! 229: if (lflag > 1) {
! 230: ull = va_arg(ap, u_int64_t);
! 231: kprintn64(put, ull, 16);
! 232: break;
! 233: }
! 234: #else
! 235: if (lflag > 1) {
! 236: /* hold an int64_t in base 16 */
! 237: char *p, buf[(sizeof(u_int64_t) * 8 / 4) + 1];
! 238: u_int64_t ull;
! 239:
! 240: ull = va_arg(ap, u_int64_t);
! 241: p = buf;
! 242: do {
! 243: *p++ = hexdig[ull & 15];
! 244: } while (ull >>= 4);
! 245: do {
! 246: put(*--p);
! 247: } while (p > buf);
! 248: break;
! 249: }
! 250: #endif
! 251: ul = lflag ?
! 252: va_arg(ap, u_long) : va_arg(ap, u_int);
! 253: kprintn(put, ul, 16);
! 254: break;
! 255: default:
! 256: put('%');
! 257: #ifdef LIBSA_LONGLONG_PRINTF
! 258: while (--lflag)
! 259: #else
! 260: if (lflag)
! 261: #endif
! 262: put('l');
! 263: put(ch);
! 264: }
! 265: }
! 266: va_end(ap);
! 267: }
! 268:
! 269:
! 270: void
! 271: kprintn(void (*put)(char), unsigned long ul, int base)
! 272: {
! 273: /* hold a long in base 8 */
! 274: char *p, buf[(sizeof(long) * 8 / 3) + 1];
! 275:
! 276: p = buf;
! 277: do {
! 278: *p++ = hexdig[ul % base];
! 279: } while (ul /= base);
! 280: do {
! 281: put(*--p);
! 282: } while (p > buf);
! 283: }
! 284:
CVSweb