#include <stdarg.h>
#include <machine/machine_routines.h>
#include <pexpert/protos.h>
#include <pexpert/pexpert.h>
#include <pexpert/ppc/powermac.h>
#include <pexpert/device_tree.h>
#include <kern/debug.h>
#include <kern/simple_lock.h>
#include <vm/pmap.h>
extern void scc_putc(int unit, int line, int c);
extern long strtol(const char *, char **, int);
void (*PE_kputc)(char c);
unsigned int disable_serial_output = TRUE;
vm_offset_t scc = 0;
struct slock kprintf_lock;
void PE_init_kprintf(__unused boolean_t vm_initialized)
{
unsigned int boot_arg;
int32_t serial_baud = -1;
unsigned int size;
DTEntry options;
char *str, baud[7];
if (PE_state.initialized == FALSE)
panic("Platform Expert not initialized");
if (PE_parse_boot_arg("debug", &boot_arg))
if(boot_arg & DB_KPRT) disable_serial_output = FALSE;
if (DTLookupEntry(NULL, "/options", &options) == kSuccess) {
if (DTGetProperty(options, "input-device", (void **)&str, &size) == kSuccess) {
if ((size > 5) && !strncmp("scca:", str, 5)) {
size -= 5;
str += 5;
if (size <= 6) {
strncpy(baud, str, size);
baud[size] = '\0';
gPESerialBaud = strtol(baud, NULL, 0);
}
}
}
if (DTGetProperty(options, "output-device", (void **)&str, &size) == kSuccess) {
if ((size > 5) && !strncmp("scca:", str, 5)) {
size -= 5;
str += 5;
if (size <= 6) {
strncpy(baud, str, size);
baud[size] = '\0';
gPESerialBaud = strtol(baud, NULL, 0);
}
}
}
}
if (PE_parse_boot_arg("serialbaud", &serial_baud))
if (serial_baud != -1) gPESerialBaud = serial_baud;
if( (scc = PE_find_scc())) {
scc = io_map_spec(scc, 0x1000, VM_WIMG_IO);
initialize_serial((void *)scc, gPESerialBaud);
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)
{
scc_putc(0, 1, c);
if (c == '\n')
scc_putc(0, 1, '\r');
}
void kprintf(const char *fmt, ...)
{
va_list listp;
boolean_t state;
state = ml_set_interrupts_enabled(FALSE);
simple_lock(&kprintf_lock);
if (!disable_serial_output) {
va_start(listp, fmt);
_doprnt(fmt, &listp, PE_kputc, 16);
va_end(listp);
}
simple_unlock(&kprintf_lock);
ml_set_interrupts_enabled(state);
}