--- np2/i386c/ia32/instructions/bit_byte.c	2003/12/08 00:55:32	1.1
+++ np2/i386c/ia32/instructions/bit_byte.c	2004/02/11 07:55:04	1.4
@@ -1,4 +1,4 @@
-/*	$Id: bit_byte.c,v 1.1 2003/12/08 00:55:32 yui Exp $	*/
+/*	$Id: bit_byte.c,v 1.4 2004/02/11 07:55:04 monaka Exp $	*/
 
 /*
  * Copyright (c) 2002-2003 NONAKA Kimihiro
@@ -33,6 +33,14 @@
 
 #include "bit_byte.h"
 
+#define	BIT_OFFSET16(v)		(2 * (((SWORD)(v)) / 16))
+#define	BIT_INDEX16(v)		((v) & 0xf)
+#define	BIT_MAKEBIT16(v)	(1 << BIT_INDEX16(v))
+
+#define	BIT_OFFSET32(v)		(4 * (((SDWORD)(v)) / 32))
+#define	BIT_INDEX32(v)		((v) & 0x1f)
+#define	BIT_MAKEBIT32(v)	(1 << BIT_INDEX32(v))
+
 
 /*
  * BT
@@ -40,7 +48,7 @@
 void
 BT_EwGw(void)
 {
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, madr;
 
 	PREPART_EA_REG16(op, src);
 	if (op >= 0xc0) {
@@ -49,21 +57,17 @@ BT_EwGw(void)
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
-	}
-	if (dst & (1 << (src & 0x0f))) {
-		CPU_FLAGL |= C_FLAG;
-	} else {
-		CPU_FLAGL &= ~C_FLAG;
+		madr += BIT_OFFSET16(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
 	}
+	CPU_FLAGL &= ~C_FLAG;
+	CPU_FLAGL |= (dst >> BIT_INDEX16(src)) & 1;
 }
 
 void
 BT_EdGd(void)
 {
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, madr;
 
 	PREPART_EA_REG32(op, src);
 	if (op >= 0xc0) {
@@ -72,61 +76,49 @@ BT_EdGd(void)
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
-	}
-	if (dst & (1 << (src & 0x1f))) {
-		CPU_FLAGL |= C_FLAG;
-	} else {
-		CPU_FLAGL &= ~C_FLAG;
+		madr += BIT_OFFSET32(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
 	}
+	CPU_FLAGL &= ~C_FLAG;
+	CPU_FLAGL |= (dst >> BIT_INDEX32(src)) & 1;
 }
 
 void
 BT_EwIb(DWORD op)
 {
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, madr;
 
-	GET_PCBYTE(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		dst = *(reg16_b20[op]);
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
-	}
-	if (dst & (1 << (src & 0x0f))) {
-		CPU_FLAGL |= C_FLAG;
-	} else {
-		CPU_FLAGL &= ~C_FLAG;
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
 	}
+	CPU_FLAGL &= ~C_FLAG;
+	CPU_FLAGL |= (dst >> BIT_INDEX16(src)) & 1;
 }
 
 void
 BT_EdIb(DWORD op)
 {
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, madr;
 
-	GET_PCBYTE(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		dst = *(reg32_b20[op]);
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
-	}
-	if (dst & (1 << (src & 0x1f))) {
-		CPU_FLAGL |= C_FLAG;
-	} else {
-		CPU_FLAGL &= ~C_FLAG;
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
 	}
+	CPU_FLAGL &= ~C_FLAG;
+	CPU_FLAGL |= (dst >> BIT_INDEX32(src)) & 1;
 }
 
 /*
@@ -136,33 +128,34 @@ void
 BTS_EwGw(void)
 {
 	WORD *out;
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, res, madr;
 	WORD bit;
 
 	PREPART_EA_REG16(op, src);
-	bit = 1 << (src & 0x0f);
+	bit = BIT_MAKEBIT16(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		out = reg16_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			*out |= bit;
 			CPU_FLAGL &= ~C_FLAG;
+			res = dst | bit;
+			*out = res;
 		}
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
+		madr += BIT_OFFSET16(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			dst |= bit;
-			cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst | bit;
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)res);
 	}
 }
 
@@ -170,33 +163,34 @@ void
 BTS_EdGd(void)
 {
 	DWORD *out;
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, res, madr;
 	DWORD bit;
 
 	PREPART_EA_REG32(op, src);
-	bit = 1 << (src & 0x1f);
+	bit = BIT_MAKEBIT32(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		out = reg32_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			*out |= bit;
 			CPU_FLAGL &= ~C_FLAG;
+			res = dst | bit;
+			*out = res;
 		}
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
+		madr += BIT_OFFSET32(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			dst |= bit;
-			cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst | bit;
+		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr, res);
 	}
 }
 
@@ -204,33 +198,35 @@ void
 BTS_EwIb(DWORD op)
 {
 	WORD *out;
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, res, madr;
 	WORD bit;
 
-	GET_PCBYTE(src);
-	bit = 1 << (src & 0x0f);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		out = reg16_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		bit = BIT_MAKEBIT16(src);
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			*out |= bit;
 			CPU_FLAGL &= ~C_FLAG;
+			res = dst | bit;
+			*out = res;
 		}
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
+		bit = BIT_MAKEBIT16(src);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			dst |= bit;
-			cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst | bit;
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)res);
 	}
 }
 
@@ -238,33 +234,35 @@ void
 BTS_EdIb(DWORD op)
 {
 	DWORD *out;
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, res, madr;
 	DWORD bit;
 
-	GET_PCBYTE(src);
-	bit = 1 << (src & 0x1f);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		out = reg32_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		bit = BIT_MAKEBIT32(src);
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			*out |= bit;
 			CPU_FLAGL &= ~C_FLAG;
+			res = dst | bit;
+			*out = res;
 		}
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
+		bit = BIT_MAKEBIT32(src);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
-			dst |= bit;
-			cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst | bit;
+		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr, res);
 	}
 }
 
@@ -275,33 +273,34 @@ void
 BTR_EwGw(void)
 {
 	WORD *out;
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, res, madr;
 	WORD bit;
 
 	PREPART_EA_REG16(op, src);
-	bit = 1 << (src & 0x0f);
+	bit = BIT_MAKEBIT16(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		out = reg16_b20[op];
-		if (*out & bit) {
-			*out &= ~bit;
+		dst = *out;
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
+			res = dst & ~bit;
+			*out = res;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
+		madr += BIT_OFFSET16(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
 		if (dst & bit) {
-			dst &= ~bit;
-			cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst & ~bit;
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)res);
 	}
 }
 
@@ -309,34 +308,34 @@ void
 BTR_EdGd(void)
 {
 	DWORD *out;
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, res, madr;
 	DWORD bit;
 
 	PREPART_EA_REG32(op, src);
-	bit = 1 << (src & 0x1f);
+	bit = BIT_MAKEBIT32(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		out = reg32_b20[op];
 		dst = *out;
-		if (*out & bit) {
-			*out &= ~bit;
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
+			res = dst & ~bit;
+			*out = res;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
+		madr += BIT_OFFSET32(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
 		if (dst & bit) {
-			dst &= ~bit;
-			cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst & ~bit;
+		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr, res);
 	}
 }
 
@@ -344,33 +343,35 @@ void
 BTR_EwIb(DWORD op)
 {
 	WORD *out;
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, res, madr;
 	WORD bit;
 
-	GET_PCBYTE(src);
-	bit = 1 << (src & 0x0f);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		out = reg16_b20[op];
-		if (*out & bit) {
-			*out &= ~bit;
+		dst = *out;
+		bit = BIT_MAKEBIT16(src);
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
+			res = dst & ~bit;
+			*out = res;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
+		bit = BIT_MAKEBIT16(src);
 		if (dst & bit) {
-			dst &= ~bit;
-			cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst & ~bit;
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)res);
 	}
 }
 
@@ -378,37 +379,38 @@ void
 BTR_EdIb(DWORD op)
 {
 	DWORD *out;
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, res, madr;
 	DWORD bit;
 
-	GET_PCBYTE(src);
-	bit = 1 << (src & 0x1f);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		out = reg32_b20[op];
-		if (*out & bit) {
-			*out &= ~bit;
+		dst = *out;
+		bit = BIT_MAKEBIT32(src);
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
+			res = dst & ~bit;
+			*out = res;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
+		bit = BIT_MAKEBIT32(src);
 		if (dst & bit) {
-			dst &= ~bit;
-			cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, ad, dst);
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst & ~bit;
+		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr, res);
 	}
 }
 
-
 /*
  * BTC
  */
