--- np2/i386c/ia32/interface.c	2004/03/09 18:52:12	1.18
+++ np2/i386c/ia32/interface.c	2011/12/20 02:00:32	1.30
@@ -1,5 +1,3 @@
-/*	$Id: interface.c,v 1.18 2004/03/09 18:52:12 yui Exp $	*/
-
 /*
  * Copyright (c) 2002-2003 NONAKA Kimihiro
  * All rights reserved.
@@ -12,8 +10,6 @@
  * 2. Redistributions in binary form must reproduce the above copyright
  *    notice, this list of conditions and the following disclaimer in the
  *    documentation and/or other materials provided with the distribution.
- * 3. The name of the author may not be used to endorse or promote products
- *    derived from this software without specific prior written permission.
  *
  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
@@ -30,14 +26,14 @@
 #include "compiler.h"
 #include "cpu.h"
 #include "ia32.mcr"
+#if defined(USE_FPU)
+#include "instructions/fpu/fp.h"
+#endif
 
 #include "pccore.h"
 #include "iocore.h"
-#include "dmap.h"
+#include "dmax86.h"
 #include "bios.h"
-#if defined(IA32_REBOOT_ON_PANIC)
-#include "pccore.h"
-#endif
 
 
 void
@@ -50,32 +46,37 @@ ia32_initreg(void)
 	CPU_EDX = (CPU_FAMILY << 8) | (CPU_MODEL << 4) | CPU_STEPPING;
 	CPU_EFLAG = 2;
 	CPU_CR0 = CPU_CR0_CD | CPU_CR0_NW | CPU_CR0_ET;
-#ifndef USE_FPU
+#if defined(USE_FPU)
+	CPU_CR0 |= CPU_CR0_ET;
+#else
 	CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE;
-	CPU_CR0 &= ~CPU_CR0_MP;
+	CPU_CR0 &= ~(CPU_CR0_MP | CPU_CR0_ET);
 #endif
 	CPU_MXCSR = 0x1f80;
+
+	CPU_GDTR_BASE = 0x0;
 	CPU_GDTR_LIMIT = 0xffff;
+	CPU_IDTR_BASE = 0x0;
 	CPU_IDTR_LIMIT = 0xffff;
+	CPU_LDTR_BASE = 0x0;
+	CPU_LDTR_LIMIT = 0xffff;
+	CPU_TR_BASE = 0x0;
+	CPU_TR_LIMIT = 0xffff;
 
-#if CPU_FAMILY == 4
 	CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0;
-#elif CPU_FAMILY >= 5
-	CPU_STATSAVE.cpu_regs.dr[6] = 0xffff0ff0;
-	CPU_STATSAVE.cpu_regs.dr[7] = 0x00000400;
-#endif
 
 	for (i = 0; i < CPU_SEGREG_NUM; ++i) {
-		CPU_STAT_SREG_INIT(i);
+		segdesc_init(i, 0, &CPU_STAT_SREG(i));
 	}
-	CPU_LDTR_LIMIT = 0xffff;
-	CPU_TR_LIMIT = 0xffff;
-
-	CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000);
+	LOAD_SEGREG(CPU_CS_INDEX, 0xf000);
+	CPU_STAT_CS_BASE = 0xffff0000;
 	CPU_EIP = 0xfff0;
 	CPU_ADRSMASK = 0x000fffff;
 
 	tlb_init();
+#if defined(USE_FPU)
+	fpu_init();
+#endif
 }
 
 void
@@ -95,6 +96,13 @@ ia32shut(void)
 }
 
 void
+ia32a20enable(BOOL enable)
+{
+
+	CPU_ADRSMASK = (enable)?0xffffffff:0x00ffffff;
+}
+
+void
 ia32(void)
 {
 	int rv;
@@ -121,7 +129,7 @@ ia32(void)
 	do {
 		exec_1step();
 		if (dmac.working) {
-			dmap();
+			dmax86();
 		}
 	} while (CPU_REMCLOCK > 0);
 #else
@@ -130,14 +138,14 @@ ia32(void)
 			exec_1step();
 			if (CPU_TRAP) {
 				CPU_DR6 |= CPU_DR6_BS;
-				INTERRUPT(1, TRUE, FALSE, 0);
+				INTERRUPT(1, INTR_TYPE_EXCEPTION);
 			}
-			dmap();
+			dmax86();
 		} while (CPU_REMCLOCK > 0);
 	} else if (dmac.working) {
 		do {
 			exec_1step();
-			dmap();
+			dmax86();
 		} while (CPU_REMCLOCK > 0);
 	} else {
 		do {
@@ -175,20 +183,29 @@ ia32_step(void)
 #if !defined(IA32_SUPPORT_DEBUG_REGISTER)
 		if (CPU_TRAP) {
 			CPU_DR6 |= CPU_DR6_BS;
-			INTERRUPT(1, TRUE, FALSE, 0);
+			INTERRUPT(1, INTR_TYPE_EXCEPTION);
 		}
 #endif
 		if (dmac.working) {
-			dmap();
+			dmax86();
 		}
 	} while (CPU_REMCLOCK > 0);
 }
 
 void CPUCALL
-ia32_interrupt(int vect)
+ia32_interrupt(int vect, int soft)
 {
 
-	INTERRUPT(vect, FALSE, FALSE, 0);
+//	TRACEOUT(("int (%x, %x) PE=%d VM=%d",  vect, soft, CPU_STAT_PM, CPU_STAT_VM86));
+	if (!soft) {
+		INTERRUPT(vect, INTR_TYPE_EXTINTR);
+	} else {
+		if (CPU_STAT_PM && CPU_STAT_VM86 && CPU_STAT_IOPL < CPU_IOPL3) {
+			VERBOSE(("ia32_interrupt: VM86 && IOPL < 3 && INTn"));
+			EXCEPTION(GP_EXCEPTION, 0);
+		}
+		INTERRUPT(vect, INTR_TYPE_SOFTINTR);
+	}
 }
 
 
@@ -257,18 +274,18 @@ ia32_bioscall(void)
 
 	if (!CPU_STAT_PM || CPU_STAT_VM86) {
 #if 1
-		adrs = (CPU_EIP - 1) + ((CPU_REGS_SREG(CPU_CS_INDEX)) << 4);
+		adrs = CPU_PREV_EIP + (CPU_CS << 4);
 #else
-		adrs = (CPU_EIP - 1) + CPU_STAT_CS_BASE;
+		adrs = CPU_PREV_EIP + CPU_STAT_CS_BASE;
 #endif
 		if ((adrs >= 0xf8000) && (adrs < 0x100000)) {
-			biosfunc(adrs);
-			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);
+			if (biosfunc(adrs)) {
+				/* Nothing to do */
 			}
+			LOAD_SEGREG(CPU_ES_INDEX, CPU_ES);
+			LOAD_SEGREG(CPU_CS_INDEX, CPU_CS);
+			LOAD_SEGREG(CPU_SS_INDEX, CPU_SS);
+			LOAD_SEGREG(CPU_DS_INDEX, CPU_DS);
 		}
 	}
 }