#include <stdarg.h>
#include <machine/machine_routines.h>
#include <pexpert/protos.h>
#include <pexpert/pexpert.h>
#include <pexpert/ppc/powermac.h>
#include <kern/debug.h>
#include <kern/simple_lock.h>
extern void init_display_putc(unsigned char*, int, int);
extern void display_putc(char c);
extern int scc_putc(int unit, int line, int c);
extern void cnputc(char c);
void serial_putc(char c);
void (*PE_kputc)(char c) = 0;
unsigned int disableSerialOuput = TRUE;
vm_offset_t scc = 0;
struct slock kprintf_lock;
void PE_init_kprintf(boolean_t vm_initialized)
{
unsigned int boot_arg;
if (PE_state.initialized == FALSE)
panic("Platform Expert not initialized");
if (PE_parse_boot_arg("debug", &boot_arg))
if(boot_arg & DB_KPRT) disableSerialOuput = FALSE;
if( (scc = PE_find_scc())) {
scc = io_map_spec(scc, 0x1000);
initialize_serial((void *)scc);
PE_kputc = serial_putc;
simple_lock_init(&kprintf_lock, 0);
} else
PE_kputc = cnputc;
#if 0
switch (PE_state.debug_video.v_display) {
case kDebugTypeSerial:
PE_kputc = serial_putc;
break;
case kDebugTypeDisplay:
init_display_putc( (unsigned char*)PE_state.debug_video.v_baseAddr,
PE_state.debug_video.v_rowBytes,
PE_state.debug_video.v_height);
PE_kputc = display_putc;
break;
default:
PE_state.debug_video.v_baseAddr = 0;
}
#endif
}
void serial_putc(char c)
{
(void) scc_putc(0, 1, c);
if (c == '\n') (void) scc_putc(0, 1, '\r');
#if 0
(void) scc_putc(0, (int)PE_state.debug_video.v_baseAddr, c);
if (c == '\n') (void) scc_putc(0, (int)PE_state.debug_video.v_baseAddr, '\r');
#endif
}
void kprintf(const char *fmt, ...)
{
va_list listp;
boolean_t state;
state = ml_set_interrupts_enabled(FALSE);
simple_lock(&kprintf_lock);
if (!disableSerialOuput) {
va_start(listp, fmt);
_doprnt(fmt, &listp, PE_kputc, 16);
va_end(listp);
}
simple_unlock(&kprintf_lock);
ml_set_interrupts_enabled(state);
}