xref: /freebsd/sys/kern/subr_prf.c (revision cca8f9808bddeb30d374107332f4ee333fe2297a)
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