@@ -416,32 +418,34 @@ void
 BTC_EwGw(void)
 {
 	WORD *out;
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, res, madr;
 	WORD bit;
 
 	PREPART_EA_REG16(op, src);
-	bit = 1 << (src & 0x0f);
+	bit = BIT_MAKEBIT16(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		out = reg16_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
-		*out ^= bit;
+		res = dst ^ bit;
+		*out = res;
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
-		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, ad, dst ^ bit);
+		madr += BIT_OFFSET16(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst ^ bit;
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)res);
 	}
 }
 
@@ -449,32 +453,34 @@ void
 BTC_EdGd(void)
 {
 	DWORD *out;
-	DWORD op, src, dst, madr, ad;
+	DWORD op, src, dst, res, madr;
 	DWORD bit;
 
 	PREPART_EA_REG32(op, src);
-	bit = 1 << (src & 0x1f);
+	bit = BIT_MAKEBIT32(src);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		out = reg32_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
-		*out ^= bit;
+		res = dst ^ bit;
+		*out = res;
 	} else {
 		CPU_WORKCLOCK(7);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
-		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, ad, dst ^ bit);
+		madr += BIT_OFFSET32(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst ^ bit;
+		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr, res);
 	}
 }
 
@@ -482,32 +488,35 @@ void
 BTC_EwIb(DWORD op)
 {
 	WORD *out;
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, res, madr;
 	WORD bit;
 
-	GET_PCBYTE(src);
-	bit = 1 << (src & 0x0f);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		out = reg16_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		bit = BIT_MAKEBIT16(src);
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
-		*out ^= bit;
+		res = dst ^ bit;
+		*out = res;
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
-		ad += 2 * (src >> 4);
-		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, ad);
-		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, ad, dst ^ bit);
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr);
+		bit = BIT_MAKEBIT16(src);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst ^ bit;
+		cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)res);
 	}
 }
 
