--- np2/i386c/ia32/instructions/fpu/fpdummy.c	2004/03/09 23:39:19	1.5
+++ np2/i386c/ia32/instructions/fpu/fpdummy.c	2012/01/29 03:22:24	1.12
@@ -1,26 +1,21 @@
-/*	$Id: fpdummy.c,v 1.5 2004/03/09 23:39:19 yui Exp $	*/
-
 #include "compiler.h"
 #include "cpu.h"
 #include "ia32.mcr"
+#include "fp.h"
 
 
 void
-FWAIT(void)
-{
-//	TRACEOUT(("use FPU - FWAIT"));
-}
-
-void
 ESC0(void)
 {
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU d8 %.2x", op));
+	TRACEOUT(("use FPU d8 %.2x", op));
 	if (op >= 0xc0) {
+		EXCEPTION(NM_EXCEPTION, 0);
 	} else {
 		madr = calc_ea_dst(op);
+		EXCEPTION(NM_EXCEPTION, 0);
 	}
 }
 
@@ -30,10 +25,15 @@ ESC1(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU d9 %.2x", op));
+	TRACEOUT(("use FPU d9 %.2x", op));
 	if (op >= 0xc0) {
+		EXCEPTION(NM_EXCEPTION, 0);
 	} else {
 		madr = calc_ea_dst(op);
+		if ((op & 0x38) == 0x38) {
+			TRACEOUT(("FSTCW"));
+			cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, 0xffff);
+		}
 	}
 }
 
@@ -43,10 +43,12 @@ ESC2(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU da %.2x", op));
+	TRACEOUT(("use FPU da %.2x", op));
 	if (op >= 0xc0) {
+		EXCEPTION(NM_EXCEPTION, 0);
 	} else {
 		madr = calc_ea_dst(op);
+		EXCEPTION(NM_EXCEPTION, 0);
 	}
 }
 
@@ -56,10 +58,16 @@ ESC3(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU db %.2x", op));
+	TRACEOUT(("use FPU db %.2x", op));
 	if (op >= 0xc0) {
+		if (op != 0xe3) {
+			EXCEPTION(NM_EXCEPTION, 0);
+		}
+		/* FNINIT */
+		(void)madr;
 	} else {
 		madr = calc_ea_dst(op);
+		EXCEPTION(NM_EXCEPTION, 0);
 	}
 }
 
@@ -69,10 +77,12 @@ ESC4(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU dc %.2x", op));
+	TRACEOUT(("use FPU dc %.2x", op));
 	if (op >= 0xc0) {
+		EXCEPTION(NM_EXCEPTION, 0);
 	} else {
 		madr = calc_ea_dst(op);
+		EXCEPTION(NM_EXCEPTION, 0);
 	}
 }
 
@@ -82,10 +92,17 @@ ESC5(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU dd %.2x", op));
+	TRACEOUT(("use FPU dd %.2x", op));
 	if (op >= 0xc0) {
+		EXCEPTION(NM_EXCEPTION, 0);
 	} else {
 		madr = calc_ea_dst(op);
+		if (((op >> 3) & 7) != 7) {
+			EXCEPTION(NM_EXCEPTION, 0);
+		}
+		/* FSTSW */
+		TRACEOUT(("FSTSW"));
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, 0xffff);
 	}
 }
 
@@ -95,10 +112,12 @@ ESC6(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU de %.2x", op));
+	TRACEOUT(("use FPU de %.2x", op));
 	if (op >= 0xc0) {
+		EXCEPTION(NM_EXCEPTION, 0);
 	} else {
 		madr = calc_ea_dst(op);
+		EXCEPTION(NM_EXCEPTION, 0);
 	}
 }
 
@@ -108,9 +127,16 @@ ESC7(void)
 	UINT32 op, madr;
 
 	GET_PCBYTE(op);
-//	TRACEOUT(("use FPU df %.2x", op));
+	TRACEOUT(("use FPU df %.2x", op));
 	if (op >= 0xc0) {
+		if (op != 0xe0) {
+			EXCEPTION(NM_EXCEPTION, 0);
+		}
+		/* FSTSW AX */
+		TRACEOUT(("FSTSW AX"));
+		CPU_AX = 0xffff;
 	} else {
 		madr = calc_ea_dst(op);
+		EXCEPTION(NM_EXCEPTION, 0);
 	}
 }