X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Kernel%2Fdebug.c;h=857ab596db3a6f04131d837097a5e3234feb0193;hb=b3fa9a08edcbc459bd8e9df73186e292470ebfc3;hp=bd3b4074f35dd7baf1462c30eb5fcbc561c51965;hpb=f119d0e5b18b7286d04fc536a94e0f96e3c51714;p=tpg%2Facess2.git diff --git a/Kernel/debug.c b/Kernel/debug.c index bd3b4074..857ab596 100644 --- a/Kernel/debug.c +++ b/Kernel/debug.c @@ -2,19 +2,81 @@ * AcessOS Microkernel Version * debug.c */ -#include +#include #include -// === MACROS === -#define E9(ch) __asm__ __volatile__ ("outb %%al, $0xe9"::"a"(((Uint8)ch))) +#define DEBUG_TO_E9 1 +#define DEBUG_TO_SERIAL 1 +#define SERIAL_PORT 0x3F8 +#define GDB_SERIAL_PORT 0x2F8 // === IMPORTS === extern void Threads_Dump(); // === GLOBALS === int gDebug_Level = 0; + int giDebug_KTerm = -1; + int gbDebug_SerialSetup = 0; + int gbGDB_SerialSetup = 0; // === CODE === +int putDebugChar(char ch) +{ + if(!gbGDB_SerialSetup) { + outb(GDB_SERIAL_PORT + 1, 0x00); // Disable all interrupts + outb(GDB_SERIAL_PORT + 3, 0x80); // Enable DLAB (set baud rate divisor) + outb(GDB_SERIAL_PORT + 0, 0x03); // Set divisor to 3 (lo byte) 38400 baud + outb(GDB_SERIAL_PORT + 1, 0x00); // (hi byte) + outb(GDB_SERIAL_PORT + 3, 0x03); // 8 bits, no parity, one stop bit + outb(GDB_SERIAL_PORT + 2, 0xC7); // Enable FIFO with 14-byte threshold and clear it + outb(GDB_SERIAL_PORT + 4, 0x0B); // IRQs enabled, RTS/DSR set + gbDebug_SerialSetup = 1; + } + while( (inb(GDB_SERIAL_PORT + 5) & 0x20) == 0 ); + outb(GDB_SERIAL_PORT, ch); + return 0; +} +int getDebugChar() +{ + if(!gbGDB_SerialSetup) { + outb(GDB_SERIAL_PORT + 1, 0x00); // Disable all interrupts + outb(GDB_SERIAL_PORT + 3, 0x80); // Enable DLAB (set baud rate divisor) + outb(GDB_SERIAL_PORT + 0, 0x03); // Set divisor to 3 (lo byte) 38400 baud + outb(GDB_SERIAL_PORT + 1, 0x00); // (hi byte) + outb(GDB_SERIAL_PORT + 3, 0x03); // 8 bits, no parity, one stop bit + outb(GDB_SERIAL_PORT + 2, 0xC7); // Enable FIFO with 14-byte threshold and clear it + outb(GDB_SERIAL_PORT + 4, 0x0B); // IRQs enabled, RTS/DSR set + gbDebug_SerialSetup = 1; + } + while( (inb(GDB_SERIAL_PORT + 5) & 1) == 0) ; + return inb(GDB_SERIAL_PORT); +} + +static void E9(char ch) +{ + if(giDebug_KTerm != -1) + VFS_Write(giDebug_KTerm, 1, &ch); + + #if DEBUG_TO_SERIAL + if(!gbDebug_SerialSetup) { + outb(SERIAL_PORT + 1, 0x00); // Disable all interrupts + outb(SERIAL_PORT + 3, 0x80); // Enable DLAB (set baud rate divisor) + outb(SERIAL_PORT + 0, 0x03); // Set divisor to 3 (lo byte) 38400 baud + outb(SERIAL_PORT + 1, 0x00); // (hi byte) + outb(SERIAL_PORT + 3, 0x03); // 8 bits, no parity, one stop bit + outb(SERIAL_PORT + 2, 0xC7); // Enable FIFO with 14-byte threshold and clear it + outb(SERIAL_PORT + 4, 0x0B); // IRQs enabled, RTS/DSR set + gbDebug_SerialSetup = 1; + } + while( (inb(SERIAL_PORT + 5) & 0x20) == 0 ); + outb(SERIAL_PORT, ch); + #endif + + #if DEBUG_TO_E9 + __asm__ __volatile__ ( "outb %%al, $0xe9" :: "a"(((Uint8)ch)) ); + #endif +} + static void E9_Str(char *Str) { while(*Str) E9(*Str++); @@ -28,7 +90,7 @@ void E9_Fmt(const char *format, va_list *args) char *p = NULL; int isLongLong = 0; Uint64 arg; - + while((c = *format++) != 0) { // Non control character @@ -36,15 +98,15 @@ void E9_Fmt(const char *format, va_list *args) E9(c); continue; } - + c = *format++; - + // Literal % if(c == '%') { E9('%'); continue; } - + // Pointer if(c == 'p') { Uint ptr = va_arg(*args, Uint); @@ -53,17 +115,17 @@ void E9_Fmt(const char *format, va_list *args) itoa(p, ptr, 16, BITS/4, '0'); goto printString; } - + // Get Argument arg = va_arg(*args, Uint); - + // Padding if(c == '0') { pad = '0'; c = *format++; } else pad = ' '; - + // Minimum length minSize = 1; if('1' <= c && c <= '9') @@ -76,7 +138,7 @@ void E9_Fmt(const char *format, va_list *args) c = *format++; } } - + // Long (default) isLongLong = 0; if(c == 'l') { @@ -89,7 +151,7 @@ void E9_Fmt(const char *format, va_list *args) isLongLong = 1; } } - + p = tmpBuf; switch (c) { case 'd': @@ -117,14 +179,25 @@ void E9_Fmt(const char *format, va_list *args) if(arg) E9_Str("True"); else E9_Str("False"); break; - + case 's': p = (char*)(Uint)arg; printString: if(!p) p = "(null)"; while(*p) E9(*p++); break; - + + // Single Character / Array + case 'c': + if(minSize == 1) { + E9(arg); + break; + } + p = (char*)(Uint)arg; + if(!p) goto printString; + while(minSize--) E9(*p++); + break; + default: E9(arg); break; } } @@ -145,11 +218,11 @@ void LogV(char *Fmt, va_list Args) void LogF(char *Fmt, ...) { va_list args; - + va_start(args, Fmt); - + E9_Fmt(Fmt, &args); - + va_end(args); } /** @@ -158,7 +231,7 @@ void LogF(char *Fmt, ...) void Log(char *Fmt, ...) { va_list args; - + E9_Str("Log: "); va_start(args, Fmt); E9_Fmt(Fmt, &args); @@ -182,26 +255,34 @@ void Panic(char *Fmt, ...) E9_Fmt(Fmt, &args); va_end(args); E9('\n'); - + Threads_Dump(); - + __asm__ __volatile__ ("xchg %bx, %bx"); __asm__ __volatile__ ("cli;\n\thlt"); for(;;) __asm__ __volatile__ ("hlt"); } +void Debug_SetKTerminal(char *File) +{ + if(giDebug_KTerm != -1) + VFS_Close(giDebug_KTerm); + giDebug_KTerm = VFS_Open(File, VFS_OPENFLAG_WRITE); + Log("Opened '%s' as 0x%x", File, giDebug_KTerm); +} + void Debug_Enter(char *FuncName, char *ArgTypes, ...) { va_list args; int i = gDebug_Level ++; int pos; - + va_start(args, ArgTypes); - + while(i--) E9(' '); - + E9_Str(FuncName); E9_Str(": ("); - + while(*ArgTypes) { pos = strpos(ArgTypes, ' '); @@ -226,11 +307,11 @@ void Debug_Enter(char *FuncName, char *ArgTypes, ...) if(pos != -1) { E9(','); E9(' '); } - + if(pos == -1) break; ArgTypes = &ArgTypes[pos+1]; } - + va_end(args); E9(')'); E9('\n'); } @@ -239,14 +320,14 @@ void Debug_Log(char *FuncName, char *Fmt, ...) { va_list args; int i = gDebug_Level; - + va_start(args, Fmt); - + while(i--) E9(' '); - + E9_Str(FuncName); E9_Str(": "); E9_Fmt(Fmt, &args); - + va_end(args); E9('\n'); } @@ -255,20 +336,24 @@ void Debug_Leave(char *FuncName, char RetType, ...) { va_list args; int i = --gDebug_Level; - + va_start(args, RetType); - + + if( i == -1 ) { + gDebug_Level = 0; + i = 0; + } // Indenting while(i--) E9(' '); - + E9_Str(FuncName); E9_Str(": RETURN"); - + // No Return if(RetType == '-') { E9('\n'); return; } - + E9(' '); switch(RetType) { @@ -282,7 +367,7 @@ void Debug_Leave(char *FuncName, char RetType, ...) case 'X': E9_Fmt("0x%llx", &args); break; } E9('\n'); - + va_end(args); } @@ -292,7 +377,7 @@ void Debug_HexDump(char *Header, void *Data, Uint Length) Uint pos = 0; E9_Str(Header); LogF(" (Hexdump of %p)\n", Data); - + while(Length >= 16) { Log("%04x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", @@ -304,20 +389,20 @@ void Debug_HexDump(char *Header, void *Data, Uint Length) cdat += 16; pos += 16; } - + LogF("Log: %04x: ", pos); while(Length) { Uint byte = *cdat; LogF("%02x ", byte); Length--; - cdat --; + cdat ++; } E9('\n'); - } // --- EXPORTS --- +EXPORT(Log); EXPORT(Warning); EXPORT(Debug_Enter); EXPORT(Debug_Log);