--- np2/i386c/ia32/interface.c	2003/12/08 02:09:17	1.2
+++ np2/i386c/ia32/interface.c	2004/02/05 16:41:32	1.11
@@ -1,4 +1,4 @@
-/*	$Id: interface.c,v 1.2 2003/12/08 02:09:17 yui Exp $	*/
+/*	$Id: interface.c,v 1.11 2004/02/05 16:41:32 monaka Exp $	*/
 
 /*
  * Copyright (c) 2002-2003 NONAKA Kimihiro
@@ -30,20 +30,64 @@
 #include "compiler.h"
 #include "cpu.h"
 #include "ia32.mcr"
+
 #include "dmap.h"
 #include "bios.h"
+#if defined(IA32_REBOOT_ON_PANIC)
+#include "pccore.h"
+#endif
 
 
 void
-ia32reset(void)
+ia32_initreg(void)
 {
-//	cpu_init();
-#ifdef USE_FPU		// ->ia32_init
-//	fpu_init();
+	int i;
+
+	CPU_STATSAVE.cpu_inst_default.seg_base = (DWORD)-1;
+
+	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
+	CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE;
+	CPU_CR0 &= ~CPU_CR0_MP;
+#endif
+	CPU_MXCSR = 0x1f80;
+	CPU_GDTR_LIMIT = 0xffff;
+	CPU_IDTR_LIMIT = 0xffff;
+
+#if CPU_FAMILY == 4
+	CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0;
+#elif (CPU_FAMILY == 5) || (CPU_FAMILY == 6)
+	CPU_STATSAVE.cpu_regs.dr[6] = 0xffff0ff0;
+	CPU_STATSAVE.cpu_regs.dr[7] = 0x00000400;
 #endif
 
-	CPU_SET_SEGREG(CPU_CS_INDEX, 0x1fc0);
-	CPU_ADRSMASK = 0xfffff;
+	for (i = 0; i < CPU_SEGREG_NUM; ++i) {
+		CPU_STAT_SREG_INIT(i);
+	}
+	CPU_LDTR_LIMIT = 0xffff;
+	CPU_TR_LIMIT = 0xffff;
+
+	CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000);
+	CPU_EIP = 0xfff0;
+	CPU_ADRSMASK = 0x000fffff;
+}
+
+void
+ia32reset(void)
+{
+
+	memset(&i386core.s, 0, sizeof(i386core.s));
+	ia32_initreg();
+}
+
+void
+ia32shut(void)
+{
+
+	memset(&i386core.s, 0, offsetof(I386STAT, cpu_type));
+	ia32_initreg();
 }
 
 void
@@ -51,17 +95,21 @@ ia32(void)
 {
 	int rv;
 
-#if defined(WIN32)
-	rv = setjmp(exec_1step_jmpbuf);
-#else
 	rv = sigsetjmp(exec_1step_jmpbuf, 1);
-#endif
 	switch (rv) {
 	case 0:
 		break;
-	
+
+	case 1:
+		VERBOSE(("ia32: return from exception"));
+		break;
+
+	case 2:
+		VERBOSE(("ia32: return from panic"));
+		return;
+
 	default:
-		CPU_EIP = CPU_PREV_EIP;
+		VERBOSE(("ia32: return from unknown cause"));
 		break;
 	}
 
@@ -75,21 +123,24 @@ ia32withtrap(void)
 {
 	int rv;
 
-#if defined(WIN32)
-	rv = setjmp(exec_1step_jmpbuf);
-#else
 	rv = sigsetjmp(exec_1step_jmpbuf, 1);
-#endif
 	switch (rv) {
 	case 0:
 		break;
-	
+
+	case 1:
+		VERBOSE(("ia32withtrap: return from exception"));
+		break;
+
+	case 2:
+		VERBOSE(("ia32withtrap: return from panic"));
+		return;
+
 	default:
-		CPU_EIP = CPU_PREV_EIP;
+		VERBOSE(("ia32withtrap: return from unknown cause"));
 		break;
 	}
 
-
 	do {
 		exec_1step();
 		if (CPU_TRAP) {
@@ -103,21 +154,24 @@ ia32withdma(void)
 {
 	int rv;
 
-#if defined(WIN32)
-	rv = setjmp(exec_1step_jmpbuf);
-#else
 	rv = sigsetjmp(exec_1step_jmpbuf, 1);
-#endif
 	switch (rv) {
 	case 0:
 		break;
-	
+
+	case 1:
+		VERBOSE(("ia32withdma: return from exception"));
+		break;
+
+	case 2:
+		VERBOSE(("ia32withdma: return from panic"));
+		return;
+
 	default:
-		CPU_EIP = CPU_PREV_EIP;
+		VERBOSE(("ia32withdma: return from unknown cause"));
 		break;
 	}
 
-
 	do {
 		exec_1step();
 		dmap_i286();
@@ -129,21 +183,24 @@ ia32_step(void)
 {
 	int rv;
 
-#if defined(WIN32)
-	rv = setjmp(exec_1step_jmpbuf);
-#else
 	rv = sigsetjmp(exec_1step_jmpbuf, 1);
-#endif
 	switch (rv) {
 	case 0:
 		break;
-	
+
+	case 1:
+		VERBOSE(("ia32_step: return from exception"));
+		break;
+
+	case 2:
+		VERBOSE(("ia32_step: return from panic"));
+		return;
+
 	default:
-		CPU_EIP = CPU_PREV_EIP;
+		VERBOSE(("ia32_step: return from unknown cause"));
 		break;
 	}
 
-
 	do {
 		exec_1step();
 		if (CPU_TRAP) {
@@ -160,22 +217,34 @@ ia32_interrupt(BYTE vect)
 	INTERRUPT(vect, 0, 0, 0);
 }
 
+
 /*
  * error function
  */
 void
 ia32_panic(const char *str, ...)
 {
-	char buf[1024];
+	extern char *cpu_reg2str(void);
+	char buf[2048];
 	va_list ap;
+
 	va_start(ap, str);
 	vsnprintf(buf, sizeof(buf), str, ap);
 	va_end(ap);
 	strcat(buf, "\n");
+	strcat(buf, cpu_reg2str());
 
-	fprintf(stderr, buf);
+	msgbox("ia32_panic", buf);
+
+#if defined(IA32_REBOOT_ON_PANIC)
+	VERBOSE(("ia32_panic: reboot"));
+	pccore_cfgupdate();
+	pccore_reset();
+	siglongjmp(exec_1step_jmpbuf, 2);
+#else
 	__ASSERT(0);
 	exit(1);
+#endif
 }
 
 void