@@ -515,32 +524,35 @@ void
 BTC_EdIb(DWORD op)
 {
 	DWORD *out;
-	DWORD src, dst, madr, ad;
+	DWORD src, dst, res, madr;
 	DWORD bit;
 
-	GET_PCBYTE(src);
-	bit = 1 << (src & 0x1f);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
+		GET_PCBYTE(src);
 		out = reg32_b20[op];
-		if (*out & bit) {
+		dst = *out;
+		bit = BIT_MAKEBIT32(src);
+		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
-		*out ^= bit;
+		res = dst ^ bit;
+		*out = res;
 	} else {
 		CPU_WORKCLOCK(6);
 		madr = calc_ea_dst(op);
-		ad = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
-		ad += 4 * (src >> 5);
-		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, ad);
-		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, ad, dst ^ bit);
+		GET_PCBYTE(src);
+		dst = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr);
+		bit = BIT_MAKEBIT32(src);
 		if (dst & bit) {
 			CPU_FLAGL |= C_FLAG;
 		} else {
 			CPU_FLAGL &= ~C_FLAG;
 		}
+		res = dst ^ bit;
+		cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr, res);
 	}
 }
 
@@ -559,10 +571,12 @@ BSF_GwEw(void)
 		CPU_FLAGL |= Z_FLAG;
 		/* dest reg is undefined */
 	} else {
-		for (bit = 0; (bit < 16) && !(src & (1 << bit)); bit++)
-			continue;
-		*out = (WORD)bit;
 		CPU_FLAGL &= ~Z_FLAG;
+		for (bit = 0; bit < 15; bit++) {
+			if (src & (1 << bit))
+				break;
+		}
+		*out = (WORD)bit;
 	}
 }
 
