--- np2/i386c/ia32/interface.c	2004/01/24 18:20:06	1.8
+++ np2/i386c/ia32/interface.c	2005/02/08 09:57:26	1.22
@@ -1,4 +1,4 @@
-/*	$Id: interface.c,v 1.8 2004/01/24 18:20:06 yui Exp $	*/
+/*	$Id: interface.c,v 1.22 2005/02/08 09:57:26 yui Exp $	*/
 
 /*
  * Copyright (c) 2002-2003 NONAKA Kimihiro
@@ -31,15 +31,21 @@
 #include "cpu.h"
 #include "ia32.mcr"
 
-#include "dmap.h"
+#include "pccore.h"
+#include "iocore.h"
+#include "dmax86.h"
 #include "bios.h"
+#if defined(IA32_REBOOT_ON_PANIC)
+#include "pccore.h"
+#endif
 
 
-static void ia32_initreg(void) {
-
+void
+ia32_initreg(void)
+{
 	int i;
 
-	CPU_STATSAVE.cpu_inst_default.seg_base = (DWORD)-1;
+	CPU_STATSAVE.cpu_inst_default.seg_base = (UINT32)-1;
 
 	CPU_EDX = (CPU_FAMILY << 8) | (CPU_MODEL << 4) | CPU_STEPPING;
 	CPU_EFLAG = 2;
@@ -54,7 +60,7 @@ static void ia32_initreg(void) {
 
 #if CPU_FAMILY == 4
 	CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0;
-#elif (CPU_FAMILY == 5) || (CPU_FAMILY == 6)
+#elif CPU_FAMILY >= 5
 	CPU_STATSAVE.cpu_regs.dr[6] = 0xffff0ff0;
 	CPU_STATSAVE.cpu_regs.dr[7] = 0x00000400;
 #endif
@@ -68,48 +74,38 @@ static void ia32_initreg(void) {
 	CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000);
 	CPU_EIP = 0xfff0;
 	CPU_ADRSMASK = 0x000fffff;
+
+	tlb_init();
 }
 
 void
 ia32reset(void)
 {
-	ZeroMemory(&i386core.s, sizeof(i386core.s));
+
+	memset(&i386core.s, 0, sizeof(i386core.s));
 	ia32_initreg();
 }
 
 void
 ia32shut(void)
 {
-	ZeroMemory(&i386core.s, offsetof(I386STAT, cpu_type));
+
+	memset(&i386core.s, 0, offsetof(I386STAT, cpu_type));
 	ia32_initreg();
 }
 
 void
-ia32(void)
+ia32a20enable(BOOL enable)
 {
-	int rv;
-
-	rv = sigsetjmp(exec_1step_jmpbuf, 1);
-	switch (rv) {
-	case 0:
-		break;
-
-	case 1:
-		VERBOSE(("ia32: return from exception"));
-		break;
-
-	default:
-		VERBOSE(("ia32: return from unknown cause"));
-		break;
-	}
-
-	do {
-		exec_1step();
-	} while (CPU_REMCLOCK > 0);
+#if (CPU_FAMILY == 3)
+	CPU_ADRSMASK = (enable)?0x00ffffff:0x00ffffff;
+#else
+	CPU_ADRSMASK = (enable)?0xffffffff:0x00ffffff;
+#endif
 }
 
 void
-ia32withtrap(void)
+ia32(void)
 {
 	int rv;
 
@@ -119,45 +115,46 @@ ia32withtrap(void)
 		break;
 
 	case 1:
-		VERBOSE(("ia32withtrap: return from exception"));
+		VERBOSE(("ia32: return from exception"));
 		break;
 
+	case 2:
+		VERBOSE(("ia32: return from panic"));
+		return;
+
 	default:
-		VERBOSE(("ia32withtrap: return from unknown cause"));
+		VERBOSE(("ia32: return from unknown cause"));
 		break;
 	}
 
+#if defined(IA32_SUPPORT_DEBUG_REGISTER)
 	do {
 		exec_1step();
-		if (CPU_TRAP) {
-			ia32_interrupt(1);
+		if (dmac.working) {
+			dmax86();
 		}
 	} while (CPU_REMCLOCK > 0);
-}
-
-void
-ia32withdma(void)
-{
-	int rv;
-
-	rv = sigsetjmp(exec_1step_jmpbuf, 1);
-	switch (rv) {
-	case 0:
-		break;
-
-	case 1:
-		VERBOSE(("ia32withdma: return from exception"));
-		break;
-
-	default:
-		VERBOSE(("ia32withdma: return from unknown cause"));
-		break;
+#else
+	if (CPU_TRAP) {
+		do {
+			exec_1step();
+			if (CPU_TRAP) {
+				CPU_DR6 |= CPU_DR6_BS;
+				INTERRUPT(1, TRUE, FALSE, 0);
+			}
+			dmax86();
+		} while (CPU_REMCLOCK > 0);
+	} else if (dmac.working) {
+		do {
+			exec_1step();
+			dmax86();
+		} while (CPU_REMCLOCK > 0);
+	} else {
+		do {
+			exec_1step();
+		} while (CPU_REMCLOCK > 0);
 	}
-
-	do {
-		exec_1step();
-		dmap_i286();
-	} while (CPU_REMCLOCK > 0);
+#endif
 }
 
 void
@@ -174,6 +171,10 @@ ia32_step(void)
 		VERBOSE(("ia32_step: return from exception"));
 		break;
 
+	case 2:
+		VERBOSE(("ia32_step: return from panic"));
+		return;
+
 	default:
 		VERBOSE(("ia32_step: return from unknown cause"));
 		break;
@@ -181,18 +182,32 @@ ia32_step(void)
 
 	do {
 		exec_1step();
+#if !defined(IA32_SUPPORT_DEBUG_REGISTER)
 		if (CPU_TRAP) {
-			ia32_interrupt(1);
+			CPU_DR6 |= CPU_DR6_BS;
+			INTERRUPT(1, TRUE, FALSE, 0);
+		}
+#endif
+		if (dmac.working) {
+			dmax86();
 		}
-		dmap_i286();
 	} while (CPU_REMCLOCK > 0);
 }
 
 void CPUCALL
-ia32_interrupt(BYTE vect)
+ia32_interrupt(int vect, int soft)
 {
 
-	INTERRUPT(vect, 0, 0, 0);
+//	TRACEOUT(("int (%x, %x) PE=%d VM=%d",  vect, soft, CPU_STAT_PM, CPU_STAT_VM86));
+	if (!soft) {
+		INTERRUPT(vect, FALSE, FALSE, 0);
+	}
+	else {
+		if (CPU_STAT_VM86 && (CPU_STAT_IOPL < CPU_IOPL3) && (soft == -1)) {
+			TRACEOUT(("BIOS interrupt: VM86 && IOPL < 3 && INTn"));
+		}
+		INTERRUPT(vect, TRUE, FALSE, 0);
+	}
 }
 
 
@@ -214,8 +229,14 @@ ia32_panic(const char *str, ...)
 
 	msgbox("ia32_panic", buf);
 
+#if defined(IA32_REBOOT_ON_PANIC)
+	VERBOSE(("ia32_panic: reboot"));
+	pccore_reset();
+	siglongjmp(exec_1step_jmpbuf, 2);
+#else
 	__ASSERT(0);
 	exit(1);
+#endif
 }
 
 void
@@ -251,16 +272,24 @@ ia32_printf(const char *str, ...)
 void
 ia32_bioscall(void)
 {
-	DWORD adrs;
+	UINT32 adrs;
 
-	if (!CPU_STAT_PM && !CPU_INST_OP32 && !CPU_INST_AS32) {
-		adrs = ((CPU_IP-1) & 0xffff) + CPU_STAT_SREGBASE(CPU_CS_INDEX);
+	if (!CPU_STAT_PM || CPU_STAT_VM86) {
+#if 1
+		adrs = (CPU_EIP - 1) + ((CPU_REGS_SREG(CPU_CS_INDEX)) << 4);
+#else
+		adrs = (CPU_EIP - 1) + CPU_STAT_CS_BASE;
+#endif
 		if ((adrs >= 0xf8000) && (adrs < 0x100000)) {
-			biosfunc(adrs);
-			CPU_SET_SEGREG(CPU_ES_INDEX, CPU_ES);
-			CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS);
-			CPU_SET_SEGREG(CPU_SS_INDEX, CPU_SS);
-			CPU_SET_SEGREG(CPU_DS_INDEX, CPU_DS);
+			if (biosfunc(adrs)) {
+				CPU_PREFETCH_CLEAR();
+			}
+			if (!CPU_STAT_PM || CPU_STAT_VM86) {
+				CPU_SET_SEGREG(CPU_ES_INDEX, CPU_ES);
+				CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS);
+				CPU_SET_SEGREG(CPU_SS_INDEX, CPU_SS);
+				CPU_SET_SEGREG(CPU_DS_INDEX, CPU_DS);
+			}
 		}
 	}
 }