1df8bae1dSRodney W. Grimes /*- 2df8bae1dSRodney W. Grimes * Copyright (c) 1986, 1988, 1991, 1993 3df8bae1dSRodney W. Grimes * The Regents of the University of California. All rights reserved. 4df8bae1dSRodney W. Grimes * (c) UNIX System Laboratories, Inc. 5df8bae1dSRodney W. Grimes * All or some portions of this file are derived from material licensed 6df8bae1dSRodney W. Grimes * to the University of California by American Telephone and Telegraph 7df8bae1dSRodney W. Grimes * Co. or Unix System Laboratories, Inc. and are reproduced herein with 8df8bae1dSRodney W. Grimes * the permission of UNIX System Laboratories, Inc. 9df8bae1dSRodney W. Grimes * 10df8bae1dSRodney W. Grimes * Redistribution and use in source and binary forms, with or without 11df8bae1dSRodney W. Grimes * modification, are permitted provided that the following conditions 12df8bae1dSRodney W. Grimes * are met: 13df8bae1dSRodney W. Grimes * 1. Redistributions of source code must retain the above copyright 14df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer. 15df8bae1dSRodney W. Grimes * 2. Redistributions in binary form must reproduce the above copyright 16df8bae1dSRodney W. Grimes * notice, this list of conditions and the following disclaimer in the 17df8bae1dSRodney W. Grimes * documentation and/or other materials provided with the distribution. 18df8bae1dSRodney W. Grimes * 3. All advertising materials mentioning features or use of this software 19df8bae1dSRodney W. Grimes * must display the following acknowledgement: 20df8bae1dSRodney W. Grimes * This product includes software developed by the University of 21df8bae1dSRodney W. Grimes * California, Berkeley and its contributors. 22df8bae1dSRodney W. Grimes * 4. Neither the name of the University nor the names of its contributors 23df8bae1dSRodney W. Grimes * may be used to endorse or promote products derived from this software 24df8bae1dSRodney W. Grimes * without specific prior written permission. 25df8bae1dSRodney W. Grimes * 26df8bae1dSRodney W. Grimes * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 27df8bae1dSRodney W. Grimes * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 28df8bae1dSRodney W. Grimes * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 29df8bae1dSRodney W. Grimes * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 30df8bae1dSRodney W. Grimes * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 31df8bae1dSRodney W. Grimes * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 32df8bae1dSRodney W. Grimes * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 33df8bae1dSRodney W. Grimes * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 34df8bae1dSRodney W. Grimes * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 35df8bae1dSRodney W. Grimes * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 36df8bae1dSRodney W. Grimes * SUCH DAMAGE. 37df8bae1dSRodney W. Grimes * 38df8bae1dSRodney W. Grimes * @(#)subr_prf.c 8.3 (Berkeley) 1/21/94 39c3aac50fSPeter Wemm * $FreeBSD$ 40df8bae1dSRodney W. Grimes */ 41df8bae1dSRodney W. Grimes 42df8bae1dSRodney W. Grimes #include <sys/param.h> 43df8bae1dSRodney W. Grimes #include <sys/systm.h> 44e796e00dSPoul-Henning Kamp #include <sys/kernel.h> 45df8bae1dSRodney W. Grimes #include <sys/msgbuf.h> 46a1c995b6SPoul-Henning Kamp #include <sys/malloc.h> 47df8bae1dSRodney W. Grimes #include <sys/proc.h> 48df8bae1dSRodney W. Grimes #include <sys/tty.h> 49df8bae1dSRodney W. Grimes #include <sys/syslog.h> 50ce9edcf5SPoul-Henning Kamp #include <sys/cons.h> 51e2a09b26SPoul-Henning Kamp #include <sys/uio.h> 52948d3d94SThomas Moestl #include <sys/sysctl.h> 53df8bae1dSRodney W. Grimes 54df8bae1dSRodney W. Grimes /* 55df8bae1dSRodney W. Grimes * Note that stdarg.h and the ANSI style va_start macro is used for both 56df8bae1dSRodney W. Grimes * ANSI and traditional C compilers. 57df8bae1dSRodney W. Grimes */ 58df8bae1dSRodney W. Grimes #include <machine/stdarg.h> 59df8bae1dSRodney W. Grimes 60df8bae1dSRodney W. Grimes #define TOCONS 0x01 61df8bae1dSRodney W. Grimes #define TOTTY 0x02 62df8bae1dSRodney W. Grimes #define TOLOG 0x04 63df8bae1dSRodney W. Grimes 6482941964SPeter Wemm /* Max number conversion buffer length: a u_quad_t in base 2, plus NUL byte. */ 6582941964SPeter Wemm #define MAXNBUF (sizeof(quad_t) * NBBY + 1) 66df8bae1dSRodney W. Grimes 678245f3f5SArchie Cobbs struct putchar_arg { 688245f3f5SArchie Cobbs int flags; 69e2a09b26SPoul-Henning Kamp int pri; 708245f3f5SArchie Cobbs struct tty *tty; 718245f3f5SArchie Cobbs }; 728245f3f5SArchie Cobbs 738245f3f5SArchie Cobbs struct snprintf_arg { 748245f3f5SArchie Cobbs char *str; 758245f3f5SArchie Cobbs size_t remain; 768245f3f5SArchie Cobbs }; 778245f3f5SArchie Cobbs 78e2a09b26SPoul-Henning Kamp extern int log_open; 79e2a09b26SPoul-Henning Kamp 8005292ba2SArchie Cobbs struct tty *constty; /* pointer to console "window" tty */ 8105292ba2SArchie Cobbs 8287b6de2bSPoul-Henning Kamp static void (*v_putc)(int) = cnputc; /* routine to putc on virtual console */ 83e2a09b26SPoul-Henning Kamp static void msglogchar(int c, int pri); 84e2a09b26SPoul-Henning Kamp static void msgaddchar(int c, void *dummy); 85791d77e0SPoul-Henning Kamp static void putchar __P((int ch, void *arg)); 86ad4f8dbdSArchie Cobbs static char *ksprintn __P((char *nbuf, u_long num, int base, int *len)); 877d921a01SPeter Wemm static char *ksprintqn __P((char *nbuf, u_quad_t num, int base, int *len)); 888245f3f5SArchie Cobbs static void snprintf_func __P((int ch, void *arg)); 89df8bae1dSRodney W. Grimes 9087b6de2bSPoul-Henning Kamp static int consintr = 1; /* Ok to handle console interrupts? */ 91e796e00dSPoul-Henning Kamp static int msgbufmapped; /* Set when safe to use msgbuf */ 92e2a09b26SPoul-Henning Kamp int msgbuftrigger; 93df8bae1dSRodney W. Grimes 94df8bae1dSRodney W. Grimes /* 95df8bae1dSRodney W. Grimes * Warn that a system table is full. 96df8bae1dSRodney W. Grimes */ 97df8bae1dSRodney W. Grimes void 98e2a09b26SPoul-Henning Kamp tablefull(const char *tab) 99df8bae1dSRodney W. Grimes { 100df8bae1dSRodney W. Grimes 101df8bae1dSRodney W. Grimes log(LOG_ERR, "%s: table is full\n", tab); 102df8bae1dSRodney W. Grimes } 103df8bae1dSRodney W. Grimes 104df8bae1dSRodney W. Grimes /* 105df8bae1dSRodney W. Grimes * Uprintf prints to the controlling terminal for the current process. 106df8bae1dSRodney W. Grimes * It may block if the tty queue is overfull. No message is printed if 107df8bae1dSRodney W. Grimes * the queue does not clear in a reasonable time. 108df8bae1dSRodney W. Grimes */ 109f1550d9dSDoug Rabson int 110df8bae1dSRodney W. Grimes uprintf(const char *fmt, ...) 111df8bae1dSRodney W. Grimes { 112b40ce416SJulian Elischer struct thread *td = curthread; 113b40ce416SJulian Elischer struct proc *p = td->td_proc; 114df8bae1dSRodney W. Grimes va_list ap; 115791d77e0SPoul-Henning Kamp struct putchar_arg pca; 116f1550d9dSDoug Rabson int retval = 0; 117df8bae1dSRodney W. Grimes 118b40ce416SJulian Elischer if (td && td != PCPU_GET(idlethread) && p->p_flag & P_CONTROLT && 1190384fff8SJason Evans p->p_session->s_ttyvp) { 120df8bae1dSRodney W. Grimes va_start(ap, fmt); 121791d77e0SPoul-Henning Kamp pca.tty = p->p_session->s_ttyp; 122791d77e0SPoul-Henning Kamp pca.flags = TOTTY; 123f1550d9dSDoug Rabson retval = kvprintf(fmt, putchar, &pca, 10, ap); 124df8bae1dSRodney W. Grimes va_end(ap); 125df8bae1dSRodney W. Grimes } 126f1550d9dSDoug Rabson return retval; 127df8bae1dSRodney W. Grimes } 128df8bae1dSRodney W. Grimes 129df8bae1dSRodney W. Grimes /* 130df8bae1dSRodney W. Grimes * tprintf prints on the controlling terminal associated 131a52585d7SPoul-Henning Kamp * with the given session, possibly to the log as well. 132df8bae1dSRodney W. Grimes */ 133a52585d7SPoul-Henning Kamp void 134a52585d7SPoul-Henning Kamp tprintf(struct proc *p, int pri, const char *fmt, ...) 135df8bae1dSRodney W. Grimes { 136df8bae1dSRodney W. Grimes struct tty *tp = NULL; 137a52585d7SPoul-Henning Kamp int flags = 0, shld = 0; 138df8bae1dSRodney W. Grimes va_list ap; 139791d77e0SPoul-Henning Kamp struct putchar_arg pca; 140f1550d9dSDoug Rabson int retval; 141df8bae1dSRodney W. Grimes 142e2a09b26SPoul-Henning Kamp if (pri != -1) 143a52585d7SPoul-Henning Kamp flags |= TOLOG; 144661f2768SMatt Jacob if (p && p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) { 145a52585d7SPoul-Henning Kamp SESSHOLD(p->p_session); 146a52585d7SPoul-Henning Kamp shld++; 147a52585d7SPoul-Henning Kamp if (ttycheckoutq(p->p_session->s_ttyp, 0)) { 148a52585d7SPoul-Henning Kamp flags |= TOTTY; 149a52585d7SPoul-Henning Kamp tp = p->p_session->s_ttyp; 150a52585d7SPoul-Henning Kamp } 151a52585d7SPoul-Henning Kamp } 152e2a09b26SPoul-Henning Kamp pca.pri = pri; 153791d77e0SPoul-Henning Kamp pca.tty = tp; 154791d77e0SPoul-Henning Kamp pca.flags = flags; 155a52585d7SPoul-Henning Kamp va_start(ap, fmt); 156f1550d9dSDoug Rabson retval = kvprintf(fmt, putchar, &pca, 10, ap); 157df8bae1dSRodney W. Grimes va_end(ap); 158a52585d7SPoul-Henning Kamp if (shld) 159a52585d7SPoul-Henning Kamp SESSRELE(p->p_session); 160e2a09b26SPoul-Henning Kamp msgbuftrigger = 1; 161df8bae1dSRodney W. Grimes } 162df8bae1dSRodney W. Grimes 163df8bae1dSRodney W. Grimes /* 164df8bae1dSRodney W. Grimes * Ttyprintf displays a message on a tty; it should be used only by 165df8bae1dSRodney W. Grimes * the tty driver, or anything that knows the underlying tty will not 166df8bae1dSRodney W. Grimes * be revoke(2)'d away. Other callers should use tprintf. 167df8bae1dSRodney W. Grimes */ 168f1550d9dSDoug Rabson int 169df8bae1dSRodney W. Grimes ttyprintf(struct tty *tp, const char *fmt, ...) 170df8bae1dSRodney W. Grimes { 171df8bae1dSRodney W. Grimes va_list ap; 172791d77e0SPoul-Henning Kamp struct putchar_arg pca; 173f1550d9dSDoug Rabson int retval; 174f1550d9dSDoug Rabson 175df8bae1dSRodney W. Grimes va_start(ap, fmt); 176791d77e0SPoul-Henning Kamp pca.tty = tp; 177791d77e0SPoul-Henning Kamp pca.flags = TOTTY; 178f1550d9dSDoug Rabson retval = kvprintf(fmt, putchar, &pca, 10, ap); 179df8bae1dSRodney W. Grimes va_end(ap); 180f1550d9dSDoug Rabson return retval; 181df8bae1dSRodney W. Grimes } 182df8bae1dSRodney W. Grimes 183df8bae1dSRodney W. Grimes /* 184df8bae1dSRodney W. Grimes * Log writes to the log buffer, and guarantees not to sleep (so can be 185df8bae1dSRodney W. Grimes * called by interrupt routines). If there is no process reading the 186df8bae1dSRodney W. Grimes * log yet, it writes to the console also. 187df8bae1dSRodney W. Grimes */ 1884d88c459SPoul-Henning Kamp void 189df8bae1dSRodney W. Grimes log(int level, const char *fmt, ...) 190df8bae1dSRodney W. Grimes { 191df8bae1dSRodney W. Grimes va_list ap; 192f1550d9dSDoug Rabson int retval; 193791d77e0SPoul-Henning Kamp struct putchar_arg pca; 194e2a09b26SPoul-Henning Kamp 195791d77e0SPoul-Henning Kamp pca.tty = NULL; 196e2a09b26SPoul-Henning Kamp pca.pri = level; 197e2a09b26SPoul-Henning Kamp pca.flags = log_open ? TOLOG : TOCONS; 198e2a09b26SPoul-Henning Kamp 199e2a09b26SPoul-Henning Kamp va_start(ap, fmt); 200e2a09b26SPoul-Henning Kamp retval = kvprintf(fmt, putchar, &pca, 10, ap); 201df8bae1dSRodney W. Grimes va_end(ap); 202e2a09b26SPoul-Henning Kamp 203b80e3b41SPoul-Henning Kamp msgbuftrigger = 1; 204df8bae1dSRodney W. Grimes } 205df8bae1dSRodney W. Grimes 206e2a09b26SPoul-Henning Kamp #define CONSCHUNK 128 207e2a09b26SPoul-Henning Kamp 208e2a09b26SPoul-Henning Kamp void 209e2a09b26SPoul-Henning Kamp log_console(struct uio *uio) 210df8bae1dSRodney W. Grimes { 211e2a09b26SPoul-Henning Kamp int c, i, error, iovlen, nl; 212e2a09b26SPoul-Henning Kamp struct uio muio; 213e2a09b26SPoul-Henning Kamp struct iovec *miov = NULL; 214e2a09b26SPoul-Henning Kamp char *consbuffer; 215e2a09b26SPoul-Henning Kamp int pri; 216df8bae1dSRodney W. Grimes 217e2a09b26SPoul-Henning Kamp pri = LOG_INFO | LOG_CONSOLE; 218e2a09b26SPoul-Henning Kamp muio = *uio; 219e2a09b26SPoul-Henning Kamp iovlen = uio->uio_iovcnt * sizeof (struct iovec); 220e2a09b26SPoul-Henning Kamp MALLOC(miov, struct iovec *, iovlen, M_TEMP, M_WAITOK); 221e2a09b26SPoul-Henning Kamp MALLOC(consbuffer, char *, CONSCHUNK, M_TEMP, M_WAITOK); 222e2a09b26SPoul-Henning Kamp bcopy((caddr_t)muio.uio_iov, (caddr_t)miov, iovlen); 223e2a09b26SPoul-Henning Kamp muio.uio_iov = miov; 224e2a09b26SPoul-Henning Kamp uio = &muio; 225e2a09b26SPoul-Henning Kamp 226e2a09b26SPoul-Henning Kamp nl = 0; 227e2a09b26SPoul-Henning Kamp while (uio->uio_resid > 0) { 228e2a09b26SPoul-Henning Kamp c = imin(uio->uio_resid, CONSCHUNK); 229e2a09b26SPoul-Henning Kamp error = uiomove(consbuffer, c, uio); 230e2a09b26SPoul-Henning Kamp if (error != 0) 231e2a09b26SPoul-Henning Kamp return; 232e2a09b26SPoul-Henning Kamp for (i = 0; i < c; i++) { 233e2a09b26SPoul-Henning Kamp msglogchar(consbuffer[i], pri); 234e2a09b26SPoul-Henning Kamp if (consbuffer[i] == '\n') 235e2a09b26SPoul-Henning Kamp nl = 1; 236e2a09b26SPoul-Henning Kamp else 237e2a09b26SPoul-Henning Kamp nl = 0; 238e2a09b26SPoul-Henning Kamp } 239e2a09b26SPoul-Henning Kamp } 240e2a09b26SPoul-Henning Kamp if (!nl) 241e2a09b26SPoul-Henning Kamp msglogchar('\n', pri); 242b80e3b41SPoul-Henning Kamp msgbuftrigger = 1; 243e2a09b26SPoul-Henning Kamp FREE(miov, M_TEMP); 244e2a09b26SPoul-Henning Kamp FREE(consbuffer, M_TEMP); 245e2a09b26SPoul-Henning Kamp return; 246df8bae1dSRodney W. Grimes } 247df8bae1dSRodney W. Grimes 2486ddbf1e2SGary Palmer int 249df8bae1dSRodney W. Grimes printf(const char *fmt, ...) 250df8bae1dSRodney W. Grimes { 251df8bae1dSRodney W. Grimes va_list ap; 2524d88c459SPoul-Henning Kamp int savintr; 253791d77e0SPoul-Henning Kamp struct putchar_arg pca; 25465ed8cbdSJustin T. Gibbs int retval; 255df8bae1dSRodney W. Grimes 256df8bae1dSRodney W. Grimes savintr = consintr; /* disable interrupts */ 257df8bae1dSRodney W. Grimes consintr = 0; 258df8bae1dSRodney W. Grimes va_start(ap, fmt); 259791d77e0SPoul-Henning Kamp pca.tty = NULL; 260791d77e0SPoul-Henning Kamp pca.flags = TOCONS | TOLOG; 261e2a09b26SPoul-Henning Kamp pca.pri = -1; 26265ed8cbdSJustin T. Gibbs retval = kvprintf(fmt, putchar, &pca, 10, ap); 263df8bae1dSRodney W. Grimes va_end(ap); 264df8bae1dSRodney W. Grimes if (!panicstr) 265b80e3b41SPoul-Henning Kamp msgbuftrigger = 1; 266df8bae1dSRodney W. Grimes consintr = savintr; /* reenable interrupts */ 26765ed8cbdSJustin T. Gibbs return retval; 268df8bae1dSRodney W. Grimes } 269df8bae1dSRodney W. Grimes 270f1550d9dSDoug Rabson int 271791d77e0SPoul-Henning Kamp vprintf(const char *fmt, va_list ap) 272791d77e0SPoul-Henning Kamp { 2734d88c459SPoul-Henning Kamp int savintr; 274791d77e0SPoul-Henning Kamp struct putchar_arg pca; 275f1550d9dSDoug Rabson int retval; 276791d77e0SPoul-Henning Kamp 277791d77e0SPoul-Henning Kamp savintr = consintr; /* disable interrupts */ 278791d77e0SPoul-Henning Kamp consintr = 0; 279791d77e0SPoul-Henning Kamp pca.tty = NULL; 280791d77e0SPoul-Henning Kamp pca.flags = TOCONS | TOLOG; 281e2a09b26SPoul-Henning Kamp pca.pri = -1; 282f1550d9dSDoug Rabson retval = kvprintf(fmt, putchar, &pca, 10, ap); 283791d77e0SPoul-Henning Kamp if (!panicstr) 284b80e3b41SPoul-Henning Kamp msgbuftrigger = 1; 285791d77e0SPoul-Henning Kamp consintr = savintr; /* reenable interrupts */ 286f1550d9dSDoug Rabson return retval; 287791d77e0SPoul-Henning Kamp } 288791d77e0SPoul-Henning Kamp 289791d77e0SPoul-Henning Kamp /* 290791d77e0SPoul-Henning Kamp * Print a character on console or users terminal. If destination is 291e796e00dSPoul-Henning Kamp * the console then the last bunch of characters are saved in msgbuf for 292791d77e0SPoul-Henning Kamp * inspection later. 293791d77e0SPoul-Henning Kamp */ 294791d77e0SPoul-Henning Kamp static void 295791d77e0SPoul-Henning Kamp putchar(int c, void *arg) 296791d77e0SPoul-Henning Kamp { 297791d77e0SPoul-Henning Kamp struct putchar_arg *ap = (struct putchar_arg*) arg; 298791d77e0SPoul-Henning Kamp int flags = ap->flags; 299791d77e0SPoul-Henning Kamp struct tty *tp = ap->tty; 300791d77e0SPoul-Henning Kamp if (panicstr) 301791d77e0SPoul-Henning Kamp constty = NULL; 302791d77e0SPoul-Henning Kamp if ((flags & TOCONS) && tp == NULL && constty) { 303791d77e0SPoul-Henning Kamp tp = constty; 304791d77e0SPoul-Henning Kamp flags |= TOTTY; 305791d77e0SPoul-Henning Kamp } 306791d77e0SPoul-Henning Kamp if ((flags & TOTTY) && tp && tputchar(c, tp) < 0 && 307791d77e0SPoul-Henning Kamp (flags & TOCONS) && tp == constty) 308791d77e0SPoul-Henning Kamp constty = NULL; 309791d77e0SPoul-Henning Kamp if ((flags & TOLOG)) 310e2a09b26SPoul-Henning Kamp msglogchar(c, ap->pri); 311791d77e0SPoul-Henning Kamp if ((flags & TOCONS) && constty == NULL && c != '\0') 312791d77e0SPoul-Henning Kamp (*v_putc)(c); 313791d77e0SPoul-Henning Kamp } 314791d77e0SPoul-Henning Kamp 315791d77e0SPoul-Henning Kamp /* 316791d77e0SPoul-Henning Kamp * Scaled down version of sprintf(3). 317791d77e0SPoul-Henning Kamp */ 318791d77e0SPoul-Henning Kamp int 319791d77e0SPoul-Henning Kamp sprintf(char *buf, const char *cfmt, ...) 320791d77e0SPoul-Henning Kamp { 321791d77e0SPoul-Henning Kamp int retval; 322791d77e0SPoul-Henning Kamp va_list ap; 323791d77e0SPoul-Henning Kamp 324791d77e0SPoul-Henning Kamp va_start(ap, cfmt); 325791d77e0SPoul-Henning Kamp retval = kvprintf(cfmt, NULL, (void *)buf, 10, ap); 326fe96d47dSPoul-Henning Kamp buf[retval] = '\0'; 327791d77e0SPoul-Henning Kamp va_end(ap); 328791d77e0SPoul-Henning Kamp return retval; 329791d77e0SPoul-Henning Kamp } 330791d77e0SPoul-Henning Kamp 331791d77e0SPoul-Henning Kamp /* 33299237364SAndrey A. Chernov * Scaled down version of vsprintf(3). 33399237364SAndrey A. Chernov */ 33499237364SAndrey A. Chernov int 33599237364SAndrey A. Chernov vsprintf(char *buf, const char *cfmt, va_list ap) 33699237364SAndrey A. Chernov { 33799237364SAndrey A. Chernov int retval; 33899237364SAndrey A. Chernov 33999237364SAndrey A. Chernov retval = kvprintf(cfmt, NULL, (void *)buf, 10, ap); 34099237364SAndrey A. Chernov buf[retval] = '\0'; 34199237364SAndrey A. Chernov return retval; 34299237364SAndrey A. Chernov } 34399237364SAndrey A. Chernov 34499237364SAndrey A. Chernov /* 3458245f3f5SArchie Cobbs * Scaled down version of snprintf(3). 3468245f3f5SArchie Cobbs */ 3478245f3f5SArchie Cobbs int 3488245f3f5SArchie Cobbs snprintf(char *str, size_t size, const char *format, ...) 3498245f3f5SArchie Cobbs { 3508245f3f5SArchie Cobbs int retval; 3518245f3f5SArchie Cobbs va_list ap; 3528245f3f5SArchie Cobbs 3538245f3f5SArchie Cobbs va_start(ap, format); 3548245f3f5SArchie Cobbs retval = vsnprintf(str, size, format, ap); 3558245f3f5SArchie Cobbs va_end(ap); 3568245f3f5SArchie Cobbs return(retval); 3578245f3f5SArchie Cobbs } 3588245f3f5SArchie Cobbs 3598245f3f5SArchie Cobbs /* 3608245f3f5SArchie Cobbs * Scaled down version of vsnprintf(3). 3618245f3f5SArchie Cobbs */ 3628245f3f5SArchie Cobbs int 3638245f3f5SArchie Cobbs vsnprintf(char *str, size_t size, const char *format, va_list ap) 3648245f3f5SArchie Cobbs { 3658245f3f5SArchie Cobbs struct snprintf_arg info; 3668245f3f5SArchie Cobbs int retval; 3678245f3f5SArchie Cobbs 3688245f3f5SArchie Cobbs info.str = str; 3698245f3f5SArchie Cobbs info.remain = size; 3708245f3f5SArchie Cobbs retval = kvprintf(format, snprintf_func, &info, 10, ap); 3718245f3f5SArchie Cobbs if (info.remain >= 1) 3728245f3f5SArchie Cobbs *info.str++ = '\0'; 3738245f3f5SArchie Cobbs return retval; 3748245f3f5SArchie Cobbs } 3758245f3f5SArchie Cobbs 3768245f3f5SArchie Cobbs static void 3778245f3f5SArchie Cobbs snprintf_func(int ch, void *arg) 3788245f3f5SArchie Cobbs { 3798245f3f5SArchie Cobbs struct snprintf_arg *const info = arg; 3808245f3f5SArchie Cobbs 3818245f3f5SArchie Cobbs if (info->remain >= 2) { 3828245f3f5SArchie Cobbs *info->str++ = ch; 3838245f3f5SArchie Cobbs info->remain--; 3848245f3f5SArchie Cobbs } 3858245f3f5SArchie Cobbs } 3868245f3f5SArchie Cobbs 3878245f3f5SArchie Cobbs /* 38882941964SPeter Wemm * Put a NUL-terminated ASCII number (base <= 36) in a buffer in reverse 38905292ba2SArchie Cobbs * order; return an optional length and a pointer to the last character 39005292ba2SArchie Cobbs * written in the buffer (i.e., the first character of the string). 39105292ba2SArchie Cobbs * The buffer pointed to by `nbuf' must have length >= MAXNBUF. 392791d77e0SPoul-Henning Kamp */ 393791d77e0SPoul-Henning Kamp static char * 39405292ba2SArchie Cobbs ksprintn(nbuf, ul, base, lenp) 39505292ba2SArchie Cobbs char *nbuf; 3964d88c459SPoul-Henning Kamp u_long ul; 3974d88c459SPoul-Henning Kamp int base, *lenp; 39805292ba2SArchie Cobbs { 3994d88c459SPoul-Henning Kamp char *p; 400791d77e0SPoul-Henning Kamp 40105292ba2SArchie Cobbs p = nbuf; 402ad4f8dbdSArchie Cobbs *p = '\0'; 403791d77e0SPoul-Henning Kamp do { 404791d77e0SPoul-Henning Kamp *++p = hex2ascii(ul % base); 405791d77e0SPoul-Henning Kamp } while (ul /= base); 406791d77e0SPoul-Henning Kamp if (lenp) 40705292ba2SArchie Cobbs *lenp = p - nbuf; 408791d77e0SPoul-Henning Kamp return (p); 409791d77e0SPoul-Henning Kamp } 41082941964SPeter Wemm /* ksprintn, but for a quad_t. */ 4117d921a01SPeter Wemm static char * 4127d921a01SPeter Wemm ksprintqn(nbuf, uq, base, lenp) 4137d921a01SPeter Wemm char *nbuf; 4144d88c459SPoul-Henning Kamp u_quad_t uq; 4154d88c459SPoul-Henning Kamp int base, *lenp; 4167d921a01SPeter Wemm { 4174d88c459SPoul-Henning Kamp char *p; 4187d921a01SPeter Wemm 4197d921a01SPeter Wemm p = nbuf; 4207d921a01SPeter Wemm *p = '\0'; 4217d921a01SPeter Wemm do { 4227d921a01SPeter Wemm *++p = hex2ascii(uq % base); 4237d921a01SPeter Wemm } while (uq /= base); 4247d921a01SPeter Wemm if (lenp) 4257d921a01SPeter Wemm *lenp = p - nbuf; 4267d921a01SPeter Wemm return (p); 4277d921a01SPeter Wemm } 428791d77e0SPoul-Henning Kamp 429df8bae1dSRodney W. Grimes /* 430df8bae1dSRodney W. Grimes * Scaled down version of printf(3). 431df8bae1dSRodney W. Grimes * 432df8bae1dSRodney W. Grimes * Two additional formats: 433df8bae1dSRodney W. Grimes * 434df8bae1dSRodney W. Grimes * The format %b is supported to decode error registers. 435df8bae1dSRodney W. Grimes * Its usage is: 436df8bae1dSRodney W. Grimes * 437df8bae1dSRodney W. Grimes * printf("reg=%b\n", regval, "<base><arg>*"); 438df8bae1dSRodney W. Grimes * 439df8bae1dSRodney W. Grimes * where <base> is the output base expressed as a control character, e.g. 440df8bae1dSRodney W. Grimes * \10 gives octal; \20 gives hex. Each arg is a sequence of characters, 441df8bae1dSRodney W. Grimes * the first of which gives the bit number to be inspected (origin 1), and 442df8bae1dSRodney W. Grimes * the next characters (up to a control character, i.e. a character <= 32), 443df8bae1dSRodney W. Grimes * give the name of the register. Thus: 444df8bae1dSRodney W. Grimes * 4454e31a37bSGary Palmer * kvprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE\n"); 446df8bae1dSRodney W. Grimes * 447df8bae1dSRodney W. Grimes * would produce output: 448df8bae1dSRodney W. Grimes * 449df8bae1dSRodney W. Grimes * reg=3<BITTWO,BITONE> 450df8bae1dSRodney W. Grimes * 451120f0783SPoul-Henning Kamp * XXX: %D -- Hexdump, takes pointer and separator string: 452120f0783SPoul-Henning Kamp * ("%6D", ptr, ":") -> XX:XX:XX:XX:XX:XX 453120f0783SPoul-Henning Kamp * ("%*D", len, ptr, " " -> XX XX XX XX ... 454df8bae1dSRodney W. Grimes */ 455791d77e0SPoul-Henning Kamp int 456791d77e0SPoul-Henning Kamp kvprintf(char const *fmt, void (*func)(int, void*), void *arg, int radix, va_list ap) 457df8bae1dSRodney W. Grimes { 458791d77e0SPoul-Henning Kamp #define PCHAR(c) {int cc=(c); if (func) (*func)(cc,arg); else *d++ = cc; retval++; } 459ad4f8dbdSArchie Cobbs char nbuf[MAXNBUF]; 460791d77e0SPoul-Henning Kamp char *p, *q, *d; 461120f0783SPoul-Henning Kamp u_char *up; 462791d77e0SPoul-Henning Kamp int ch, n; 463df8bae1dSRodney W. Grimes u_long ul; 4647d921a01SPeter Wemm u_quad_t uq; 4657d921a01SPeter Wemm int base, lflag, qflag, tmp, width, ladjust, sharpflag, neg, sign, dot; 4664f20e4b1SPoul-Henning Kamp int dwidth; 467df8bae1dSRodney W. Grimes char padc; 468791d77e0SPoul-Henning Kamp int retval = 0; 469791d77e0SPoul-Henning Kamp 4707d921a01SPeter Wemm ul = 0; 4717d921a01SPeter Wemm uq = 0; 472fe96d47dSPoul-Henning Kamp if (!func) 473791d77e0SPoul-Henning Kamp d = (char *) arg; 474791d77e0SPoul-Henning Kamp else 475fe96d47dSPoul-Henning Kamp d = NULL; 4768f5067baSDavid Greenman 4778f5067baSDavid Greenman if (fmt == NULL) 4782336b9d7SBruce Evans fmt = "(fmt null)\n"; 479b4b2f81eSPoul-Henning Kamp 480120f0783SPoul-Henning Kamp if (radix < 2 || radix > 36) 481b4b2f81eSPoul-Henning Kamp radix = 10; 482b4b2f81eSPoul-Henning Kamp 483df8bae1dSRodney W. Grimes for (;;) { 484df8bae1dSRodney W. Grimes padc = ' '; 485df8bae1dSRodney W. Grimes width = 0; 486e0c95ed9SBruce Evans while ((ch = (u_char)*fmt++) != '%') { 487df8bae1dSRodney W. Grimes if (ch == '\0') 488791d77e0SPoul-Henning Kamp return retval; 489791d77e0SPoul-Henning Kamp PCHAR(ch); 490df8bae1dSRodney W. Grimes } 4917d921a01SPeter Wemm qflag = 0; lflag = 0; ladjust = 0; sharpflag = 0; neg = 0; 4924f20e4b1SPoul-Henning Kamp sign = 0; dot = 0; dwidth = 0; 493e0c95ed9SBruce Evans reswitch: switch (ch = (u_char)*fmt++) { 4944830092aSPoul-Henning Kamp case '.': 4954830092aSPoul-Henning Kamp dot = 1; 4964830092aSPoul-Henning Kamp goto reswitch; 497791d77e0SPoul-Henning Kamp case '#': 498791d77e0SPoul-Henning Kamp sharpflag = 1; 499791d77e0SPoul-Henning Kamp goto reswitch; 500791d77e0SPoul-Henning Kamp case '+': 501791d77e0SPoul-Henning Kamp sign = 1; 502791d77e0SPoul-Henning Kamp goto reswitch; 503791d77e0SPoul-Henning Kamp case '-': 504791d77e0SPoul-Henning Kamp ladjust = 1; 505791d77e0SPoul-Henning Kamp goto reswitch; 506791d77e0SPoul-Henning Kamp case '%': 507791d77e0SPoul-Henning Kamp PCHAR(ch); 508791d77e0SPoul-Henning Kamp break; 509791d77e0SPoul-Henning Kamp case '*': 510ed71c342SPoul-Henning Kamp if (!dot) { 511791d77e0SPoul-Henning Kamp width = va_arg(ap, int); 512791d77e0SPoul-Henning Kamp if (width < 0) { 513791d77e0SPoul-Henning Kamp ladjust = !ladjust; 514791d77e0SPoul-Henning Kamp width = -width; 515791d77e0SPoul-Henning Kamp } 516ed71c342SPoul-Henning Kamp } else { 517ed71c342SPoul-Henning Kamp dwidth = va_arg(ap, int); 518ed71c342SPoul-Henning Kamp } 519791d77e0SPoul-Henning Kamp goto reswitch; 520df8bae1dSRodney W. Grimes case '0': 5214f20e4b1SPoul-Henning Kamp if (!dot) { 522df8bae1dSRodney W. Grimes padc = '0'; 523df8bae1dSRodney W. Grimes goto reswitch; 5244f20e4b1SPoul-Henning Kamp } 525df8bae1dSRodney W. Grimes case '1': case '2': case '3': case '4': 526df8bae1dSRodney W. Grimes case '5': case '6': case '7': case '8': case '9': 5274f20e4b1SPoul-Henning Kamp for (n = 0;; ++fmt) { 5284f20e4b1SPoul-Henning Kamp n = n * 10 + ch - '0'; 529df8bae1dSRodney W. Grimes ch = *fmt; 530df8bae1dSRodney W. Grimes if (ch < '0' || ch > '9') 531df8bae1dSRodney W. Grimes break; 532df8bae1dSRodney W. Grimes } 5334f20e4b1SPoul-Henning Kamp if (dot) 5344f20e4b1SPoul-Henning Kamp dwidth = n; 5354f20e4b1SPoul-Henning Kamp else 5364f20e4b1SPoul-Henning Kamp width = n; 537df8bae1dSRodney W. Grimes goto reswitch; 538df8bae1dSRodney W. Grimes case 'b': 539df8bae1dSRodney W. Grimes ul = va_arg(ap, int); 540df8bae1dSRodney W. Grimes p = va_arg(ap, char *); 541ad4f8dbdSArchie Cobbs for (q = ksprintn(nbuf, ul, *p++, NULL); *q;) 542791d77e0SPoul-Henning Kamp PCHAR(*q--); 543df8bae1dSRodney W. Grimes 544df8bae1dSRodney W. Grimes if (!ul) 545df8bae1dSRodney W. Grimes break; 546df8bae1dSRodney W. Grimes 547797f2d22SPoul-Henning Kamp for (tmp = 0; *p;) { 548797f2d22SPoul-Henning Kamp n = *p++; 549df8bae1dSRodney W. Grimes if (ul & (1 << (n - 1))) { 550791d77e0SPoul-Henning Kamp PCHAR(tmp ? ',' : '<'); 551df8bae1dSRodney W. Grimes for (; (n = *p) > ' '; ++p) 552791d77e0SPoul-Henning Kamp PCHAR(n); 553df8bae1dSRodney W. Grimes tmp = 1; 554df8bae1dSRodney W. Grimes } else 555df8bae1dSRodney W. Grimes for (; *p > ' '; ++p) 556df8bae1dSRodney W. Grimes continue; 557df8bae1dSRodney W. Grimes } 558df8bae1dSRodney W. Grimes if (tmp) 559791d77e0SPoul-Henning Kamp PCHAR('>'); 560df8bae1dSRodney W. Grimes break; 561df8bae1dSRodney W. Grimes case 'c': 562791d77e0SPoul-Henning Kamp PCHAR(va_arg(ap, int)); 563df8bae1dSRodney W. Grimes break; 564120f0783SPoul-Henning Kamp case 'D': 565120f0783SPoul-Henning Kamp up = va_arg(ap, u_char *); 566120f0783SPoul-Henning Kamp p = va_arg(ap, char *); 567120f0783SPoul-Henning Kamp if (!width) 568120f0783SPoul-Henning Kamp width = 16; 569120f0783SPoul-Henning Kamp while(width--) { 570120f0783SPoul-Henning Kamp PCHAR(hex2ascii(*up >> 4)); 571120f0783SPoul-Henning Kamp PCHAR(hex2ascii(*up & 0x0f)); 572120f0783SPoul-Henning Kamp up++; 573120f0783SPoul-Henning Kamp if (width) 574120f0783SPoul-Henning Kamp for (q=p;*q;q++) 575120f0783SPoul-Henning Kamp PCHAR(*q); 576120f0783SPoul-Henning Kamp } 577120f0783SPoul-Henning Kamp break; 578df8bae1dSRodney W. Grimes case 'd': 5797d921a01SPeter Wemm if (qflag) 5807d921a01SPeter Wemm uq = va_arg(ap, quad_t); 5817d921a01SPeter Wemm else if (lflag) 5827d921a01SPeter Wemm ul = va_arg(ap, long); 5837d921a01SPeter Wemm else 5847d921a01SPeter Wemm ul = va_arg(ap, int); 585791d77e0SPoul-Henning Kamp sign = 1; 586df8bae1dSRodney W. Grimes base = 10; 587df8bae1dSRodney W. Grimes goto number; 588791d77e0SPoul-Henning Kamp case 'l': 589301ca4ffSBrian Feldman if (lflag) { 590301ca4ffSBrian Feldman lflag = 0; 591301ca4ffSBrian Feldman qflag = 1; 592301ca4ffSBrian Feldman } else 593791d77e0SPoul-Henning Kamp lflag = 1; 594791d77e0SPoul-Henning Kamp goto reswitch; 595df8bae1dSRodney W. Grimes case 'o': 5967d921a01SPeter Wemm if (qflag) 5977d921a01SPeter Wemm uq = va_arg(ap, u_quad_t); 5987d921a01SPeter Wemm else if (lflag) 5997d921a01SPeter Wemm ul = va_arg(ap, u_long); 6007d921a01SPeter Wemm else 6017d921a01SPeter Wemm ul = va_arg(ap, u_int); 602df8bae1dSRodney W. Grimes base = 8; 603e0c38587SBruce Evans goto nosign; 60412d17f65SPoul-Henning Kamp case 'p': 605a23d65bfSBruce Evans ul = (uintptr_t)va_arg(ap, void *); 60612d17f65SPoul-Henning Kamp base = 16; 607c41141b0SBruce Evans sharpflag = (width == 0); 608e0c38587SBruce Evans goto nosign; 6097d921a01SPeter Wemm case 'q': 6107d921a01SPeter Wemm qflag = 1; 6117d921a01SPeter Wemm goto reswitch; 612e0c38587SBruce Evans case 'n': 613e0c38587SBruce Evans case 'r': 6147d921a01SPeter Wemm if (qflag) 6157d921a01SPeter Wemm uq = va_arg(ap, u_quad_t); 6167d921a01SPeter Wemm else if (lflag) 6177d921a01SPeter Wemm ul = va_arg(ap, u_long); 6187d921a01SPeter Wemm else 6197d921a01SPeter Wemm ul = sign ? 6207d921a01SPeter Wemm (u_long)va_arg(ap, int) : va_arg(ap, u_int); 621e0c38587SBruce Evans base = radix; 62212d17f65SPoul-Henning Kamp goto number; 623791d77e0SPoul-Henning Kamp case 's': 624791d77e0SPoul-Henning Kamp p = va_arg(ap, char *); 625791d77e0SPoul-Henning Kamp if (p == NULL) 626791d77e0SPoul-Henning Kamp p = "(null)"; 6274830092aSPoul-Henning Kamp if (!dot) 6284830092aSPoul-Henning Kamp n = strlen (p); 6294830092aSPoul-Henning Kamp else 6304f20e4b1SPoul-Henning Kamp for (n = 0; n < dwidth && p[n]; n++) 6314830092aSPoul-Henning Kamp continue; 6324f20e4b1SPoul-Henning Kamp 6334830092aSPoul-Henning Kamp width -= n; 6344f20e4b1SPoul-Henning Kamp 635791d77e0SPoul-Henning Kamp if (!ladjust && width > 0) 636791d77e0SPoul-Henning Kamp while (width--) 637791d77e0SPoul-Henning Kamp PCHAR(padc); 6384830092aSPoul-Henning Kamp while (n--) 639791d77e0SPoul-Henning Kamp PCHAR(*p++); 640791d77e0SPoul-Henning Kamp if (ladjust && width > 0) 641791d77e0SPoul-Henning Kamp while (width--) 642791d77e0SPoul-Henning Kamp PCHAR(padc); 643791d77e0SPoul-Henning Kamp break; 644f53dbe97SBruce Evans case 'u': 6457d921a01SPeter Wemm if (qflag) 6467d921a01SPeter Wemm uq = va_arg(ap, u_quad_t); 6477d921a01SPeter Wemm else if (lflag) 6487d921a01SPeter Wemm ul = va_arg(ap, u_long); 6497d921a01SPeter Wemm else 6507d921a01SPeter Wemm ul = va_arg(ap, u_int); 651f53dbe97SBruce Evans base = 10; 652e0c38587SBruce Evans goto nosign; 653df8bae1dSRodney W. Grimes case 'x': 654aa998012SMike Smith case 'X': 6557d921a01SPeter Wemm if (qflag) 6567d921a01SPeter Wemm uq = va_arg(ap, u_quad_t); 6577d921a01SPeter Wemm else if (lflag) 6587d921a01SPeter Wemm ul = va_arg(ap, u_long); 6597d921a01SPeter Wemm else 6607d921a01SPeter Wemm ul = va_arg(ap, u_int); 661df8bae1dSRodney W. Grimes base = 16; 662e0c38587SBruce Evans goto nosign; 663e0c38587SBruce Evans case 'z': 6647d921a01SPeter Wemm if (qflag) 6657d921a01SPeter Wemm uq = va_arg(ap, u_quad_t); 6667d921a01SPeter Wemm else if (lflag) 6677d921a01SPeter Wemm ul = va_arg(ap, u_long); 6687d921a01SPeter Wemm else 6697d921a01SPeter Wemm ul = sign ? 6707d921a01SPeter Wemm (u_long)va_arg(ap, int) : va_arg(ap, u_int); 671e0c38587SBruce Evans base = 16; 672e0c38587SBruce Evans goto number; 673e0c38587SBruce Evans nosign: sign = 0; 6747d921a01SPeter Wemm number: 6757d921a01SPeter Wemm if (qflag) { 67682941964SPeter Wemm if (sign && (quad_t)uq < 0) { 6777d921a01SPeter Wemm neg = 1; 6787d921a01SPeter Wemm uq = -(quad_t)uq; 6797d921a01SPeter Wemm } 6807d921a01SPeter Wemm p = ksprintqn(nbuf, uq, base, &tmp); 6817d921a01SPeter Wemm } else { 68282941964SPeter Wemm if (sign && (long)ul < 0) { 683791d77e0SPoul-Henning Kamp neg = 1; 684791d77e0SPoul-Henning Kamp ul = -(long)ul; 685791d77e0SPoul-Henning Kamp } 686ad4f8dbdSArchie Cobbs p = ksprintn(nbuf, ul, base, &tmp); 6877d921a01SPeter Wemm } 68882941964SPeter Wemm if (sharpflag && (qflag ? uq != 0 : ul != 0)) { 689791d77e0SPoul-Henning Kamp if (base == 8) 690791d77e0SPoul-Henning Kamp tmp++; 691791d77e0SPoul-Henning Kamp else if (base == 16) 692791d77e0SPoul-Henning Kamp tmp += 2; 693791d77e0SPoul-Henning Kamp } 694791d77e0SPoul-Henning Kamp if (neg) 695791d77e0SPoul-Henning Kamp tmp++; 696791d77e0SPoul-Henning Kamp 697791d77e0SPoul-Henning Kamp if (!ladjust && width && (width -= tmp) > 0) 698df8bae1dSRodney W. Grimes while (width--) 699791d77e0SPoul-Henning Kamp PCHAR(padc); 700791d77e0SPoul-Henning Kamp if (neg) 701791d77e0SPoul-Henning Kamp PCHAR('-'); 702341c6159SPeter Wemm if (sharpflag && (qflag ? uq != 0 : ul != 0)) { 703791d77e0SPoul-Henning Kamp if (base == 8) { 704791d77e0SPoul-Henning Kamp PCHAR('0'); 705791d77e0SPoul-Henning Kamp } else if (base == 16) { 706791d77e0SPoul-Henning Kamp PCHAR('0'); 707791d77e0SPoul-Henning Kamp PCHAR('x'); 708791d77e0SPoul-Henning Kamp } 709791d77e0SPoul-Henning Kamp } 710791d77e0SPoul-Henning Kamp 711797f2d22SPoul-Henning Kamp while (*p) 712791d77e0SPoul-Henning Kamp PCHAR(*p--); 713791d77e0SPoul-Henning Kamp 714791d77e0SPoul-Henning Kamp if (ladjust && width && (width -= tmp) > 0) 715791d77e0SPoul-Henning Kamp while (width--) 716791d77e0SPoul-Henning Kamp PCHAR(padc); 717791d77e0SPoul-Henning Kamp 718df8bae1dSRodney W. Grimes break; 719df8bae1dSRodney W. Grimes default: 720791d77e0SPoul-Henning Kamp PCHAR('%'); 721df8bae1dSRodney W. Grimes if (lflag) 722791d77e0SPoul-Henning Kamp PCHAR('l'); 723791d77e0SPoul-Henning Kamp PCHAR(ch); 724791d77e0SPoul-Henning Kamp break; 725df8bae1dSRodney W. Grimes } 726df8bae1dSRodney W. Grimes } 727791d77e0SPoul-Henning Kamp #undef PCHAR 728df8bae1dSRodney W. Grimes } 729df8bae1dSRodney W. Grimes 730df8bae1dSRodney W. Grimes /* 731e2a09b26SPoul-Henning Kamp * Put character in log buffer with a particular priority. 732df8bae1dSRodney W. Grimes */ 733df8bae1dSRodney W. Grimes static void 734e2a09b26SPoul-Henning Kamp msglogchar(int c, int pri) 735e2a09b26SPoul-Henning Kamp { 736e2a09b26SPoul-Henning Kamp static int lastpri = -1; 737e2a09b26SPoul-Henning Kamp static int dangling; 738e2a09b26SPoul-Henning Kamp char nbuf[MAXNBUF]; 739e2a09b26SPoul-Henning Kamp char *p; 740e2a09b26SPoul-Henning Kamp 741e2a09b26SPoul-Henning Kamp if (!msgbufmapped) 742e2a09b26SPoul-Henning Kamp return; 743e2a09b26SPoul-Henning Kamp if (c == '\0' || c == '\r') 744e2a09b26SPoul-Henning Kamp return; 745e2a09b26SPoul-Henning Kamp if (pri != -1 && pri != lastpri) { 746e2a09b26SPoul-Henning Kamp if (dangling) { 747e2a09b26SPoul-Henning Kamp msgaddchar('\n', NULL); 748e2a09b26SPoul-Henning Kamp dangling = 0; 749e2a09b26SPoul-Henning Kamp } 750e2a09b26SPoul-Henning Kamp msgaddchar('<', NULL); 751e2a09b26SPoul-Henning Kamp for (p = ksprintn(nbuf, (u_long)pri, 10, NULL); *p;) 752e2a09b26SPoul-Henning Kamp msgaddchar(*p--, NULL); 753e2a09b26SPoul-Henning Kamp msgaddchar('>', NULL); 754e2a09b26SPoul-Henning Kamp lastpri = pri; 755e2a09b26SPoul-Henning Kamp } 756e2a09b26SPoul-Henning Kamp msgaddchar(c, NULL); 757e2a09b26SPoul-Henning Kamp if (c == '\n') { 758e2a09b26SPoul-Henning Kamp dangling = 0; 759e2a09b26SPoul-Henning Kamp lastpri = -1; 760e2a09b26SPoul-Henning Kamp } else { 761e2a09b26SPoul-Henning Kamp dangling = 1; 762e2a09b26SPoul-Henning Kamp } 763e2a09b26SPoul-Henning Kamp } 764e2a09b26SPoul-Henning Kamp 765e2a09b26SPoul-Henning Kamp /* 766e2a09b26SPoul-Henning Kamp * Put char in log buffer 767e2a09b26SPoul-Henning Kamp */ 768e2a09b26SPoul-Henning Kamp static void 769e2a09b26SPoul-Henning Kamp msgaddchar(int c, void *dummy) 770df8bae1dSRodney W. Grimes { 771791d77e0SPoul-Henning Kamp struct msgbuf *mbp; 772df8bae1dSRodney W. Grimes 773e2a09b26SPoul-Henning Kamp if (!msgbufmapped) 774e2a09b26SPoul-Henning Kamp return; 775df8bae1dSRodney W. Grimes mbp = msgbufp; 77658067a99SPoul-Henning Kamp mbp->msg_ptr[mbp->msg_bufx++] = c; 77758067a99SPoul-Henning Kamp if (mbp->msg_bufx >= mbp->msg_size) 778df8bae1dSRodney W. Grimes mbp->msg_bufx = 0; 77902d5c7b1SDavid Greenman /* If the buffer is full, keep the most recent data. */ 780a3f4faceSBruce Evans if (mbp->msg_bufr == mbp->msg_bufx) { 78158067a99SPoul-Henning Kamp if (++mbp->msg_bufr >= mbp->msg_size) 782a3f4faceSBruce Evans mbp->msg_bufr = 0; 783a3f4faceSBruce Evans } 784df8bae1dSRodney W. Grimes } 785e796e00dSPoul-Henning Kamp 786eb9d435aSJonathan Lemon static void 787eb9d435aSJonathan Lemon msgbufcopy(struct msgbuf *oldp) 788eb9d435aSJonathan Lemon { 789eb9d435aSJonathan Lemon int pos; 790eb9d435aSJonathan Lemon 791eb9d435aSJonathan Lemon pos = oldp->msg_bufr; 792eb9d435aSJonathan Lemon while (pos != oldp->msg_bufx) { 793e2a09b26SPoul-Henning Kamp msglogchar(oldp->msg_ptr[pos], -1); 794eb9d435aSJonathan Lemon if (++pos >= oldp->msg_size) 795eb9d435aSJonathan Lemon pos = 0; 796eb9d435aSJonathan Lemon } 797eb9d435aSJonathan Lemon } 798eb9d435aSJonathan Lemon 799e796e00dSPoul-Henning Kamp void 800e796e00dSPoul-Henning Kamp msgbufinit(void *ptr, size_t size) 801e796e00dSPoul-Henning Kamp { 802e796e00dSPoul-Henning Kamp char *cp; 803eb9d435aSJonathan Lemon static struct msgbuf *oldp = NULL; 804e796e00dSPoul-Henning Kamp 805cca8f980SIan Dowse size -= sizeof(*msgbufp); 806e796e00dSPoul-Henning Kamp cp = (char *)ptr; 807cca8f980SIan Dowse msgbufp = (struct msgbuf *) (cp + size); 808cca8f980SIan Dowse if (msgbufp->msg_magic != MSG_MAGIC || msgbufp->msg_size != size || 809cca8f980SIan Dowse msgbufp->msg_bufx >= size || msgbufp->msg_bufr >= size) { 810e796e00dSPoul-Henning Kamp bzero(cp, size); 811cca8f980SIan Dowse bzero(msgbufp, sizeof(*msgbufp)); 812e796e00dSPoul-Henning Kamp msgbufp->msg_magic = MSG_MAGIC; 813e796e00dSPoul-Henning Kamp msgbufp->msg_size = (char *)msgbufp - cp; 814e796e00dSPoul-Henning Kamp } 815cca8f980SIan Dowse msgbufp->msg_ptr = cp; 816eb9d435aSJonathan Lemon if (msgbufmapped && oldp != msgbufp) 817eb9d435aSJonathan Lemon msgbufcopy(oldp); 818e796e00dSPoul-Henning Kamp msgbufmapped = 1; 819eb9d435aSJonathan Lemon oldp = msgbufp; 820e796e00dSPoul-Henning Kamp } 821e796e00dSPoul-Henning Kamp 822948d3d94SThomas Moestl /* Sysctls for accessing/clearing the msgbuf */ 823948d3d94SThomas Moestl static int 824948d3d94SThomas Moestl sysctl_kern_msgbuf(SYSCTL_HANDLER_ARGS) 825948d3d94SThomas Moestl { 826948d3d94SThomas Moestl int error; 827948d3d94SThomas Moestl 828948d3d94SThomas Moestl /* 829948d3d94SThomas Moestl * Unwind the buffer, so that it's linear (possibly starting with 830948d3d94SThomas Moestl * some initial nulls). 831948d3d94SThomas Moestl */ 832948d3d94SThomas Moestl error = sysctl_handle_opaque(oidp, msgbufp->msg_ptr + msgbufp->msg_bufx, 833948d3d94SThomas Moestl msgbufp->msg_size - msgbufp->msg_bufx, req); 834948d3d94SThomas Moestl if (error) 835948d3d94SThomas Moestl return (error); 836948d3d94SThomas Moestl if (msgbufp->msg_bufx > 0) { 837948d3d94SThomas Moestl error = sysctl_handle_opaque(oidp, msgbufp->msg_ptr, 838948d3d94SThomas Moestl msgbufp->msg_bufx, req); 839948d3d94SThomas Moestl } 840948d3d94SThomas Moestl return (error); 841948d3d94SThomas Moestl } 842948d3d94SThomas Moestl 843948d3d94SThomas Moestl SYSCTL_PROC(_kern, OID_AUTO, msgbuf, CTLTYPE_STRING | CTLFLAG_RD, 844948d3d94SThomas Moestl 0, 0, sysctl_kern_msgbuf, "A", "Contents of kernel message buffer"); 845948d3d94SThomas Moestl 846948d3d94SThomas Moestl static int msgbuf_clear; 847948d3d94SThomas Moestl 848948d3d94SThomas Moestl static int 849948d3d94SThomas Moestl sysctl_kern_msgbuf_clear(SYSCTL_HANDLER_ARGS) 850948d3d94SThomas Moestl { 851948d3d94SThomas Moestl int error; 852948d3d94SThomas Moestl error = sysctl_handle_int(oidp, oidp->oid_arg1, oidp->oid_arg2, req); 853948d3d94SThomas Moestl if (!error && req->newptr) { 854948d3d94SThomas Moestl /* Clear the buffer and reset write pointer */ 855948d3d94SThomas Moestl bzero(msgbufp->msg_ptr, msgbufp->msg_size); 856948d3d94SThomas Moestl msgbufp->msg_bufr = msgbufp->msg_bufx = 0; 857948d3d94SThomas Moestl msgbuf_clear = 0; 858948d3d94SThomas Moestl } 859948d3d94SThomas Moestl return (error); 860948d3d94SThomas Moestl } 861948d3d94SThomas Moestl 862948d3d94SThomas Moestl SYSCTL_PROC(_kern, OID_AUTO, msgbuf_clear, 863948d3d94SThomas Moestl CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_SECURE, &msgbuf_clear, 0, 864948d3d94SThomas Moestl sysctl_kern_msgbuf_clear, "I", "Clear kernel message buffer"); 865948d3d94SThomas Moestl 866e796e00dSPoul-Henning Kamp #include "opt_ddb.h" 867e796e00dSPoul-Henning Kamp #ifdef DDB 868e796e00dSPoul-Henning Kamp #include <ddb/ddb.h> 869e796e00dSPoul-Henning Kamp 870e796e00dSPoul-Henning Kamp DB_SHOW_COMMAND(msgbuf, db_show_msgbuf) 871e796e00dSPoul-Henning Kamp { 872e796e00dSPoul-Henning Kamp int i, j; 873e796e00dSPoul-Henning Kamp 874e796e00dSPoul-Henning Kamp if (!msgbufmapped) { 875e796e00dSPoul-Henning Kamp db_printf("msgbuf not mapped yet\n"); 876e796e00dSPoul-Henning Kamp return; 877e796e00dSPoul-Henning Kamp } 878e796e00dSPoul-Henning Kamp db_printf("msgbufp = %p\n", msgbufp); 879e796e00dSPoul-Henning Kamp db_printf("magic = %x, size = %d, r= %d, w = %d, ptr = %p\n", 880e796e00dSPoul-Henning Kamp msgbufp->msg_magic, msgbufp->msg_size, msgbufp->msg_bufr, 881e796e00dSPoul-Henning Kamp msgbufp->msg_bufx, msgbufp->msg_ptr); 882e796e00dSPoul-Henning Kamp for (i = 0; i < msgbufp->msg_size; i++) { 883e796e00dSPoul-Henning Kamp j = (i + msgbufp->msg_bufr) % msgbufp->msg_size; 884e796e00dSPoul-Henning Kamp db_printf("%c", msgbufp->msg_ptr[j]); 885e796e00dSPoul-Henning Kamp } 886e796e00dSPoul-Henning Kamp db_printf("\n"); 887e796e00dSPoul-Henning Kamp } 888e796e00dSPoul-Henning Kamp 889e796e00dSPoul-Henning Kamp #endif /* DDB */ 890