#include <stdarg.h>
#include <machine/machine_routines.h>
#include <pexpert/pexpert.h>
#include <kern/debug.h>
#include <kern/simple_lock.h>
#include <i386/mp.h>
extern void cnputc(char c);
extern int serial_init(void);
extern void serial_putc(char c);
void (*PE_kputc)(char c) = 0;
unsigned int disableSerialOuput = TRUE;
decl_simple_lock_data(static, 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 (!vm_initialized)
{
simple_lock_init(&kprintf_lock, 0);
if (PE_parse_boot_arg("debug", &boot_arg))
if (boot_arg & DB_KPRT) disableSerialOuput = FALSE;
if (!disableSerialOuput && serial_init())
PE_kputc = serial_putc;
else
PE_kputc = cnputc;
}
}
#ifdef MP_DEBUG
static void _kprintf(const char *format, ...)
{
va_list listp;
va_start(listp, format);
_doprnt(format, &listp, PE_kputc, 16);
va_end(listp);
}
#define MP_DEBUG_KPRINTF(x...) _kprintf(x)
#else
#define MP_DEBUG_KPRINTF(x...)
#endif
static int cpu_last_locked = 0;
void kprintf(const char *fmt, ...)
{
va_list listp;
boolean_t state;
if (!disableSerialOuput) {
state = ml_set_interrupts_enabled(FALSE);
while (!simple_lock_try(&kprintf_lock)) {
ml_set_interrupts_enabled(state);
ml_set_interrupts_enabled(FALSE);
}
if (cpu_number() != cpu_last_locked) {
MP_DEBUG_KPRINTF("[cpu%d...]\n", cpu_number());
cpu_last_locked = cpu_number();
}
va_start(listp, fmt);
_doprnt(fmt, &listp, PE_kputc, 16);
va_end(listp);
simple_unlock(&kprintf_lock);
ml_set_interrupts_enabled(state);
}
}