X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Kernel%2Farch%2Fx86_64%2Ferrors.c;h=f7da7f9f8d5a9362f7a8d1b0becc0e9fc9c0da00;hb=7aa331d83b8dd23d3ca7530fa582cec528df274a;hp=711846c81ecb8ce2cca237b5cc97bf49acea4520;hpb=273ede03312a1b5c537d250403ff11065106e186;p=tpg%2Facess2.git

diff --git a/Kernel/arch/x86_64/errors.c b/Kernel/arch/x86_64/errors.c
index 711846c8..f7da7f9f 100644
--- a/Kernel/arch/x86_64/errors.c
+++ b/Kernel/arch/x86_64/errors.c
@@ -5,12 +5,15 @@
 #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);
-void	Error_Backtrace(Uint IP, Uint BP);
+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);
@@ -31,17 +34,37 @@ const char * const csaERROR_NAMES[] = {
 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(" - %s", csaERROR_NAMES[Regs->IntNum]);
 	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);
@@ -98,8 +121,7 @@ void Error_Backtrace(Uint IP, Uint BP)
 	//	return;
 	//}
 	
-	if( IP > MM_USER_MAX
-	 && IP < MM_KERNEL_CODE
+	if( IP > USER_MAX && IP < MM_KERNEL_CODE
 	 && (MM_MODULE_MIN > IP || IP > MM_MODULE_MAX)
 		)
 	{
@@ -119,7 +141,7 @@ void Error_Backtrace(Uint IP, Uint BP)
 	}
 	
 	
-	while( MM_GetPhysAddr(BP) && i < MAX_BACKTRACE )
+	while( MM_GetPhysAddr(BP) && MM_GetPhysAddr(BP+8+7) && i < MAX_BACKTRACE )
 	{
 		//str = Debug_GetSymbol(*(Uint*)(ebp+4), &delta);
 		//if(str == NULL)