*/
#include <acess.h>
#include <proc.h>
+#include <mm_virt.h>
+#include <threads_int.h> // Needed for SSE handling
+
+#define MAX_BACKTRACE 6
// === IMPORTS ===
-void MM_PageFault(tVAddr Addr, Uint ErrorCode, tRegs *Regs);
+extern int MM_PageFault(tVAddr Addr, Uint ErrorCode, tRegs *Regs);
+extern void Error_Backtrace(Uint IP, Uint BP);
+extern void Proc_EnableSSE(void);
+extern void Proc_RestoreSSE(Uint32 Data);
// === PROTOTYPES ===
void Error_Handler(tRegs *Regs);
void Error_Handler(tRegs *Regs)
{
Uint cr;
+
+ if( Regs->IntNum == 7 )
+ {
+ tThread *thread = Proc_GetCurThread();
+ if(!thread->SavedState.bSSEModified)
+ {
+ Proc_EnableSSE();
+ if(!thread->SavedState.SSE)
+ thread->SavedState.SSE = malloc(sizeof(tSSEState) + 0xF);
+ else
+ Proc_RestoreSSE( ((Uint)thread->SavedState.SSE + 0xF) & ~0xF );
+ thread->SavedState.bSSEModified = 1;
+// __asm__ __volatile__ ("sti");
+ return ;
+ }
+ // oops, SSE enabled but a #NM, bad news
+ }
if( Regs->IntNum == 14 ) {
__asm__ __volatile__ ("mov %%cr2, %0":"=r"(cr));
- MM_PageFault(cr, Regs->ErrorCode, Regs);
- return ;
+ if( MM_PageFault(cr, Regs->ErrorCode, Regs) == 0 )
+ return ;
+ }
+ else {
+ Debug_KernelPanic();
+
+ Error_Backtrace(Regs->RIP, Regs->RBP);
}
-
- Debug_KernelPanic();
Log("CPU Error %x, Code: 0x%x", Regs->IntNum, Regs->ErrorCode);
Log(" - %s", csaERROR_NAMES[Regs->IntNum]);
- Log(" CS:RIP = 0x%04x:%016x", Regs->CS, Regs->RIP);
- Log(" SS:RSP = 0x%04x:%016x", Regs->SS, Regs->RSP);
- Log(" RFLAGS = 0x%016x", Regs->RFlags);
+ Log(" CS:RIP = 0x%04x:%016llx", Regs->CS, Regs->RIP);
+ Log(" SS:RSP = 0x%04x:%016llx", Regs->SS, Regs->RSP);
+ Log(" RFLAGS = 0x%016llx", Regs->RFlags);
- Log(" RAX %016x RCX %016x RDX %016x RBX %016x",
+ Log(" RAX %016llx RCX %016llx RDX %016llx RBX %016llx",
Regs->RAX, Regs->RCX, Regs->RDX, Regs->RBX);
- Log(" RSP %016x RBP %016x RSI %016x RDI %016x",
+ Log(" RSP %016llx RBP %016llx RSI %016llx RDI %016llx",
Regs->RSP, Regs->RBP, Regs->RSP, Regs->RDI);
- Log(" R8 %016x R9 %016x R10 %016x R11 %016x",
+ Log(" R8 %016llx R9 %016llx R10 %016llx R11 %016llx",
Regs->R8, Regs->R9, Regs->R10, Regs->R11);
- Log(" R12 %016x R13 %016x R14 %016x R15 %016x",
+ Log(" R12 %016llx R13 %016llx R14 %016llx R15 %016llx",
Regs->R12, Regs->R13, Regs->R14, Regs->R15);
Log(" FS %04x GS %04x", Regs->FS, Regs->GS);
__asm__ __volatile__ ("mov %%cr0, %0":"=r"(cr));
Warning(" CR0 0x%08x", cr);
__asm__ __volatile__ ("mov %%cr2, %0":"=r"(cr));
- Warning(" CR2 0x%08x", cr);
+ Warning(" CR2 0x%016llx", cr);
__asm__ __volatile__ ("mov %%cr3, %0":"=r"(cr));
- Warning(" CR3 0x%08x", cr);
+ Warning(" CR3 0x%016llx", cr);
__asm__ __volatile__ ("mov %%cr4, %0":"=r"(cr));
Warning(" CR4 0x%08x", cr);
{
case 6: // #UD
Warning(" Offending bytes: %02x %02x %02x %02x",
- *(Uint8*)Regs->RIP+0, *(Uint8*)Regs->RIP+1,
- *(Uint8*)Regs->RIP+2, *(Uint8*)Regs->RIP+3);
+ *(Uint8*)(Regs->RIP+0), *(Uint8*)(Regs->RIP+1),
+ *(Uint8*)(Regs->RIP+2), *(Uint8*)(Regs->RIP+3)
+ );
break;
}
for(;;)
__asm__ __volatile__ ("hlt");
}
+
+/**
+ * \fn void Error_Backtrace(Uint eip, Uint ebp)
+ * \brief Unrolls the stack to trace execution
+ * \param eip Current Instruction Pointer
+ * \param ebp Current Base Pointer (Stack Frame)
+ */
+void Error_Backtrace(Uint IP, Uint BP)
+{
+ int i = 0;
+
+ //if(eip < 0xC0000000 && eip > 0x1000)
+ //{
+ // LogF("Backtrace: User - 0x%x\n", eip);
+ // return;
+ //}
+
+ if( IP > USER_MAX && IP < MM_KERNEL_CODE
+ && (MM_MODULE_MIN > IP || IP > MM_MODULE_MAX)
+ )
+ {
+ LogF("Backtrace: Data Area - %p\n", IP);
+ return;
+ }
+
+ //str = Debug_GetSymbol(eip, &delta);
+ //if(str == NULL)
+ LogF("Backtrace: %p", IP);
+ //else
+ // LogF("Backtrace: %s+0x%x", str, delta);
+ if( !MM_GetPhysAddr(BP) )
+ {
+ LogF("\nBacktrace: Invalid BP, stopping\n");
+ return;
+ }
+
+
+ while( MM_GetPhysAddr(BP) && MM_GetPhysAddr(BP+8+7) && i < MAX_BACKTRACE )
+ {
+ //str = Debug_GetSymbol(*(Uint*)(ebp+4), &delta);
+ //if(str == NULL)
+ LogF(" >> 0x%llx", ((Uint*)BP)[1]);
+ //else
+ // LogF(" >> %s+0x%x", str, delta);
+ BP = ((Uint*)BP)[0];
+ i++;
+ }
+ LogF("\n");
+}