--- np2/i386c/ia32/instructions/fpu/fpdummy.c	2011/01/15 17:17:24	1.8
+++ np2/i386c/ia32/instructions/fpu/fpdummy.c	2012/06/18 14:13:08	1.14
@@ -5,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);
 	}
 }
 
@@ -29,13 +25,25 @@ 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) {
+		switch (op & 0x38) {
+		case 0x28:
+			TRACEOUT(("FLDCW"));
+			(void) cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
+			break;
+
+		case 0x38:
 			TRACEOUT(("FSTCW"));
 			cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, 0xffff);
+			break;
+
+		default:
+			EXCEPTION(NM_EXCEPTION, 0);
+			break;
 		}
 	}
 }
@@ -46,10 +54,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);
 	}
 }
 
@@ -59,10 +69,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);
 	}
 }
 
@@ -72,10 +88,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);
 	}
 }
 
@@ -85,10 +103,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);
 	}
 }
 
@@ -98,10 +123,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);
 	}
 }
 
@@ -111,9 +138,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);
 	}
 }