xnu-517.tar.gz

[apple/xnu.git] / pexpert / i386 / pe_kprintf.c

diff --git a/pexpert/i386/pe_kprintf.c b/pexpert/i386/pe_kprintf.c
index 3d00e68f969108423ab6e95d2c66f18b2b5f90c6..4383340f09efabba52801f6ad00b9469564b02b9 100644 (file)
--- a/pexpert/i386/pe_kprintf.c
+++ b/pexpert/i386/pe_kprintf.c
@@ -27,17 +27,24 @@
  *    i386 platform expert debugging output initialization.
  */
 #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 references */
 extern void cnputc(char c);
+extern int  serial_init(void);
+extern void serial_putc(char c);
 
 /* Globals */
 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;
@@ -47,21 +54,52 @@ void PE_init_kprintf(boolean_t vm_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;
-        
-        /* FIXME - route output to serial port. */
-        PE_kputc = cnputc;
+
+        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  /* MP_DEBUG */
+#define MP_DEBUG_KPRINTF(x...)
+#endif /* MP_DEBUG */
+
+static int cpu_last_locked = 0;
 void kprintf(const char *fmt, ...)
 {
-       va_list listp;
+       va_list   listp;
+    boolean_t state;
     
     if (!disableSerialOuput) {
+        state = ml_set_interrupts_enabled(FALSE);
+        simple_lock(&kprintf_lock);
+
+       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);
     }
 }