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
dboot_panic(char * fmt,...)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
dboot_printf(char * fmt,...)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
dboot_puts(char * s)88 dboot_puts(char *s)
89 {
90 	while (*s != 0) {
91 		bcons_putchar(*s);
92 		++s;
93 	}
94 }
95 
96 static void
dboot_putnum(uint64_t x,boolean_t is_signed,uint8_t base)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
do_dboot_printf(char * fmt,va_list args)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 }
211