--- np2/i386c/ia32/instructions/fpu/fpdummy.c	2004/03/26 06:33:53	1.7
+++ np2/i386c/ia32/instructions/fpu/fpdummy.c	2012/01/29 03:22:24	1.12
@@ -1,5 +1,3 @@
-/*	$Id: fpdummy.c,v 1.7 2004/03/26 06:33:53 yui Exp $	*/
-
 #include "compiler.h"
 #include "cpu.h"
 #include "ia32.mcr"
@@ -7,21 +5,17 @@
 
 
 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);
 	}
 }
 
@@ -31,8 +25,9 @@ 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) {
@@ -48,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);
 	}
 }
 
@@ -61,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);
 	}
 }
 
@@ -74,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);
 	}
 }
 
@@ -87,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);
 	}
 }
 
@@ -100,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);
 	}
 }
 
@@ -113,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);
 	}
 }