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 *
25 * Copyright 2007 Sun Microsystems, Inc. All rights reserved.
26 * Use is subject to license terms.
27 */
28
29 #include <sys/types.h>
30 #include <sys/param.h>
31 #include <sys/machparam.h>
32 #include <sys/archsystm.h>
33 #include <sys/boot_console.h>
34 #include <sys/varargs.h>
35 #include "dboot_asm.h"
36 #include "dboot_printf.h"
37 #include "dboot_xboot.h"
38
39 #ifdef __xpv
40 #include <sys/hypervisor.h>
41 #endif
42
43 /*
44 * This file provides simple output formatting via dboot_printf()
45 */
46
47 static void do_dboot_printf(char *fmt, va_list args);
48
49 static char digits[] = "0123456789abcdef";
50
51 /*
52 * Primitive version of panic, prints a message then resets the system
53 */
54 void
dboot_panic(char * fmt,...)55 dboot_panic(char *fmt, ...)
56 {
57 va_list args;
58
59 va_start(args, fmt);
60 do_dboot_printf(fmt, args);
61
62 if (boot_console_type(NULL) == CONS_SCREEN_TEXT) {
63 dboot_printf("Press any key to reboot\n");
64 (void) bcons_getchar();
65 }
66 outb(0x64, 0xfe); /* this resets the system, see pc_reset() */
67 dboot_halt(); /* just in case */
68 }
69
70 /*
71 * printf for boot code
72 */
73 void
dboot_printf(char * fmt,...)74 dboot_printf(char *fmt, ...)
75 {
76 va_list args;
77
78 va_start(args, fmt);
79 do_dboot_printf(fmt, args);
80 }
81
82
83 /*
84 * output a string
85 */
86 static void
dboot_puts(char * s)87 dboot_puts(char *s)
88 {
89 while (*s != 0) {
90 bcons_putchar(*s);
91 ++s;
92 }
93 }
94
95 static void
dboot_putnum(uint64_t x,uint_t is_signed,uint8_t base)96 dboot_putnum(uint64_t x, uint_t is_signed, uint8_t base)
97 {
98 char buffer[64]; /* digits in reverse order */
99 int i;
100
101 if (is_signed && (int64_t)x < 0) {
102 bcons_putchar('-');
103 x = -x;
104 }
105
106 for (i = -1; x != 0 && i <= 63; x /= base)
107 buffer[++i] = digits[x - ((x / base) * base)];
108
109 if (i < 0)
110 buffer[++i] = '0';
111
112 while (i >= 0)
113 bcons_putchar(buffer[i--]);
114 }
115
116 /*
117 * very primitive printf - only does %s, %d, %x, %lx, or %%
118 */
119 static void
do_dboot_printf(char * fmt,va_list args)120 do_dboot_printf(char *fmt, va_list args)
121 {
122 char *s;
123 uint64_t x;
124 uint8_t base;
125 uint8_t size;
126 uint_t is_signed = 1;
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, !is_signed, 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, is_signed, 10);
180 break;
181
182 case 'b':
183 base = 2;
184 goto unsigned_num;
185
186 case 'o':
187 base = 8;
188 goto unsigned_num;
189
190 case 'x':
191 base = 16;
192 unsigned_num:
193 if (size == 0)
194 x = va_arg(args, uint_t);
195 else if (size == sizeof (long))
196 x = va_arg(args, ulong_t);
197 else
198 x = va_arg(args, unsigned long long);
199 dboot_putnum(x, !is_signed, base);
200 break;
201
202 default:
203 dboot_puts("dboot_printf(): unknown % escape\n");
204 }
205 }
206 }
207