print.c revision b04ba41ea929f16cdc810888f7419a4adb2dfed6
/*
* Copyright (C) 2006-2011 Oracle Corporation
*
* This file is part of VirtualBox Open Source Edition (OSE), as
* available from http://www.virtualbox.org. This file is free software;
* you can redistribute it and/or modify it under the terms of the GNU
* General Public License (GPL) as published by the Free Software
* Foundation, in version 2 as it comes in the "COPYING" file of the
* VirtualBox OSE distribution. VirtualBox OSE is distributed in the
* hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
* --------------------------------------------------------------------
*
* This code is based on:
*
* ROM BIOS for use with Bochs/Plex86/QEMU emulation environment
*
* Copyright (C) 2002 MandrakeSoft S.A.
*
* MandrakeSoft S.A.
* 43, rue d'Aboukir
* 75002 Paris - France
* http://www.linux-mandrake.com/
* http://www.mandrakesoft.com/
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with this library; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#include <stdint.h>
#include <stdarg.h>
#include "inlines.h"
#include "biosint.h"
// Debug printf support
/* Redirect INFO output to backdoor logging port. */
#define PANIC_PORT 0x400
#define PANIC_PORT2 0x401
#define INFO_PORT 0x504
#define DEBUG_PORT 0x403
const char bios_prefix_string[] = "BIOS: ";
void wrch(uint8_t c);
#pragma aux wrch = "mov ah, 0eh" "int 10h" parm [al] modify exact [ax bx];
void send(uint16_t action, uint8_t c)
{
#if BX_DEBUG_SERIAL
if (c == '\n')
uart_tx_byte(BX_DEBUG_PORT, '\r');
uart_tx_byte(BX_DEBUG_PORT, c);
#endif
#if BX_VIRTUAL_PORTS
if (action & BIOS_PRINTF_DEBUG)
outb(DEBUG_PORT, c);
if (action & BIOS_PRINTF_INFO)
outb(INFO_PORT, c);
#endif
if (action & BIOS_PRINTF_SCREEN) {
if (c == '\n')
wrch('\r');
wrch(c);
}
}
void put_int(uint16_t action, short val, short width, bx_bool neg)
{
short nval = val / 10;
if (nval)
put_int(action, nval, width - 1, neg);
else {
while (--width > 0)
send(action, ' ');
if (neg)
send(action, '-');
}
send(action, val - (nval * 10) + '0');
}
void put_uint(uint16_t action, unsigned short val, short width, bx_bool neg)
{
unsigned short nval = val / 10;
if (nval)
put_uint(action, nval, width - 1, neg);
else {
while (--width > 0)
send(action, ' ');
if (neg)
send(action, '-');
}
send(action, val - (nval * 10) + '0');
}
void put_luint(uint16_t action, unsigned long val, short width, bx_bool neg)
{
unsigned long nval = val / 10;
if (nval)
put_luint(action, nval, width - 1, neg);
else {
while (--width > 0)
send(action, ' ');
if (neg)
send(action, '-');
}
send(action, val - (nval * 10) + '0');
}
void put_str(uint16_t action, const char __far *s)
{
uint8_t c;
while (c = *s) {
send(action, c);
s++;
}
}
void put_str_near(uint16_t action, const char __near *s)
{
uint8_t c;
while (c = *s) {
send(action, c);
s++;
}
}
//--------------------------------------------------------------------------
// bios_printf()
// A compact variable argument printf function.
//
// Supports %[format_width][length]format
// where format can be x,X,u,d,s,S,c
// and the optional length modifier is l (ell)
//--------------------------------------------------------------------------
void bios_printf(uint16_t action, const char *s, ...)
{
uint8_t c;
bx_bool in_format;
int i;
uint16_t arg, nibble, hibyte, format_width, hexadd;
va_list args;
va_start( args, s );
in_format = 0;
format_width = 0;
if ((action & BIOS_PRINTF_DEBHALT) == BIOS_PRINTF_DEBHALT) {
#if BX_VIRTUAL_PORTS
outb(PANIC_PORT2, 0x00);
#endif
bios_printf (BIOS_PRINTF_SCREEN, "FATAL: ");
}
while (c = *s) {
if ( c == '%' ) {
in_format = 1;
format_width = 0;
}
else if (in_format) {
if ( (c>='0') && (c<='9') ) {
format_width = (format_width * 10) + (c - '0');
}
else {
arg = va_arg( args, uint16_t );
if (c == 'x' || c == 'X') {
if (format_width == 0)
format_width = 4;
if (c == 'x')
hexadd = 'a';
else
hexadd = 'A';
for (i=format_width-1; i>=0; i--) {
nibble = (arg >> (4 * i)) & 0x000f;
send (action, (nibble<=9)? (nibble+'0') : (nibble-10+hexadd));
}
}
else if (c == 'u') {
put_uint(action, arg, format_width, 0);
}
else if (c == 'l') {
s++;
c = *s; /* is it ld,lx,lu? */
hibyte = va_arg( args, uint16_t );
if (c == 'd') {
if (hibyte & 0x8000)
put_luint(action, 0L-(((uint32_t) hibyte << 16) | arg), format_width-1, 1);
else
put_luint(action, ((uint32_t) hibyte << 16) | arg, format_width, 0);
}
else if (c == 'u') {
put_luint(action, ((uint32_t) hibyte << 16) | arg, format_width, 0);
}
else if (c == 'x' || c == 'X')
{
if (format_width == 0)
format_width = 8;
if (c == 'x')
hexadd = 'a';
else
hexadd = 'A';
for (i=format_width-1; i>=0; i--) {
nibble = ((((uint32_t)hibyte << 16) | arg) >> (4 * i)) & 0x000f;
send (action, (nibble<=9)? (nibble+'0') : (nibble-10+hexadd));
}
}
}
else if (c == 'd') {
if (arg & 0x8000)
put_int(action, -arg, format_width - 1, 1);
else
put_int(action, arg, format_width, 0);
}
else if (c == 's') {
put_str(action, (char *)arg);
}
else if (c == 'S') {
hibyte = arg;
arg = va_arg( args, uint16_t );
put_str(action, hibyte :> (char *)arg);
}
else if (c == 'c') {
send(action, arg);
}
else
BX_PANIC("bios_printf: unknown format\n");
in_format = 0;
}
}
else {
send(action, c);
}
++s;
}
va_end( args );
if (action & BIOS_PRINTF_HALT) {
// freeze in a busy loop.
int_disable();
halt_forever();
}
}
// End of printf support