@@ -188,7 +257,7 @@ ia32_warning(const char *str, ...)
 	va_end(ap);
 	strcat(buf, "\n");
 
-	fprintf(stderr, buf);
+	msgbox("ia32_warning", buf);
 }
 
 void
@@ -199,33 +268,30 @@ ia32_printf(const char *str, ...)
 	va_start(ap, str);
 	vsnprintf(buf, sizeof(buf), str, ap);
 	va_end(ap);
+	strcat(buf, "\n");
 
-	fprintf(stderr, buf);
+	msgbox("ia32_printf", buf);
 }
 
+
 /*
  * bios call interface
  */
 void
 ia32_bioscall(void)
 {
+	DWORD adrs;
 
-	/* XXX */
-	if (!CPU_STAT_PM && !CPU_INST_OP32 && !CPU_INST_AS32) {
-		DWORD adrs;
-		WORD sreg;
-
-		adrs = ((CPU_IP-1) & 0xffff) + CPU_STAT_SREGBASE(CPU_CS_INDEX);
+	if (!CPU_STAT_PM || CPU_STAT_VM86) {
+		adrs = (CPU_EIP - 1) + CPU_STAT_SREGBASE(CPU_CS_INDEX);
 		if ((adrs >= 0xf8000) && (adrs < 0x100000)) {
 			biosfunc(adrs);
-			sreg = CPU_ES;
-			CPU_SET_SEGREG(CPU_ES_INDEX, sreg);
-			sreg = CPU_CS;
-			CPU_SET_SEGREG(CPU_CS_INDEX, sreg);
-			sreg = CPU_SS;
-			CPU_SET_SEGREG(CPU_SS_INDEX, sreg);
-			sreg = CPU_DS;
-			CPU_SET_SEGREG(CPU_DS_INDEX, sreg);
+			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);
+			}
 		}
 	}
 }