@@ -578,10 +592,12 @@ BSF_GdEd(void)
 		CPU_FLAGL |= Z_FLAG;
 		/* dest reg is undefined */
 	} else {
-		for (bit = 0; (bit < 32) && !(src & (1 << bit)); bit++)
-			continue;
-		*out = (DWORD)bit;
 		CPU_FLAGL &= ~Z_FLAG;
+		for (bit = 0; bit < 31; bit++) {
+			if (src & (1 << bit))
+				break;
+		}
+		*out = (DWORD)bit;
 	}
 }
 
@@ -600,10 +616,12 @@ BSR_GwEw(void)
 		CPU_FLAGL |= Z_FLAG;
 		/* dest reg is undefined */
 	} else {
-		for (bit = 15; (bit >= 0) && !(src & (1 << bit)); bit--)
-			continue;
-		*out = (WORD)bit;
 		CPU_FLAGL &= ~Z_FLAG;
+		for (bit = 15; bit > 0; bit--) {
+			if (src & (1 << bit))
+				break;
+		}
+		*out = (WORD)bit;
 	}
 }
 
@@ -619,10 +637,12 @@ BSR_GdEd(void)
 		CPU_FLAGL |= Z_FLAG;
 		/* dest reg is undefined */
 	} else {
-		for (bit = 31; (bit >= 0) && !(src & (1 << bit)); bit--)
-			continue;
-		*out = (DWORD)bit;
 		CPU_FLAGL &= ~Z_FLAG;
+		for (bit = 31; bit > 0; bit--) {
+			if (src & (1 << bit))
+				break;
+		}
+		*out = (DWORD)bit;
 	}
 }
 
@@ -632,10 +652,10 @@ BSR_GdEd(void)
 void
 SETO_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = CPU_OV ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -649,10 +669,10 @@ SETO_Eb(void)
 void
 SETNO_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = CPU_OV ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -666,10 +686,10 @@ SETNO_Eb(void)
 void
 SETC_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = CPU_FLAGL & C_FLAG;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -683,10 +703,10 @@ SETC_Eb(void)
 void
 SETNC_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & C_FLAG) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -700,10 +720,10 @@ SETNC_Eb(void)
 void
 SETZ_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & Z_FLAG) ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -717,10 +737,10 @@ SETZ_Eb(void)
 void
 SETNZ_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & Z_FLAG) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -734,10 +754,10 @@ SETNZ_Eb(void)
 void
 SETA_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & (Z_FLAG|C_FLAG)) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -751,10 +771,10 @@ SETA_Eb(void)
 void
 SETNA_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & (Z_FLAG|C_FLAG)) ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -768,10 +788,10 @@ SETNA_Eb(void)
 void
 SETS_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & S_FLAG) ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -785,10 +805,10 @@ SETS_Eb(void)
 void
 SETNS_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & S_FLAG) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -802,10 +822,10 @@ SETNS_Eb(void)
 void
 SETP_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & P_FLAG) ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -819,10 +839,10 @@ SETP_Eb(void)
 void
 SETNP_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (CPU_FLAGL & P_FLAG) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -836,10 +856,10 @@ SETNP_Eb(void)
 void
 SETL_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (!CPU_OV == !(CPU_FLAGL & S_FLAG)) ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -853,10 +873,10 @@ SETL_Eb(void)
 void
 SETNL_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = (!CPU_OV == !(CPU_FLAGL & S_FLAG)) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -870,10 +890,10 @@ SETNL_Eb(void)
 void
 SETLE_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = ((CPU_FLAGL & Z_FLAG) || (!CPU_OV == !(CPU_FLAGL & S_FLAG))) ? 1 : 0;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;
@@ -887,10 +907,10 @@ SETLE_Eb(void)
 void
 SETNLE_Eb(void)
 {
-	DWORD op, src, madr;
+	DWORD op, madr;
 	BYTE v = ((CPU_FLAGL & Z_FLAG) || (!CPU_OV == !(CPU_FLAGL & S_FLAG))) ? 0 : 1;
 
-	PREPART_EA_REG8(op, src);
+	GET_PCBYTE(op);
 	if (op >= 0xc0) {
 		CPU_WORKCLOCK(2);
 		*(reg8_b20[op]) = v;