// Raw screen writing and debug output code.
//
-// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
+// Copyright (C) 2008,2009 Kevin O'Connor <kevin@koconnor.net>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "config.h" // CONFIG_*
#include "biosvar.h" // GET_GLOBAL
+struct putcinfo {
+ void (*func)(struct putcinfo *info, char c);
+};
+
+
+/****************************************************************
+ * Debug output
+ ****************************************************************/
+
#define DEBUG_PORT PORT_SERIAL1
#define DEBUG_TIMEOUT 100000
void
-debug_serial_setup()
+debug_serial_setup(void)
{
if (!CONFIG_DEBUG_SERIAL)
return;
// Make sure all serial port writes have been completely sent.
static void
-debug_serial_flush()
+debug_serial_flush(void)
{
if (!CONFIG_DEBUG_SERIAL)
return;
return;
}
-// Show a character on the screen.
+// Write a character to debug port(s).
static void
-screenc(u8 c)
+putc_debug(struct putcinfo *action, char c)
{
- if (MODE16)
- // printf is only used in 32bit code.
+ if (! CONFIG_DEBUG_LEVEL)
return;
+ if (! CONFIG_COREBOOT)
+ // Send character to debug port.
+ outb(c, PORT_BIOS_DEBUG);
+ if (c == '\n')
+ debug_serial('\r');
+ debug_serial(c);
+}
+
+// In segmented mode just need a dummy variable (putc_debug is always
+// used anyway), and in 32bit flat mode need a pointer to the 32bit
+// instance of putc_debug().
+#if MODE16
+static struct putcinfo debuginfo VAR16;
+#elif MODESEGMENT
+static struct putcinfo debuginfo VAR32SEG;
+#else
+static struct putcinfo debuginfo = { putc_debug };
+#endif
+
+
+/****************************************************************
+ * Screen writing
+ ****************************************************************/
+
+// Show a character on the screen.
+static void
+screenc(char c)
+{
struct bregs br;
memset(&br, 0, sizeof(br));
br.flags = F_IF;
call16_int(0x10, &br);
}
+// Handle a character from a printf request.
+static void
+putc_screen(struct putcinfo *action, char c)
+{
+ if (CONFIG_SCREEN_AND_DEBUG)
+ putc_debug(&debuginfo, c);
+ if (c == '\n')
+ screenc('\r');
+ screenc(c);
+}
+
+static struct putcinfo screeninfo = { putc_screen };
+
+
+/****************************************************************
+ * Xprintf code
+ ****************************************************************/
+
// Output a character.
static void
-putc(u16 action, char c)
+putc(struct putcinfo *action, char c)
{
- if (CONFIG_DEBUG_LEVEL && (CONFIG_SCREEN_AND_DEBUG || !action)) {
- if (! CONFIG_COREBOOT)
- // Send character to debug port.
- outb(c, PORT_BIOS_DEBUG);
- // Send character to serial port.
- if (c == '\n')
- debug_serial('\r');
- debug_serial(c);
+ if (MODESEGMENT) {
+ // Only debugging output supported in segmented mode.
+ putc_debug(action, c);
+ return;
}
- if (action) {
- // Send character to video screen.
- if (c == '\n')
- screenc('\r');
- screenc(c);
- }
+ void (*func)(struct putcinfo *info, char c) = GET_GLOBAL(action->func);
+ func(action, c);
}
// Ouptut a string.
static void
-puts(u16 action, const char *s)
+puts(struct putcinfo *action, const char *s)
{
for (; *s; s++)
putc(action, *s);
// Output a string that is in the CS segment.
static void
-puts_cs(u16 action, const char *s)
+puts_cs(struct putcinfo *action, const char *s)
{
- for (;; s++) {
- char c = GET_GLOBAL(*(u8*)s);
+ char *vs = (char*)s;
+ for (;; vs++) {
+ char c = GET_GLOBAL(*vs);
if (!c)
break;
putc(action, c);
// Output an unsigned integer.
static void
-putuint(u16 action, u32 val)
+putuint(struct putcinfo *action, u32 val)
{
char buf[12];
char *d = &buf[sizeof(buf) - 1];
// Output a single digit hex character.
static inline void
-putsinglehex(u16 action, u32 val)
+putsinglehex(struct putcinfo *action, u32 val)
{
if (val <= 9)
val = '0' + val;
// Output an integer in hexadecimal.
static void
-puthex(u16 action, u32 val, int width)
+puthex(struct putcinfo *action, u32 val, int width)
{
if (!width) {
u32 tmp = val;
}
static void
-bvprintf(u16 action, const char *fmt, va_list args)
+bvprintf(struct putcinfo *action, const char *fmt, va_list args)
{
const char *s = fmt;
for (;; s++) {
}
s = n;
}
- debug_serial_flush();
}
void
if (CONFIG_DEBUG_LEVEL) {
va_list args;
va_start(args, fmt);
- bvprintf(0, fmt, args);
+ bvprintf(&debuginfo, fmt, args);
va_end(args);
+ debug_serial_flush();
}
// XXX - use PANIC PORT.
void
__dprintf(const char *fmt, ...)
{
+ if (!MODESEGMENT && CONFIG_THREADS && CONFIG_DEBUG_LEVEL >= DEBUG_thread
+ && *fmt != '\\' && *fmt != '/') {
+ struct thread_info *cur = getCurThread();
+ if (cur != &MainThread) {
+ // Show "thread id" for this debug message.
+ putc_debug(&debuginfo, '|');
+ puthex(&debuginfo, (u32)cur, 8);
+ putc_debug(&debuginfo, '|');
+ putc_debug(&debuginfo, ' ');
+ }
+ }
+
va_list args;
va_start(args, fmt);
- bvprintf(0, fmt, args);
+ bvprintf(&debuginfo, fmt, args);
va_end(args);
+ debug_serial_flush();
}
void
printf(const char *fmt, ...)
{
+ ASSERT32FLAT();
+ va_list args;
+ va_start(args, fmt);
+ bvprintf(&screeninfo, fmt, args);
+ va_end(args);
+ if (CONFIG_SCREEN_AND_DEBUG)
+ debug_serial_flush();
+}
+
+
+/****************************************************************
+ * snprintf
+ ****************************************************************/
+
+struct snprintfinfo {
+ struct putcinfo info;
+ char *str, *end;
+};
+
+static void
+putc_str(struct putcinfo *info, char c)
+{
+ struct snprintfinfo *sinfo = container_of(info, struct snprintfinfo, info);
+ if (sinfo->str >= sinfo->end)
+ return;
+ *sinfo->str = c;
+ sinfo->str++;
+}
+
+// Build a formatted string. Note, this function returns the actual
+// number of bytes used (not including null) even in the overflow
+// case.
+int
+snprintf(char *str, size_t size, const char *fmt, ...)
+{
+ ASSERT32FLAT();
+ if (!size)
+ return 0;
+ struct snprintfinfo sinfo = { { putc_str }, str, str + size };
va_list args;
va_start(args, fmt);
- bvprintf(1, fmt, args);
+ bvprintf(&sinfo.info, fmt, args);
va_end(args);
+ char *end = sinfo.str;
+ if (end >= sinfo.end)
+ end = sinfo.end - 1;
+ *end = '\0';
+ return end - str;
}
+
+/****************************************************************
+ * Misc helpers
+ ****************************************************************/
+
void
hexdump(const void *d, int len)
{
int count=0;
while (len > 0) {
if (count % 8 == 0) {
- putc(0, '\n');
- puthex(0, count*4, 8);
- putc(0, ':');
+ putc(&debuginfo, '\n');
+ puthex(&debuginfo, count*4, 8);
+ putc(&debuginfo, ':');
} else {
- putc(0, ' ');
+ putc(&debuginfo, ' ');
}
- puthex(0, *(u32*)d, 8);
+ puthex(&debuginfo, *(u32*)d, 8);
count++;
len-=4;
d+=4;
}
- putc(0, '\n');
+ putc(&debuginfo, '\n');
debug_serial_flush();
}
void
__debug_isr(const char *fname)
{
- puts_cs(0, fname);
- putc(0, '\n');
+ puts_cs(&debuginfo, fname);
+ putc(&debuginfo, '\n');
debug_serial_flush();
}
dump_regs(regs);
}
-// Report on a handler returning a failure notification to the caller.
+// Report on an invalid parameter.
void
-__set_fail(struct bregs *regs, int lineno, const char *fname)
+__warn_invalid(struct bregs *regs, int lineno, const char *fname)
{
- dprintf(1, "fail %s:%d:\n", fname, lineno);
- dump_regs(regs);
- set_fail_silent(regs);
+ if (CONFIG_DEBUG_LEVEL >= DEBUG_invalid) {
+ dprintf(1, "invalid %s:%d:\n", fname, lineno);
+ dump_regs(regs);
+ }
}
-// Report on a handler returning a failure code to the caller. Note,
-// the lineno and return code are encoded in the same parameter as gcc
-// does a better job of scheduling function calls when there are 3 or
-// less parameters.
+// Report on an unimplemented feature.
void
-__set_code_fail(struct bregs *regs, u32 linecode, const char *fname)
+__warn_unimplemented(struct bregs *regs, int lineno, const char *fname)
+{
+ if (CONFIG_DEBUG_LEVEL >= DEBUG_unimplemented) {
+ dprintf(1, "unimplemented %s:%d:\n", fname, lineno);
+ dump_regs(regs);
+ }
+}
+
+// Report a handler reporting an invalid parameter to the caller.
+void
+__set_invalid(struct bregs *regs, int lineno, const char *fname)
+{
+ __warn_invalid(regs, lineno, fname);
+ set_invalid_silent(regs);
+}
+
+// Report a call of an unimplemented function.
+void
+__set_unimplemented(struct bregs *regs, int lineno, const char *fname)
+{
+ __warn_unimplemented(regs, lineno, fname);
+ set_invalid_silent(regs);
+}
+
+// Report a handler reporting an invalid parameter code to the
+// caller. Note, the lineno and return code are encoded in the same
+// parameter as gcc does a better job of scheduling function calls
+// when there are 3 or less parameters.
+void
+__set_code_invalid(struct bregs *regs, u32 linecode, const char *fname)
{
u8 code = linecode;
u32 lineno = linecode >> 8;
- dprintf(1, "fail %s:%d(%x):\n", fname, lineno, code);
- dump_regs(regs);
- set_code_fail_silent(regs, code);
+ __warn_invalid(regs, lineno, fname);
+ set_code_invalid_silent(regs, code);
+}
+
+// Report a call of an unimplemented function.
+void
+__set_code_unimplemented(struct bregs *regs, u32 linecode, const char *fname)
+{
+ u8 code = linecode;
+ u32 lineno = linecode >> 8;
+ __warn_unimplemented(regs, lineno, fname);
+ set_code_invalid_silent(regs, code);
}
projects / seabios.git / blobdiff