1 /*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21
22 /*
23 * Copyright (c) 2012 Gary Mills
24 * Copyright 2020 Joyent, Inc.
25 *
26 * Copyright 2007 Sun Microsystems, Inc. All rights reserved.
27 * Use is subject to license terms.
28 */
29
30 #include <sys/types.h>
31 #include <sys/param.h>
32 #include <sys/machparam.h>
33 #include <sys/archsystm.h>
34 #include <sys/boot_console.h>
35 #include <sys/varargs.h>
36 #include "dboot_asm.h"
37 #include "dboot_printf.h"
38 #include "dboot_xboot.h"
39
40 #ifdef __xpv
41 #include <sys/hypervisor.h>
42 #endif
43
44 /*
45 * This file provides simple output formatting via dboot_printf()
46 */
47
48 static void do_dboot_printf(char *fmt, va_list args);
49
50 static char digits[] = "0123456789abcdef";
51
52 /*
53 * Primitive version of panic, prints a message then resets the system
54 */
55 void
56 dboot_panic(char *fmt, ...)
57 {
58 va_list args;
59
60 va_start(args, fmt);
61 do_dboot_printf(fmt, args);
62
63 if (boot_console_type(NULL) == CONS_SCREEN_TEXT) {
64 dboot_printf("Press any key to reboot\n");
65 (void) bcons_getchar();
66 }
67 outb(0x64, 0xfe); /* this resets the system, see pc_reset() */
68 dboot_halt(); /* just in case */
69 }
70
71 /*
72 * printf for boot code
73 */
74 void
75 dboot_printf(char *fmt, ...)
76 {
77 va_list args;
78
79 va_start(args, fmt);
80 do_dboot_printf(fmt, args);
81 }
82
83
84 /*
85 * output a string
86 */
87 static void
88 dboot_puts(char *s)
89 {
90 while (*s != 0) {
91 bcons_putchar(*s);
92 ++s;
93 }
94 }
95
96 static void
97 dboot_putnum(uint64_t x, boolean_t is_signed, uint8_t base)
98 {
99 char buffer[64]; /* digits in reverse order */
100 int i;
101
102 if (is_signed && (int64_t)x < 0) {
103 bcons_putchar('-');
104 x = -x;
105 }
106
107 for (i = -1; x != 0 && i <= 63; x /= base)
108 buffer[++i] = digits[x - ((x / base) * base)];
109
110 if (i < 0)
111 buffer[++i] = '0';
112
113 while (i >= 0)
114 bcons_putchar(buffer[i--]);
115 }
116
117 /*
118 * Very primitive printf - only does a subset of the standard format characters.
119 */
120 static void
121 do_dboot_printf(char *fmt, va_list args)
122 {
123 char *s;
124 uint64_t x;
125 uint8_t base;
126 uint8_t size;
127
128 if (fmt == NULL) {
129 dboot_puts("dboot_printf(): 1st arg is NULL\n");
130 return;
131 }
132 for (; *fmt; ++fmt) {
133 if (*fmt != '%') {
134 bcons_putchar(*fmt);
135 continue;
136 }
137
138 size = 0;
139 again:
140 ++fmt;
141 switch (*fmt) {
142
143 case '%':
144 bcons_putchar(*fmt);
145 break;
146
147 case 'c':
148 x = va_arg(args, int);
149 bcons_putchar(x);
150 break;
151
152 case 's':
153 s = va_arg(args, char *);
154 if (s == NULL)
155 dboot_puts("*NULL*");
156 else
157 dboot_puts(s);
158 break;
159
160 case 'p':
161 x = va_arg(args, ulong_t);
162 dboot_putnum(x, B_FALSE, 16);
163 break;
164
165 case 'l':
166 if (size == 0)
167 size = sizeof (long);
168 else if (size == sizeof (long))
169 size = sizeof (long long);
170 goto again;
171
172 case 'd':
173 if (size == 0)
174 x = va_arg(args, int);
175 else if (size == sizeof (long))
176 x = va_arg(args, long);
177 else
178 x = va_arg(args, long long);
179 dboot_putnum(x, B_TRUE, 10);
180 break;
181
182 case 'u':
183 base = 10;
184 goto unsigned_num;
185
186 case 'b':
187 base = 2;
188 goto unsigned_num;
189
190 case 'o':
191 base = 8;
192 goto unsigned_num;
193
194 case 'x':
195 base = 16;
196 unsigned_num:
197 if (size == 0)
198 x = va_arg(args, uint_t);
199 else if (size == sizeof (ulong_t))
200 x = va_arg(args, ulong_t);
201 else
202 x = va_arg(args, unsigned long long);
203 dboot_putnum(x, B_FALSE, base);
204 break;
205
206 default:
207 dboot_puts("dboot_printf(): unknown % escape\n");
208 }
209 }
210 }