VirtualBox

source: vbox/trunk/src/VBox/Devices/PC/BIOS/print.c@ 62564

Last change on this file since 62564 was 62509, checked in by vboxsync, 8 years ago

(C) 2016
  • Property svn:eol-style set to native
  • Property svn:keywords set to Author Date Id Revision
File size: 8.8 KB
Line 
1/*
2 * Copyright (C) 2006-2016 Oracle Corporation
3 *
4 * This file is part of VirtualBox Open Source Edition (OSE), as
5 * available from http://www.virtualbox.org. This file is free software;
6 * you can redistribute it and/or modify it under the terms of the GNU
7 * General Public License (GPL) as published by the Free Software
8 * Foundation, in version 2 as it comes in the "COPYING" file of the
9 * VirtualBox OSE distribution. VirtualBox OSE is distributed in the
10 * hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
11 * --------------------------------------------------------------------
12 *
13 * This code is based on:
14 *
15 * ROM BIOS for use with Bochs/Plex86/QEMU emulation environment
16 *
17 * Copyright (C) 2002 MandrakeSoft S.A.
18 *
19 * MandrakeSoft S.A.
20 * 43, rue d'Aboukir
21 * 75002 Paris - France
22 * http://www.linux-mandrake.com/
23 * http://www.mandrakesoft.com/
24 *
25 * This library is free software; you can redistribute it and/or
26 * modify it under the terms of the GNU Lesser General Public
27 * License as published by the Free Software Foundation; either
28 * version 2 of the License, or (at your option) any later version.
29 *
30 * This library is distributed in the hope that it will be useful,
31 * but WITHOUT ANY WARRANTY; without even the implied warranty of
32 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
33 * Lesser General Public License for more details.
34 *
35 * You should have received a copy of the GNU Lesser General Public
36 * License along with this library; if not, write to the Free Software
37 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
38 *
39 */
40
41
42#include <stdint.h>
43#include <stdarg.h>
44#include "inlines.h"
45#include "biosint.h"
46
47// Debug printf support
48
49/* Redirect INFO output to backdoor logging port. */
50#define INFO_PORT 0x504
51#define DEBUG_PORT 0x403
52
53const char bios_prefix_string[] = "BIOS: ";
54
55void wrch(uint8_t c);
56#pragma aux wrch = "mov ah, 0eh" "int 10h" parm [al] modify exact [ax bx];
57
58void send(uint16_t action, uint8_t c)
59{
60#if BX_DEBUG_SERIAL
61 if (c == '\n')
62 uart_tx_byte(BX_DEBUG_PORT, '\r');
63 uart_tx_byte(BX_DEBUG_PORT, c);
64#endif
65#if BX_VIRTUAL_PORTS
66 if (action & BIOS_PRINTF_DEBUG)
67 outb(DEBUG_PORT, c);
68 if (action & BIOS_PRINTF_INFO)
69 outb(INFO_PORT, c);
70#endif
71 if (action & BIOS_PRINTF_SCREEN) {
72 if (c == '\n')
73 wrch('\r');
74 wrch(c);
75 }
76}
77
78void put_int(uint16_t action, short val, short width, bx_bool neg)
79{
80 short nval = val / 10;
81 if (nval)
82 put_int(action, nval, width - 1, neg);
83 else {
84 while (--width > 0)
85 send(action, ' ');
86 if (neg)
87 send(action, '-');
88 }
89 send(action, val - (nval * 10) + '0');
90}
91
92void put_uint(uint16_t action, unsigned short val, short width, bx_bool neg)
93{
94 unsigned short nval = val / 10;
95 if (nval)
96 put_uint(action, nval, width - 1, neg);
97 else {
98 while (--width > 0)
99 send(action, ' ');
100 if (neg)
101 send(action, '-');
102 }
103 send(action, val - (nval * 10) + '0');
104}
105
106void put_luint(uint16_t action, unsigned long val, short width, bx_bool neg)
107{
108 unsigned long nval = val / 10;
109 if (nval)
110 put_luint(action, nval, width - 1, neg);
111 else {
112 while (--width > 0)
113 send(action, ' ');
114 if (neg)
115 send(action, '-');
116 }
117 send(action, val - (nval * 10) + '0');
118}
119
120void put_str(uint16_t action, const char __far *s)
121{
122 uint8_t c;
123
124 while (c = *s) {
125 send(action, c);
126 s++;
127 }
128}
129
130void put_str_near(uint16_t action, const char __near *s)
131{
132 uint8_t c;
133
134 while (c = *s) {
135 send(action, c);
136 s++;
137 }
138}
139
140
141//--------------------------------------------------------------------------
142// bios_printf()
143// A compact variable argument printf function.
144//
145// Supports %[format_width][length]format
146// where format can be x,X,u,d,s,S,c
147// and the optional length modifier is l (ell, long 32-bit) or ll
148// (long long, 64-bit).
149// Only x,X work with ll
150//--------------------------------------------------------------------------
151void bios_printf(uint16_t action, const char *s, ...)
152{
153 uint8_t c;
154 bx_bool in_format;
155 int i;
156 uint16_t arg, nibble, hibyte, format_width, hexadd;
157 va_list args;
158
159 va_start( args, s );
160
161 in_format = 0;
162 format_width = 0;
163
164 if ((action & BIOS_PRINTF_DEBHALT) == BIOS_PRINTF_DEBHALT) {
165 bios_printf (BIOS_PRINTF_SCREEN, "FATAL: ");
166 }
167
168 while (c = *s) {
169 if ( c == '%' ) {
170 in_format = 1;
171 format_width = 0;
172 }
173 else if (in_format) {
174 if ( (c>='0') && (c<='9') ) {
175 format_width = (format_width * 10) + (c - '0');
176 }
177 else {
178 arg = va_arg( args, uint16_t );
179 if (c == 'x' || c == 'X') {
180 if (format_width == 0)
181 format_width = 4;
182 if (c == 'x')
183 hexadd = 'a';
184 else
185 hexadd = 'A';
186 for (i=format_width-1; i>=0; i--) {
187 nibble = (arg >> (4 * i)) & 0x000f;
188 send (action, (nibble<=9)? (nibble+'0') : (nibble-10+hexadd));
189 }
190 }
191 else if (c == 'u') {
192 put_uint(action, arg, format_width, 0);
193 }
194 else if (c == 'l' && s[1] == 'l') {
195 uint64_t llval;
196 uint16_t __far *cp16;
197
198 s += 2;
199 c = *s;
200 cp16 = (uint16_t __far *)&llval;
201 cp16[0] = arg;
202 cp16[1] = va_arg( args, uint16_t );
203 cp16[2] = va_arg( args, uint16_t );
204 cp16[3] = va_arg( args, uint16_t );
205 if (c == 'x' || c == 'X') {
206 if (format_width == 0)
207 format_width = 16;
208 if (c == 'x')
209 hexadd = 'a';
210 else
211 hexadd = 'A';
212 for (i=format_width-1; i>=0; i--) {
213 nibble = (llval >> (i * 4)) & 0x000f;
214 send (action, (nibble<=9)? (nibble+'0') : (nibble-10+hexadd));
215 }
216 } else {
217 BX_PANIC("bios_printf: unknown %ll format\n");
218 }
219 }
220 else if (c == 'l') {
221 s++;
222 c = *s; /* is it ld,lx,lu? */
223 hibyte = va_arg( args, uint16_t );
224 if (c == 'd') {
225 if (hibyte & 0x8000)
226 put_luint(action, 0L-(((uint32_t) hibyte << 16) | arg), format_width-1, 1);
227 else
228 put_luint(action, ((uint32_t) hibyte << 16) | arg, format_width, 0);
229 }
230 else if (c == 'u') {
231 put_luint(action, ((uint32_t) hibyte << 16) | arg, format_width, 0);
232 }
233 else if (c == 'x' || c == 'X')
234 {
235 if (format_width == 0)
236 format_width = 8;
237 if (c == 'x')
238 hexadd = 'a';
239 else
240 hexadd = 'A';
241 for (i=format_width-1; i>=0; i--) {
242 nibble = ((((uint32_t)hibyte << 16) | arg) >> (4 * i)) & 0x000f;
243 send (action, (nibble<=9)? (nibble+'0') : (nibble-10+hexadd));
244 }
245 }
246 }
247 else if (c == 'd') {
248 if (arg & 0x8000)
249 put_int(action, -arg, format_width - 1, 1);
250 else
251 put_int(action, arg, format_width, 0);
252 }
253 else if (c == 's') {
254 put_str(action, (char *)arg);
255 }
256 else if (c == 'S') {
257 hibyte = arg;
258 arg = va_arg( args, uint16_t );
259 put_str(action, hibyte :> (char *)arg);
260 }
261 else if (c == 'c') {
262 send(action, arg);
263 }
264 else
265 BX_PANIC("bios_printf: unknown format\n");
266 in_format = 0;
267 }
268 }
269 else {
270 send(action, c);
271 }
272 ++s;
273 }
274 va_end( args );
275 if (action & BIOS_PRINTF_HALT) {
276 // freeze in a busy loop.
277 int_disable();
278 halt_forever();
279 }
280}
281
282// End of printf support
Note: See TracBrowser for help on using the repository browser.

© 2024 Oracle Support Privacy / Do Not Sell My Info Terms of Use Trademark Policy Automated Access Etiquette