1 /*- 2 * SPDX-License-Identifier: BSD-3-Clause 3 * 4 * Copyright (c) 1986, 1988, 1991, 1993 5 * The Regents of the University of California. All rights reserved. 6 * (c) UNIX System Laboratories, Inc. 7 * All or some portions of this file are derived from material licensed 8 * to the University of California by American Telephone and Telegraph 9 * Co. or Unix System Laboratories, Inc. and are reproduced herein with 10 * the permission of UNIX System Laboratories, Inc. 11 * 12 * Redistribution and use in source and binary forms, with or without 13 * modification, are permitted provided that the following conditions 14 * are met: 15 * 1. Redistributions of source code must retain the above copyright 16 * notice, this list of conditions and the following disclaimer. 17 * 2. Redistributions in binary form must reproduce the above copyright 18 * notice, this list of conditions and the following disclaimer in the 19 * documentation and/or other materials provided with the distribution. 20 * 3. Neither the name of the University nor the names of its contributors 21 * may be used to endorse or promote products derived from this software 22 * without specific prior written permission. 23 * 24 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 27 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 30 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 34 * SUCH DAMAGE. 35 * 36 * @(#)subr_prf.c 8.3 (Berkeley) 1/21/94 37 */ 38 39 #include <sys/cdefs.h> 40 __FBSDID("$FreeBSD$"); 41 42 #ifdef _KERNEL 43 #include "opt_ddb.h" 44 #include "opt_printf.h" 45 #endif /* _KERNEL */ 46 47 #include <sys/param.h> 48 #ifdef _KERNEL 49 #include <sys/systm.h> 50 #include <sys/lock.h> 51 #include <sys/kdb.h> 52 #include <sys/mutex.h> 53 #include <sys/sx.h> 54 #include <sys/kernel.h> 55 #include <sys/msgbuf.h> 56 #include <sys/malloc.h> 57 #include <sys/priv.h> 58 #include <sys/proc.h> 59 #include <sys/stddef.h> 60 #include <sys/sysctl.h> 61 #include <sys/tslog.h> 62 #include <sys/tty.h> 63 #include <sys/syslog.h> 64 #include <sys/cons.h> 65 #include <sys/uio.h> 66 #else /* !_KERNEL */ 67 #include <errno.h> 68 #endif 69 #include <sys/ctype.h> 70 #include <sys/sbuf.h> 71 72 #ifdef DDB 73 #include <ddb/ddb.h> 74 #endif 75 76 /* 77 * Note that stdarg.h and the ANSI style va_start macro is used for both 78 * ANSI and traditional C compilers. 79 */ 80 #ifdef _KERNEL 81 #include <machine/stdarg.h> 82 #else 83 #include <stdarg.h> 84 #endif 85 86 /* 87 * This is needed for sbuf_putbuf() when compiled into userland. Due to the 88 * shared nature of this file, it's the only place to put it. 89 */ 90 #ifndef _KERNEL 91 #include <stdio.h> 92 #endif 93 94 #ifdef _KERNEL 95 96 #define TOCONS 0x01 97 #define TOTTY 0x02 98 #define TOLOG 0x04 99 100 /* Max number conversion buffer length: a u_quad_t in base 2, plus NUL byte. */ 101 #define MAXNBUF (sizeof(intmax_t) * NBBY + 1) 102 103 struct putchar_arg { 104 int flags; 105 int pri; 106 struct tty *tty; 107 char *p_bufr; 108 size_t n_bufr; 109 char *p_next; 110 size_t remain; 111 }; 112 113 struct snprintf_arg { 114 char *str; 115 size_t remain; 116 }; 117 118 extern int log_open; 119 120 static void msglogchar(int c, int pri); 121 static void msglogstr(char *str, int pri, int filter_cr); 122 static void prf_putbuf(char *bufr, int flags, int pri); 123 static void putchar(int ch, void *arg); 124 static char *ksprintn(char *nbuf, uintmax_t num, int base, int *len, int upper); 125 static void snprintf_func(int ch, void *arg); 126 127 static bool msgbufmapped; /* Set when safe to use msgbuf */ 128 int msgbuftrigger; 129 struct msgbuf *msgbufp; 130 131 #ifndef BOOT_TAG_SZ 132 #define BOOT_TAG_SZ 32 133 #endif 134 #ifndef BOOT_TAG 135 /* Tag used to mark the start of a boot in dmesg */ 136 #define BOOT_TAG "---<<BOOT>>---" 137 #endif 138 139 static char current_boot_tag[BOOT_TAG_SZ + 1] = BOOT_TAG; 140 SYSCTL_STRING(_kern, OID_AUTO, boot_tag, CTLFLAG_RDTUN | CTLFLAG_NOFETCH, 141 current_boot_tag, 0, "Tag added to dmesg at start of boot"); 142 143 static int log_console_output = 1; 144 SYSCTL_INT(_kern, OID_AUTO, log_console_output, CTLFLAG_RWTUN, 145 &log_console_output, 0, "Duplicate console output to the syslog"); 146 147 /* 148 * See the comment in log_console() below for more explanation of this. 149 */ 150 static int log_console_add_linefeed; 151 SYSCTL_INT(_kern, OID_AUTO, log_console_add_linefeed, CTLFLAG_RWTUN, 152 &log_console_add_linefeed, 0, "log_console() adds extra newlines"); 153 154 static int always_console_output; 155 SYSCTL_INT(_kern, OID_AUTO, always_console_output, CTLFLAG_RWTUN, 156 &always_console_output, 0, "Always output to console despite TIOCCONS"); 157 158 /* 159 * Warn that a system table is full. 160 */ 161 void 162 tablefull(const char *tab) 163 { 164 165 log(LOG_ERR, "%s: table is full\n", tab); 166 } 167 168 /* 169 * Uprintf prints to the controlling terminal for the current process. 170 */ 171 int 172 uprintf(const char *fmt, ...) 173 { 174 va_list ap; 175 struct putchar_arg pca; 176 struct proc *p; 177 struct thread *td; 178 int retval; 179 180 td = curthread; 181 if (TD_IS_IDLETHREAD(td)) 182 return (0); 183 184 if (td->td_proc == initproc) { 185 /* Produce output when we fail to load /sbin/init: */ 186 va_start(ap, fmt); 187 retval = vprintf(fmt, ap); 188 va_end(ap); 189 return (retval); 190 } 191 192 sx_slock(&proctree_lock); 193 p = td->td_proc; 194 PROC_LOCK(p); 195 if ((p->p_flag & P_CONTROLT) == 0) { 196 PROC_UNLOCK(p); 197 sx_sunlock(&proctree_lock); 198 return (0); 199 } 200 SESS_LOCK(p->p_session); 201 pca.tty = p->p_session->s_ttyp; 202 SESS_UNLOCK(p->p_session); 203 PROC_UNLOCK(p); 204 if (pca.tty == NULL) { 205 sx_sunlock(&proctree_lock); 206 return (0); 207 } 208 pca.flags = TOTTY; 209 pca.p_bufr = NULL; 210 va_start(ap, fmt); 211 tty_lock(pca.tty); 212 sx_sunlock(&proctree_lock); 213 retval = kvprintf(fmt, putchar, &pca, 10, ap); 214 tty_unlock(pca.tty); 215 va_end(ap); 216 return (retval); 217 } 218 219 /* 220 * tprintf and vtprintf print on the controlling terminal associated with the 221 * given session, possibly to the log as well. 222 */ 223 void 224 tprintf(struct proc *p, int pri, const char *fmt, ...) 225 { 226 va_list ap; 227 228 va_start(ap, fmt); 229 vtprintf(p, pri, fmt, ap); 230 va_end(ap); 231 } 232 233 void 234 vtprintf(struct proc *p, int pri, const char *fmt, va_list ap) 235 { 236 struct tty *tp = NULL; 237 int flags = 0; 238 struct putchar_arg pca; 239 struct session *sess = NULL; 240 241 sx_slock(&proctree_lock); 242 if (pri != -1) 243 flags |= TOLOG; 244 if (p != NULL) { 245 PROC_LOCK(p); 246 if (p->p_flag & P_CONTROLT && p->p_session->s_ttyvp) { 247 sess = p->p_session; 248 sess_hold(sess); 249 PROC_UNLOCK(p); 250 tp = sess->s_ttyp; 251 if (tp != NULL && tty_checkoutq(tp)) 252 flags |= TOTTY; 253 else 254 tp = NULL; 255 } else 256 PROC_UNLOCK(p); 257 } 258 pca.pri = pri; 259 pca.tty = tp; 260 pca.flags = flags; 261 pca.p_bufr = NULL; 262 if (pca.tty != NULL) 263 tty_lock(pca.tty); 264 sx_sunlock(&proctree_lock); 265 kvprintf(fmt, putchar, &pca, 10, ap); 266 if (pca.tty != NULL) 267 tty_unlock(pca.tty); 268 if (sess != NULL) 269 sess_release(sess); 270 msgbuftrigger = 1; 271 } 272 273 static int 274 _vprintf(int level, int flags, const char *fmt, va_list ap) 275 { 276 struct putchar_arg pca; 277 int retval; 278 #ifdef PRINTF_BUFR_SIZE 279 char bufr[PRINTF_BUFR_SIZE]; 280 #endif 281 282 TSENTER(); 283 pca.tty = NULL; 284 pca.pri = level; 285 pca.flags = flags; 286 #ifdef PRINTF_BUFR_SIZE 287 pca.p_bufr = bufr; 288 pca.p_next = pca.p_bufr; 289 pca.n_bufr = sizeof(bufr); 290 pca.remain = sizeof(bufr); 291 *pca.p_next = '\0'; 292 #else 293 /* Don't buffer console output. */ 294 pca.p_bufr = NULL; 295 #endif 296 297 retval = kvprintf(fmt, putchar, &pca, 10, ap); 298 299 #ifdef PRINTF_BUFR_SIZE 300 /* Write any buffered console/log output: */ 301 if (*pca.p_bufr != '\0') 302 prf_putbuf(pca.p_bufr, flags, level); 303 #endif 304 305 TSEXIT(); 306 return (retval); 307 } 308 309 /* 310 * Log writes to the log buffer, and guarantees not to sleep (so can be 311 * called by interrupt routines). If there is no process reading the 312 * log yet, it writes to the console also. 313 */ 314 void 315 log(int level, const char *fmt, ...) 316 { 317 va_list ap; 318 319 va_start(ap, fmt); 320 vlog(level, fmt, ap); 321 va_end(ap); 322 } 323 324 void 325 vlog(int level, const char *fmt, va_list ap) 326 { 327 328 (void)_vprintf(level, log_open ? TOLOG : TOCONS | TOLOG, fmt, ap); 329 msgbuftrigger = 1; 330 } 331 332 #define CONSCHUNK 128 333 334 void 335 log_console(struct uio *uio) 336 { 337 int c, error, nl; 338 char *consbuffer; 339 int pri; 340 341 if (!log_console_output) 342 return; 343 344 pri = LOG_INFO | LOG_CONSOLE; 345 uio = cloneuio(uio); 346 consbuffer = malloc(CONSCHUNK, M_TEMP, M_WAITOK); 347 348 nl = 0; 349 while (uio->uio_resid > 0) { 350 c = imin(uio->uio_resid, CONSCHUNK - 1); 351 error = uiomove(consbuffer, c, uio); 352 if (error != 0) 353 break; 354 /* Make sure we're NUL-terminated */ 355 consbuffer[c] = '\0'; 356 if (consbuffer[c - 1] == '\n') 357 nl = 1; 358 else 359 nl = 0; 360 msglogstr(consbuffer, pri, /*filter_cr*/ 1); 361 } 362 /* 363 * The previous behavior in log_console() is preserved when 364 * log_console_add_linefeed is non-zero. For that behavior, if an 365 * individual console write came in that was not terminated with a 366 * line feed, it would add a line feed. 367 * 368 * This results in different data in the message buffer than 369 * appears on the system console (which doesn't add extra line feed 370 * characters). 371 * 372 * A number of programs and rc scripts write a line feed, or a period 373 * and a line feed when they have completed their operation. On 374 * the console, this looks seamless, but when displayed with 375 * 'dmesg -a', you wind up with output that looks like this: 376 * 377 * Updating motd: 378 * . 379 * 380 * On the console, it looks like this: 381 * Updating motd:. 382 * 383 * We could add logic to detect that situation, or just not insert 384 * the extra newlines. Set the kern.log_console_add_linefeed 385 * sysctl/tunable variable to get the old behavior. 386 */ 387 if (!nl && log_console_add_linefeed) { 388 consbuffer[0] = '\n'; 389 consbuffer[1] = '\0'; 390 msglogstr(consbuffer, pri, /*filter_cr*/ 1); 391 } 392 msgbuftrigger = 1; 393 free(uio, M_IOV); 394 free(consbuffer, M_TEMP); 395 } 396 397 int 398 printf(const char *fmt, ...) 399 { 400 va_list ap; 401 int retval; 402 403 va_start(ap, fmt); 404 retval = vprintf(fmt, ap); 405 va_end(ap); 406 407 return (retval); 408 } 409 410 int 411 vprintf(const char *fmt, va_list ap) 412 { 413 int retval; 414 415 retval = _vprintf(-1, TOCONS | TOLOG, fmt, ap); 416 417 if (!KERNEL_PANICKED()) 418 msgbuftrigger = 1; 419 420 return (retval); 421 } 422 423 static void 424 prf_putchar(int c, int flags, int pri) 425 { 426 427 if (flags & TOLOG) 428 msglogchar(c, pri); 429 430 if (flags & TOCONS) { 431 if ((!KERNEL_PANICKED()) && (constty != NULL)) 432 msgbuf_addchar(&consmsgbuf, c); 433 434 if ((constty == NULL) || always_console_output) 435 cnputc(c); 436 } 437 } 438 439 static void 440 prf_putbuf(char *bufr, int flags, int pri) 441 { 442 443 if (flags & TOLOG) 444 msglogstr(bufr, pri, /*filter_cr*/1); 445 446 if (flags & TOCONS) { 447 if ((!KERNEL_PANICKED()) && (constty != NULL)) 448 msgbuf_addstr(&consmsgbuf, -1, 449 bufr, /*filter_cr*/ 0); 450 451 if ((constty == NULL) || always_console_output) 452 cnputs(bufr); 453 } 454 } 455 456 static void 457 putbuf(int c, struct putchar_arg *ap) 458 { 459 /* Check if no console output buffer was provided. */ 460 if (ap->p_bufr == NULL) { 461 prf_putchar(c, ap->flags, ap->pri); 462 } else { 463 /* Buffer the character: */ 464 *ap->p_next++ = c; 465 ap->remain--; 466 467 /* Always leave the buffer zero terminated. */ 468 *ap->p_next = '\0'; 469 470 /* Check if the buffer needs to be flushed. */ 471 if (ap->remain == 2 || c == '\n') { 472 prf_putbuf(ap->p_bufr, ap->flags, ap->pri); 473 474 ap->p_next = ap->p_bufr; 475 ap->remain = ap->n_bufr; 476 *ap->p_next = '\0'; 477 } 478 479 /* 480 * Since we fill the buffer up one character at a time, 481 * this should not happen. We should always catch it when 482 * ap->remain == 2 (if not sooner due to a newline), flush 483 * the buffer and move on. One way this could happen is 484 * if someone sets PRINTF_BUFR_SIZE to 1 or something 485 * similarly silly. 486 */ 487 KASSERT(ap->remain > 2, ("Bad buffer logic, remain = %zd", 488 ap->remain)); 489 } 490 } 491 492 /* 493 * Print a character on console or users terminal. If destination is 494 * the console then the last bunch of characters are saved in msgbuf for 495 * inspection later. 496 */ 497 static void 498 putchar(int c, void *arg) 499 { 500 struct putchar_arg *ap = (struct putchar_arg*) arg; 501 struct tty *tp = ap->tty; 502 int flags = ap->flags; 503 504 /* Don't use the tty code after a panic or while in ddb. */ 505 if (kdb_active) { 506 if (c != '\0') 507 cnputc(c); 508 return; 509 } 510 511 if ((flags & TOTTY) && tp != NULL && !KERNEL_PANICKED()) 512 tty_putchar(tp, c); 513 514 if ((flags & (TOCONS | TOLOG)) && c != '\0') 515 putbuf(c, ap); 516 } 517 518 /* 519 * Scaled down version of sprintf(3). 520 */ 521 int 522 sprintf(char *buf, const char *cfmt, ...) 523 { 524 int retval; 525 va_list ap; 526 527 va_start(ap, cfmt); 528 retval = kvprintf(cfmt, NULL, (void *)buf, 10, ap); 529 buf[retval] = '\0'; 530 va_end(ap); 531 return (retval); 532 } 533 534 /* 535 * Scaled down version of vsprintf(3). 536 */ 537 int 538 vsprintf(char *buf, const char *cfmt, va_list ap) 539 { 540 int retval; 541 542 retval = kvprintf(cfmt, NULL, (void *)buf, 10, ap); 543 buf[retval] = '\0'; 544 return (retval); 545 } 546 547 /* 548 * Scaled down version of snprintf(3). 549 */ 550 int 551 snprintf(char *str, size_t size, const char *format, ...) 552 { 553 int retval; 554 va_list ap; 555 556 va_start(ap, format); 557 retval = vsnprintf(str, size, format, ap); 558 va_end(ap); 559 return(retval); 560 } 561 562 /* 563 * Scaled down version of vsnprintf(3). 564 */ 565 int 566 vsnprintf(char *str, size_t size, const char *format, va_list ap) 567 { 568 struct snprintf_arg info; 569 int retval; 570 571 info.str = str; 572 info.remain = size; 573 retval = kvprintf(format, snprintf_func, &info, 10, ap); 574 if (info.remain >= 1) 575 *info.str++ = '\0'; 576 return (retval); 577 } 578 579 /* 580 * Kernel version which takes radix argument vsnprintf(3). 581 */ 582 int 583 vsnrprintf(char *str, size_t size, int radix, const char *format, va_list ap) 584 { 585 struct snprintf_arg info; 586 int retval; 587 588 info.str = str; 589 info.remain = size; 590 retval = kvprintf(format, snprintf_func, &info, radix, ap); 591 if (info.remain >= 1) 592 *info.str++ = '\0'; 593 return (retval); 594 } 595 596 static void 597 snprintf_func(int ch, void *arg) 598 { 599 struct snprintf_arg *const info = arg; 600 601 if (info->remain >= 2) { 602 *info->str++ = ch; 603 info->remain--; 604 } 605 } 606 607 /* 608 * Put a NUL-terminated ASCII number (base <= 36) in a buffer in reverse 609 * order; return an optional length and a pointer to the last character 610 * written in the buffer (i.e., the first character of the string). 611 * The buffer pointed to by `nbuf' must have length >= MAXNBUF. 612 */ 613 static char * 614 ksprintn(char *nbuf, uintmax_t num, int base, int *lenp, int upper) 615 { 616 char *p, c; 617 618 p = nbuf; 619 *p = '\0'; 620 do { 621 c = hex2ascii(num % base); 622 *++p = upper ? toupper(c) : c; 623 } while (num /= base); 624 if (lenp) 625 *lenp = p - nbuf; 626 return (p); 627 } 628 629 /* 630 * Scaled down version of printf(3). 631 * 632 * Two additional formats: 633 * 634 * The format %b is supported to decode error registers. 635 * Its usage is: 636 * 637 * printf("reg=%b\n", regval, "<base><arg>*"); 638 * 639 * where <base> is the output base expressed as a control character, e.g. 640 * \10 gives octal; \20 gives hex. Each arg is a sequence of characters, 641 * the first of which gives the bit number to be inspected (origin 1), and 642 * the next characters (up to a control character, i.e. a character <= 32), 643 * give the name of the register. Thus: 644 * 645 * kvprintf("reg=%b\n", 3, "\10\2BITTWO\1BITONE"); 646 * 647 * would produce output: 648 * 649 * reg=3<BITTWO,BITONE> 650 * 651 * XXX: %D -- Hexdump, takes pointer and separator string: 652 * ("%6D", ptr, ":") -> XX:XX:XX:XX:XX:XX 653 * ("%*D", len, ptr, " " -> XX XX XX XX ... 654 */ 655 int 656 kvprintf(char const *fmt, void (*func)(int, void*), void *arg, int radix, va_list ap) 657 { 658 #define PCHAR(c) {int cc=(c); if (func) (*func)(cc,arg); else *d++ = cc; retval++; } 659 char nbuf[MAXNBUF]; 660 char *d; 661 const char *p, *percent, *q; 662 u_char *up; 663 int ch, n; 664 uintmax_t num; 665 int base, lflag, qflag, tmp, width, ladjust, sharpflag, neg, sign, dot; 666 int cflag, hflag, jflag, tflag, zflag; 667 int bconv, dwidth, upper; 668 char padc; 669 int stop = 0, retval = 0; 670 671 num = 0; 672 q = NULL; 673 if (!func) 674 d = (char *) arg; 675 else 676 d = NULL; 677 678 if (fmt == NULL) 679 fmt = "(fmt null)\n"; 680 681 if (radix < 2 || radix > 36) 682 radix = 10; 683 684 for (;;) { 685 padc = ' '; 686 width = 0; 687 while ((ch = (u_char)*fmt++) != '%' || stop) { 688 if (ch == '\0') 689 return (retval); 690 PCHAR(ch); 691 } 692 percent = fmt - 1; 693 qflag = 0; lflag = 0; ladjust = 0; sharpflag = 0; neg = 0; 694 sign = 0; dot = 0; bconv = 0; dwidth = 0; upper = 0; 695 cflag = 0; hflag = 0; jflag = 0; tflag = 0; zflag = 0; 696 reswitch: switch (ch = (u_char)*fmt++) { 697 case '.': 698 dot = 1; 699 goto reswitch; 700 case '#': 701 sharpflag = 1; 702 goto reswitch; 703 case '+': 704 sign = 1; 705 goto reswitch; 706 case '-': 707 ladjust = 1; 708 goto reswitch; 709 case '%': 710 PCHAR(ch); 711 break; 712 case '*': 713 if (!dot) { 714 width = va_arg(ap, int); 715 if (width < 0) { 716 ladjust = !ladjust; 717 width = -width; 718 } 719 } else { 720 dwidth = va_arg(ap, int); 721 } 722 goto reswitch; 723 case '0': 724 if (!dot) { 725 padc = '0'; 726 goto reswitch; 727 } 728 /* FALLTHROUGH */ 729 case '1': case '2': case '3': case '4': 730 case '5': case '6': case '7': case '8': case '9': 731 for (n = 0;; ++fmt) { 732 n = n * 10 + ch - '0'; 733 ch = *fmt; 734 if (ch < '0' || ch > '9') 735 break; 736 } 737 if (dot) 738 dwidth = n; 739 else 740 width = n; 741 goto reswitch; 742 case 'b': 743 ladjust = 1; 744 bconv = 1; 745 goto handle_nosign; 746 case 'c': 747 width -= 1; 748 749 if (!ladjust && width > 0) 750 while (width--) 751 PCHAR(padc); 752 PCHAR(va_arg(ap, int)); 753 if (ladjust && width > 0) 754 while (width--) 755 PCHAR(padc); 756 break; 757 case 'D': 758 up = va_arg(ap, u_char *); 759 p = va_arg(ap, char *); 760 if (!width) 761 width = 16; 762 while(width--) { 763 PCHAR(hex2ascii(*up >> 4)); 764 PCHAR(hex2ascii(*up & 0x0f)); 765 up++; 766 if (width) 767 for (q=p;*q;q++) 768 PCHAR(*q); 769 } 770 break; 771 case 'd': 772 case 'i': 773 base = 10; 774 sign = 1; 775 goto handle_sign; 776 case 'h': 777 if (hflag) { 778 hflag = 0; 779 cflag = 1; 780 } else 781 hflag = 1; 782 goto reswitch; 783 case 'j': 784 jflag = 1; 785 goto reswitch; 786 case 'l': 787 if (lflag) { 788 lflag = 0; 789 qflag = 1; 790 } else 791 lflag = 1; 792 goto reswitch; 793 case 'n': 794 /* 795 * We do not support %n in kernel, but consume the 796 * argument. 797 */ 798 if (jflag) 799 (void)va_arg(ap, intmax_t *); 800 else if (qflag) 801 (void)va_arg(ap, quad_t *); 802 else if (lflag) 803 (void)va_arg(ap, long *); 804 else if (zflag) 805 (void)va_arg(ap, size_t *); 806 else if (hflag) 807 (void)va_arg(ap, short *); 808 else if (cflag) 809 (void)va_arg(ap, char *); 810 else 811 (void)va_arg(ap, int *); 812 break; 813 case 'o': 814 base = 8; 815 goto handle_nosign; 816 case 'p': 817 base = 16; 818 sharpflag = (width == 0); 819 sign = 0; 820 num = (uintptr_t)va_arg(ap, void *); 821 goto number; 822 case 'q': 823 qflag = 1; 824 goto reswitch; 825 case 'r': 826 base = radix; 827 if (sign) 828 goto handle_sign; 829 goto handle_nosign; 830 case 's': 831 p = va_arg(ap, char *); 832 if (p == NULL) 833 p = "(null)"; 834 if (!dot) 835 n = strlen (p); 836 else 837 for (n = 0; n < dwidth && p[n]; n++) 838 continue; 839 840 width -= n; 841 842 if (!ladjust && width > 0) 843 while (width--) 844 PCHAR(padc); 845 while (n--) 846 PCHAR(*p++); 847 if (ladjust && width > 0) 848 while (width--) 849 PCHAR(padc); 850 break; 851 case 't': 852 tflag = 1; 853 goto reswitch; 854 case 'u': 855 base = 10; 856 goto handle_nosign; 857 case 'X': 858 upper = 1; 859 /* FALLTHROUGH */ 860 case 'x': 861 base = 16; 862 goto handle_nosign; 863 case 'y': 864 base = 16; 865 sign = 1; 866 goto handle_sign; 867 case 'z': 868 zflag = 1; 869 goto reswitch; 870 handle_nosign: 871 sign = 0; 872 if (jflag) 873 num = va_arg(ap, uintmax_t); 874 else if (qflag) 875 num = va_arg(ap, u_quad_t); 876 else if (tflag) 877 num = va_arg(ap, ptrdiff_t); 878 else if (lflag) 879 num = va_arg(ap, u_long); 880 else if (zflag) 881 num = va_arg(ap, size_t); 882 else if (hflag) 883 num = (u_short)va_arg(ap, int); 884 else if (cflag) 885 num = (u_char)va_arg(ap, int); 886 else 887 num = va_arg(ap, u_int); 888 if (bconv) { 889 q = va_arg(ap, char *); 890 base = *q++; 891 } 892 goto number; 893 handle_sign: 894 if (jflag) 895 num = va_arg(ap, intmax_t); 896 else if (qflag) 897 num = va_arg(ap, quad_t); 898 else if (tflag) 899 num = va_arg(ap, ptrdiff_t); 900 else if (lflag) 901 num = va_arg(ap, long); 902 else if (zflag) 903 num = va_arg(ap, ssize_t); 904 else if (hflag) 905 num = (short)va_arg(ap, int); 906 else if (cflag) 907 num = (char)va_arg(ap, int); 908 else 909 num = va_arg(ap, int); 910 number: 911 if (sign && (intmax_t)num < 0) { 912 neg = 1; 913 num = -(intmax_t)num; 914 } 915 p = ksprintn(nbuf, num, base, &n, upper); 916 tmp = 0; 917 if (sharpflag && num != 0) { 918 if (base == 8) 919 tmp++; 920 else if (base == 16) 921 tmp += 2; 922 } 923 if (neg) 924 tmp++; 925 926 if (!ladjust && padc == '0') 927 dwidth = width - tmp; 928 width -= tmp + imax(dwidth, n); 929 dwidth -= n; 930 if (!ladjust) 931 while (width-- > 0) 932 PCHAR(' '); 933 if (neg) 934 PCHAR('-'); 935 if (sharpflag && num != 0) { 936 if (base == 8) { 937 PCHAR('0'); 938 } else if (base == 16) { 939 PCHAR('0'); 940 PCHAR('x'); 941 } 942 } 943 while (dwidth-- > 0) 944 PCHAR('0'); 945 946 while (*p) 947 PCHAR(*p--); 948 949 if (bconv && num != 0) { 950 /* %b conversion flag format. */ 951 tmp = retval; 952 while (*q) { 953 n = *q++; 954 if (num & (1 << (n - 1))) { 955 PCHAR(retval != tmp ? 956 ',' : '<'); 957 for (; (n = *q) > ' '; ++q) 958 PCHAR(n); 959 } else 960 for (; *q > ' '; ++q) 961 continue; 962 } 963 if (retval != tmp) { 964 PCHAR('>'); 965 width -= retval - tmp; 966 } 967 } 968 969 if (ladjust) 970 while (width-- > 0) 971 PCHAR(' '); 972 973 break; 974 default: 975 while (percent < fmt) 976 PCHAR(*percent++); 977 /* 978 * Since we ignore a formatting argument it is no 979 * longer safe to obey the remaining formatting 980 * arguments as the arguments will no longer match 981 * the format specs. 982 */ 983 stop = 1; 984 break; 985 } 986 } 987 #undef PCHAR 988 } 989 990 /* 991 * Put character in log buffer with a particular priority. 992 */ 993 static void 994 msglogchar(int c, int pri) 995 { 996 static int lastpri = -1; 997 static int dangling; 998 char nbuf[MAXNBUF]; 999 char *p; 1000 1001 if (!msgbufmapped) 1002 return; 1003 if (c == '\0' || c == '\r') 1004 return; 1005 if (pri != -1 && pri != lastpri) { 1006 if (dangling) { 1007 msgbuf_addchar(msgbufp, '\n'); 1008 dangling = 0; 1009 } 1010 msgbuf_addchar(msgbufp, '<'); 1011 for (p = ksprintn(nbuf, (uintmax_t)pri, 10, NULL, 0); *p;) 1012 msgbuf_addchar(msgbufp, *p--); 1013 msgbuf_addchar(msgbufp, '>'); 1014 lastpri = pri; 1015 } 1016 msgbuf_addchar(msgbufp, c); 1017 if (c == '\n') { 1018 dangling = 0; 1019 lastpri = -1; 1020 } else { 1021 dangling = 1; 1022 } 1023 } 1024 1025 static void 1026 msglogstr(char *str, int pri, int filter_cr) 1027 { 1028 if (!msgbufmapped) 1029 return; 1030 1031 msgbuf_addstr(msgbufp, pri, str, filter_cr); 1032 } 1033 1034 void 1035 msgbufinit(void *ptr, int size) 1036 { 1037 char *cp; 1038 static struct msgbuf *oldp = NULL; 1039 bool print_boot_tag; 1040 1041 TSENTER(); 1042 size -= sizeof(*msgbufp); 1043 cp = (char *)ptr; 1044 print_boot_tag = !msgbufmapped; 1045 /* Attempt to fetch kern.boot_tag tunable on first mapping */ 1046 if (!msgbufmapped) 1047 TUNABLE_STR_FETCH("kern.boot_tag", current_boot_tag, 1048 sizeof(current_boot_tag)); 1049 msgbufp = (struct msgbuf *)(cp + size); 1050 msgbuf_reinit(msgbufp, cp, size); 1051 if (msgbufmapped && oldp != msgbufp) 1052 msgbuf_copy(oldp, msgbufp); 1053 msgbufmapped = true; 1054 if (print_boot_tag && *current_boot_tag != '\0') 1055 printf("%s\n", current_boot_tag); 1056 oldp = msgbufp; 1057 TSEXIT(); 1058 } 1059 1060 /* Sysctls for accessing/clearing the msgbuf */ 1061 static int 1062 sysctl_kern_msgbuf(SYSCTL_HANDLER_ARGS) 1063 { 1064 char buf[128], *bp; 1065 u_int seq; 1066 int error, len; 1067 bool wrap; 1068 1069 error = priv_check(req->td, PRIV_MSGBUF); 1070 if (error) 1071 return (error); 1072 1073 /* Read the whole buffer, one chunk at a time. */ 1074 mtx_lock(&msgbuf_lock); 1075 msgbuf_peekbytes(msgbufp, NULL, 0, &seq); 1076 wrap = (seq != 0); 1077 for (;;) { 1078 len = msgbuf_peekbytes(msgbufp, buf, sizeof(buf), &seq); 1079 mtx_unlock(&msgbuf_lock); 1080 if (len == 0) 1081 return (SYSCTL_OUT(req, "", 1)); /* add nulterm */ 1082 if (wrap) { 1083 /* Skip the first line, as it is probably incomplete. */ 1084 bp = memchr(buf, '\n', len); 1085 if (bp == NULL) { 1086 mtx_lock(&msgbuf_lock); 1087 continue; 1088 } 1089 wrap = false; 1090 bp++; 1091 len -= bp - buf; 1092 if (len == 0) { 1093 mtx_lock(&msgbuf_lock); 1094 continue; 1095 } 1096 } else 1097 bp = buf; 1098 error = sysctl_handle_opaque(oidp, bp, len, req); 1099 if (error) 1100 return (error); 1101 1102 mtx_lock(&msgbuf_lock); 1103 } 1104 } 1105 1106 SYSCTL_PROC(_kern, OID_AUTO, msgbuf, 1107 CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, 1108 NULL, 0, sysctl_kern_msgbuf, "A", "Contents of kernel message buffer"); 1109 1110 static int msgbuf_clearflag; 1111 1112 static int 1113 sysctl_kern_msgbuf_clear(SYSCTL_HANDLER_ARGS) 1114 { 1115 int error; 1116 error = sysctl_handle_int(oidp, oidp->oid_arg1, oidp->oid_arg2, req); 1117 if (!error && req->newptr) { 1118 mtx_lock(&msgbuf_lock); 1119 msgbuf_clear(msgbufp); 1120 mtx_unlock(&msgbuf_lock); 1121 msgbuf_clearflag = 0; 1122 } 1123 return (error); 1124 } 1125 1126 SYSCTL_PROC(_kern, OID_AUTO, msgbuf_clear, 1127 CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_SECURE | CTLFLAG_MPSAFE, 1128 &msgbuf_clearflag, 0, sysctl_kern_msgbuf_clear, "I", 1129 "Clear kernel message buffer"); 1130 1131 #ifdef DDB 1132 1133 DB_SHOW_COMMAND_FLAGS(msgbuf, db_show_msgbuf, DB_CMD_MEMSAFE) 1134 { 1135 int i, j; 1136 1137 if (!msgbufmapped) { 1138 db_printf("msgbuf not mapped yet\n"); 1139 return; 1140 } 1141 db_printf("msgbufp = %p\n", msgbufp); 1142 db_printf("magic = %x, size = %d, r= %u, w = %u, ptr = %p, cksum= %u\n", 1143 msgbufp->msg_magic, msgbufp->msg_size, msgbufp->msg_rseq, 1144 msgbufp->msg_wseq, msgbufp->msg_ptr, msgbufp->msg_cksum); 1145 for (i = 0; i < msgbufp->msg_size && !db_pager_quit; i++) { 1146 j = MSGBUF_SEQ_TO_POS(msgbufp, i + msgbufp->msg_rseq); 1147 db_printf("%c", msgbufp->msg_ptr[j]); 1148 } 1149 db_printf("\n"); 1150 } 1151 1152 #endif /* DDB */ 1153 1154 void 1155 hexdump(const void *ptr, int length, const char *hdr, int flags) 1156 { 1157 int i, j, k; 1158 int cols; 1159 const unsigned char *cp; 1160 char delim; 1161 1162 if ((flags & HD_DELIM_MASK) != 0) 1163 delim = (flags & HD_DELIM_MASK) >> 8; 1164 else 1165 delim = ' '; 1166 1167 if ((flags & HD_COLUMN_MASK) != 0) 1168 cols = flags & HD_COLUMN_MASK; 1169 else 1170 cols = 16; 1171 1172 cp = ptr; 1173 for (i = 0; i < length; i+= cols) { 1174 if (hdr != NULL) 1175 printf("%s", hdr); 1176 1177 if ((flags & HD_OMIT_COUNT) == 0) 1178 printf("%04x ", i); 1179 1180 if ((flags & HD_OMIT_HEX) == 0) { 1181 for (j = 0; j < cols; j++) { 1182 k = i + j; 1183 if (k < length) 1184 printf("%c%02x", delim, cp[k]); 1185 else 1186 printf(" "); 1187 } 1188 } 1189 1190 if ((flags & HD_OMIT_CHARS) == 0) { 1191 printf(" |"); 1192 for (j = 0; j < cols; j++) { 1193 k = i + j; 1194 if (k >= length) 1195 printf(" "); 1196 else if (cp[k] >= ' ' && cp[k] <= '~') 1197 printf("%c", cp[k]); 1198 else 1199 printf("."); 1200 } 1201 printf("|"); 1202 } 1203 printf("\n"); 1204 } 1205 } 1206 #endif /* _KERNEL */ 1207 1208 void 1209 sbuf_hexdump(struct sbuf *sb, const void *ptr, int length, const char *hdr, 1210 int flags) 1211 { 1212 int i, j, k; 1213 int cols; 1214 const unsigned char *cp; 1215 char delim; 1216 1217 if ((flags & HD_DELIM_MASK) != 0) 1218 delim = (flags & HD_DELIM_MASK) >> 8; 1219 else 1220 delim = ' '; 1221 1222 if ((flags & HD_COLUMN_MASK) != 0) 1223 cols = flags & HD_COLUMN_MASK; 1224 else 1225 cols = 16; 1226 1227 cp = ptr; 1228 for (i = 0; i < length; i+= cols) { 1229 if (hdr != NULL) 1230 sbuf_printf(sb, "%s", hdr); 1231 1232 if ((flags & HD_OMIT_COUNT) == 0) 1233 sbuf_printf(sb, "%04x ", i); 1234 1235 if ((flags & HD_OMIT_HEX) == 0) { 1236 for (j = 0; j < cols; j++) { 1237 k = i + j; 1238 if (k < length) 1239 sbuf_printf(sb, "%c%02x", delim, cp[k]); 1240 else 1241 sbuf_printf(sb, " "); 1242 } 1243 } 1244 1245 if ((flags & HD_OMIT_CHARS) == 0) { 1246 sbuf_printf(sb, " |"); 1247 for (j = 0; j < cols; j++) { 1248 k = i + j; 1249 if (k >= length) 1250 sbuf_printf(sb, " "); 1251 else if (cp[k] >= ' ' && cp[k] <= '~') 1252 sbuf_printf(sb, "%c", cp[k]); 1253 else 1254 sbuf_printf(sb, "."); 1255 } 1256 sbuf_printf(sb, "|"); 1257 } 1258 sbuf_printf(sb, "\n"); 1259 } 1260 } 1261 1262 #ifdef _KERNEL 1263 void 1264 counted_warning(unsigned *counter, const char *msg) 1265 { 1266 struct thread *td; 1267 unsigned c; 1268 1269 for (;;) { 1270 c = *counter; 1271 if (c == 0) 1272 break; 1273 if (atomic_cmpset_int(counter, c, c - 1)) { 1274 td = curthread; 1275 log(LOG_INFO, "pid %d (%s) %s%s\n", 1276 td->td_proc->p_pid, td->td_name, msg, 1277 c > 1 ? "" : " - not logging anymore"); 1278 break; 1279 } 1280 } 1281 } 1282 #endif 1283 1284 #ifdef _KERNEL 1285 void 1286 sbuf_putbuf(struct sbuf *sb) 1287 { 1288 1289 prf_putbuf(sbuf_data(sb), TOLOG | TOCONS, -1); 1290 } 1291 #else 1292 void 1293 sbuf_putbuf(struct sbuf *sb) 1294 { 1295 1296 printf("%s", sbuf_data(sb)); 1297 } 1298 #endif 1299 1300 int 1301 sbuf_printf_drain(void *arg, const char *data, int len) 1302 { 1303 size_t *retvalptr; 1304 int r; 1305 #ifdef _KERNEL 1306 char *dataptr; 1307 char oldchr; 1308 1309 /* 1310 * This is allowed as an extra byte is always resvered for 1311 * terminating NUL byte. Save and restore the byte because 1312 * we might be flushing a record, and there may be valid 1313 * data after the buffer. 1314 */ 1315 oldchr = data[len]; 1316 dataptr = __DECONST(char *, data); 1317 dataptr[len] = '\0'; 1318 1319 prf_putbuf(dataptr, TOLOG | TOCONS, -1); 1320 r = len; 1321 1322 dataptr[len] = oldchr; 1323 1324 #else /* !_KERNEL */ 1325 1326 r = printf("%.*s", len, data); 1327 if (r < 0) 1328 return (-errno); 1329 1330 #endif 1331 1332 retvalptr = arg; 1333 if (retvalptr != NULL) 1334 *retvalptr += r; 1335 1336 return (r); 1337 } 1338