--- np2/i286a/i286a_mn.s	2003/12/20 10:27:55	1.14
+++ np2/i286a/i286a_mn.s	2005/05/16 04:55:13	1.29
@@ -5,11 +5,11 @@
 	INCLUDE		i286aop.inc
 	INCLUDE		i286aio.inc
 
-	IMPORT		i286core
+	IMPORT		i286acore
 	IMPORT		iflags
 	IMPORT		i286a_localint
 	IMPORT		i286a_trapint
-	EXPORT		i286a_trapintr
+	IMPORT		i286a_selector
 	IMPORT		i286a_ea
 	IMPORT		i286a_lea
 	IMPORT		i286a_a
@@ -24,7 +24,7 @@
 	IMPORT		iocore_out8
 	IMPORT		iocore_out16
 
-	IMPORT		dmap_i286
+	IMPORT		dmax86
 	IMPORT		biosfunc
 
 	IMPORT		i286a_cts
@@ -96,7 +96,7 @@ adc_r16_ea		OP_R16_EA	ADC16, #2, #7
 adc_al_d8		OP_AL_D8	ADC8, #3
 adc_ax_d16		OP_AX_D16	ADC16, #3
 push_ss			REGPUSH		#CPU_SS, #3
-pop_ss			SEGPOPFIX	#CPU_SS, #CPU_SS_BASE, #CPU_SS_FIX, #5
+; pop_ss
 
 sbb_ea_r8		OP_EA_R8	SBB8, #2, #7
 sbb_ea_r16		OP_EA_R16	SBB16, #2, #7
@@ -105,7 +105,7 @@ sbb_r16_ea		OP_R16_EA	SBB16, #2, #7
 sbb_al_d8		OP_AL_D8	SBB8, #3
 sbb_ax_d16		OP_AX_D16	SBB16, #3
 push_ds			REGPUSH		#CPU_DS, #3
-pop_ds			SEGPOPFIX	#CPU_DS, #CPU_DS_BASE, #CPU_DS_FIX, #5
+; pop_ds		SEGPOPFIX	#CPU_DS, #CPU_DS_BASE, #CPU_DS_FIX, #5
 
 and_ea_r8		OP_EA_R8	AND8, #2, #7
 and_ea_r16		OP_EA_R16	AND16, #2, #7
@@ -134,8 +134,8 @@ xor_ax_d16		OP_AX_D16	XOR16, #3
 ; segprefix_ss		!
 ; aaa			*
 
-cmp_ea_r8		S_EA_R8		SUB8, #2, #7
-cmp_ea_r16		S_EA_R16	SUB16, #2, #7
+cmp_ea_r8		S_EA_R8		SUB8, #2, #6
+cmp_ea_r16		S_EA_R16	SUB16, #2, #6
 cmp_r8_ea		S_R8_EA		SUB8, #2, #6
 cmp_r16_ea		S_R16_EA	SUB16, #2, #6
 cmp_al_d8		S_AL_D8		SUB8, #3
@@ -190,18 +190,18 @@ pop_di			REGPOP		#CPU_DI, #5
 ; outsb			*
 ; outsw			*
 
-jo_short		JMPNE		#O_FLAG, #2, #7
-jno_short		JMPEQ		#O_FLAG, #2, #7
-jc_short		JMPNE		#C_FLAG, #2, #7
-jnc_short		JMPEQ		#C_FLAG, #2, #7
-jz_short		JMPNE		#Z_FLAG, #2, #7
-jnz_short		JMPEQ		#Z_FLAG, #2, #7
-jna_short		JMPNE		#(Z_FLAG + C_FLAG), #2, #7
-ja_short		JMPEQ		#(Z_FLAG + C_FLAG), #2, #7
-js_short		JMPNE		#S_FLAG, #2, #7
-jns_short		JMPEQ		#S_FLAG, #2, #7
-jp_short		JMPNE		#P_FLAG, #2, #7
-jnp_short		JMPEQ		#P_FLAG, #2, #7
+jo_short		JMPNE		#O_FLAG, #3, #7
+jno_short		JMPEQ		#O_FLAG, #3, #7
+jc_short		JMPNE		#C_FLAG, #3, #7
+jnc_short		JMPEQ		#C_FLAG, #3, #7
+jz_short		JMPNE		#Z_FLAG, #3, #7
+jnz_short		JMPEQ		#Z_FLAG, #3, #7
+jna_short		JMPNE		#(Z_FLAG + C_FLAG), #3, #7
+ja_short		JMPEQ		#(Z_FLAG + C_FLAG), #3, #7
+js_short		JMPNE		#S_FLAG, #3, #7
+jns_short		JMPEQ		#S_FLAG, #3, #7
+jp_short		JMPNE		#P_FLAG, #3, #7
+jnp_short		JMPEQ		#P_FLAG, #3, #7
 ; jl_short		+
 ; jnl_short		+
 ; jle_short		+
@@ -341,6 +341,12 @@ reserved		mov		r6, #6
 				sub		r8, r8, #(1 << 16)
 				b		i286a_localint
 
+pop_ss			SEGPOPFIX	#CPU_SS, #CPU_SS_BASE, #CPU_SS_FIX, #5
+				NEXT_OPCODE
+
+pop_ds			SEGPOPFIX	#CPU_DS, #CPU_DS_BASE, #CPU_DS_FIX, #5
+				mov		pc, r11
+
 daa				ldrb	r0, [r9, #CPU_AL]
 				bic		r8, r8, #O_FLAG
 				CPUWORK	#3
@@ -465,11 +471,11 @@ pusha			ldrh	r4, [r9, #CPU_SP]
 				strh	r0, [r9, #CPU_SP]
 				mov		pc, r11
 
-popa			ldrh	r4, [r9, #CPU_SP]
+popa			ldrh	r1, [r9, #CPU_SP]
 				ldr		r5, [r9, #CPU_SS_BASE]
 				CPUWORK	#19
-				add		r0, r5, r4
-				mov		r4, r4 lsl #16
+				mov		r4, r1 lsl #16
+				add		r0, r5, r1
 				bl		i286a_memoryread_w
 				add		r4, r4, #(2 << 16)
 				strh	r0, [r9, #CPU_DI]
@@ -501,11 +507,11 @@ popa			ldrh	r4, [r9, #CPU_SP]
 				strh	r0, [r9, #CPU_SP]
 				mov		pc, r11
 
-bound			GETPC8
+bound			GETPCF8
 				cmp		r0, #&c0
 				bcs		bndreg
-				CPUWORK	#13
 				R16DST	r0, r12
+				CPUWORK	#13
 				ldrh	r5, [r12, #CPU_REG]
 				bl		i286a_a
 				add		r4, r0, #2
@@ -536,7 +542,7 @@ push_d16		CPUWORK	#3
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
-imul_r_ea_d16	REG16EA	r5, #21, #24
+imul_r_ea_d16	REG16EA	r6, #21, #24
 				mov		r4, r0, lsl #16
 				GETPC16
 				mov		r0, r0, lsl #16
@@ -544,7 +550,7 @@ imul_r_ea_d16	REG16EA	r5, #21, #24
 				mov		r0, r0, asr #16
 				mul		r1, r0, r4
 				add		r12, r1, #&8000
-				strh	r1, [r5, #CPU_REG]
+				strh	r1, [r6, #CPU_REG]
 				movs	r12, r12 lsr #16
 				biceq	r8, r8, #O_FLAG
 				biceq	r8, r8, #C_FLAG
@@ -553,7 +559,7 @@ imul_r_ea_d16	REG16EA	r5, #21, #24
 				mov		pc, r11
 
 push_d8			CPUWORK	#3
-				GETPC8
+				GETPCF8
 				ldrh	r2, [r9, #CPU_SP]
 				ldr		r3, [r9, #CPU_SS_BASE]
 				mov		r0, r0 lsl #24
@@ -565,7 +571,7 @@ push_d8			CPUWORK	#3
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
-imul_r_ea_d8	REG16EA	r5, #21, #24
+imul_r_ea_d8	REG16EA	r6, #21, #24
 				mov		r4, r0, lsl #16
 				GETPC8
 				mov		r0, r0, lsl #24
@@ -573,7 +579,7 @@ imul_r_ea_d8	REG16EA	r5, #21, #24
 				mov		r0, r0, asr #24
 				mul		r1, r0, r4
 				add		r12, r1, #&8000
-				strh	r1, [r5, #CPU_REG]
+				strh	r1, [r6, #CPU_REG]
 				movs	r12, r12 lsr #16
 				biceq	r8, r8, #O_FLAG
 				biceq	r8, r8, #C_FLAG
@@ -585,11 +591,11 @@ insb			CPUWORK	#5
 				ldrh	r0, [r9, #CPU_DX]
 				CPUSV
 				bl		iocore_inp8
-				CPULD
 				ldrh	r2, [r9, #CPU_DI]
 				ldr		r3, [r9, #CPU_ES_BASE]
+				CPULD
 				mov		r1, r0
-				add		r0, r2, r3
+				add		r0, r3, r2
 				tst		r8, #D_FLAG
 				addeq	r2, r2, #1
 				subne	r2, r2, #1
@@ -601,11 +607,11 @@ insw			CPUWORK	#5
 				ldrh	r0, [r9, #CPU_DX]
 				CPUSV
 				bl		iocore_inp16
-				CPULD
 				ldrh	r2, [r9, #CPU_DI]
 				ldr		r3, [r9, #CPU_ES_BASE]
+				CPULD
 				mov		r1, r0
-				add		r0, r2, r3
+				add		r0, r3, r2
 				tst		r8, #D_FLAG
 				addeq	r2, r2, #2
 				subne	r2, r2, #2
@@ -616,11 +622,11 @@ insw			CPUWORK	#5
 outsb			CPUWORK	#3
 				ldrh	r1, [r9, #CPU_SI]
 				ldr		r2, [r9, #CPU_DS_FIX]
-				add		r0, r1, r2
 				tst		r8, #D_FLAG
-				addeq	r1, r1, #1
-				subne	r1, r1, #1
-				strh	r1, [r9, #CPU_SI]
+				addeq	r3, r1, #1
+				subne	r3, r1, #1
+				add		r0, r2, r1
+				strh	r3, [r9, #CPU_SI]
 				bl		i286a_memoryread
 				mov		r1, r0
 				ldr		r0, [r9, #CPU_DX]
@@ -632,11 +638,11 @@ outsb			CPUWORK	#3
 outsw			CPUWORK	#3
 				ldrh	r1, [r9, #CPU_SI]
 				ldr		r2, [r9, #CPU_DS_FIX]
-				add		r0, r1, r2
 				tst		r8, #D_FLAG
-				addeq	r1, r1, #2
-				subne	r1, r1, #2
-				strh	r1, [r9, #CPU_SI]
+				addeq	r3, r1, #2
+				subne	r3, r1, #2
+				add		r0, r2, r1
+				strh	r3, [r9, #CPU_SI]
 				bl		i286a_memoryread_w
 				mov		r1, r0
 				ldr		r0, [r9, #CPU_DX]
@@ -650,7 +656,7 @@ jle_short		tst		r8, #Z_FLAG
 jl_short		eor		r0, r8, r8 lsr #4
 				tst		r0, #S_FLAG
 				bne		jmps
-nojmps			CPUWORK	#2
+nojmps			CPUWORK	#3
 				add		r8, r8, #(1 << 16)
 				mov		pc, r11
 
@@ -665,19 +671,19 @@ jmps			JMPS	#7
 xchg_ea_r8		EAREG8	r6
 				cmp		r0, #&c0
 				bcc		xchgear8_1
-				CPUWORK	#3
-				R8SRC	r0, r5
+				R8SRC	r0, r2
 				ldrb	r0, [r6, #CPU_REG]
-				ldrb	r1, [r5, #CPU_REG]
-				strb	r0, [r5, #CPU_REG]
+				ldrb	r1, [r2, #CPU_REG]
+				CPUWORK	#3
+				strb	r0, [r2, #CPU_REG]
 				strb	r1, [r6, #CPU_REG]
 				mov		pc, r11
-xchgear8_1		CPUWORK	#5
-				bl		i286a_ea
+xchgear8_1		bl		i286a_ea
 				cmp		r0, #I286_MEMWRITEMAX
 				bcs		xchgear8_2
 				ldrb	r1, [r6, #CPU_REG]
 				ldrb	r4, [r9, r0]
+				CPUWORK	#5
 				strb	r1, [r9, r0]
 				strb	r4, [r6, #CPU_REG]
 				mov		pc, r11
@@ -685,6 +691,7 @@ xchgear8_2		mov		r5, r0
 				bl		i286a_memoryread
 				ldrb	r1, [r6, #CPU_REG]
 				strb	r0, [r6, #CPU_REG]
+				CPUWORK	#5
 				mov		r0, r5
 				mov		lr, r11
 				b		i286a_memorywrite
@@ -692,21 +699,18 @@ xchgear8_2		mov		r5, r0
 xchg_ea_r16		EAREG16	r6
 				cmp		r0, #&c0
 				bcc		xchgear16_1
-				CPUWORK	#3
-				R16SRC	r0, r5
+				R16SRC	r0, r2
 				ldrh	r0, [r6, #CPU_REG]
-				ldrh	r1, [r5, #CPU_REG]
-				strh	r0, [r5, #CPU_REG]
+				ldrh	r1, [r2, #CPU_REG]
+				CPUWORK	#3
+				strh	r0, [r2, #CPU_REG]
 				strh	r1, [r6, #CPU_REG]
 				mov		pc, r11
-xchgear16_1		CPUWORK	#5
-				bl		i286a_ea
-				tst		r0, #1
-				bne		xchgear16_2
-				cmp		r0, #I286_MEMWRITEMAX
-				bcs		xchgear16_2
+xchgear16_1		bl		i286a_ea
+				ACCWORD	r0, xchgear16_2
 				ldrh	r1, [r6, #CPU_REG]
 				ldrh	r4, [r9, r0]
+				CPUWORK	#5
 				strh	r1, [r9, r0]
 				strh	r4, [r6, #CPU_REG]
 				mov		pc, r11
@@ -714,6 +718,7 @@ xchgear16_2		mov		r5, r0
 				bl		i286a_memoryread_w
 				ldrh	r1, [r6, #CPU_REG]
 				strh	r0, [r6, #CPU_REG]
+				CPUWORK	#5
 				mov		r0, r5
 				mov		lr, r11
 				b		i286a_memorywrite_w
@@ -721,10 +726,10 @@ xchgear16_2		mov		r5, r0
 mov_ea_r8		EAREG8	r6
 				cmp		r0, #&c0
 				bcc		movear8_1
+				ldrb	r1, [r6, #CPU_REG]
+				R8SRC	r0, r2
 				CPUWORK	#3
-				R8SRC	r0, r5
-				ldrb	r0, [r6, #CPU_REG]
-				strb	r0, [r5, #CPU_REG]
+				strb	r1, [r2, #CPU_REG]
 				mov		pc, r11
 movear8_1		CPUWORK	#5
 				bl		i286a_ea
@@ -735,10 +740,10 @@ movear8_1		CPUWORK	#5
 mov_ea_r16		EAREG16	r6
 				cmp		r0, #&c0
 				bcc		movear16_1
+				ldrh	r1, [r6, #CPU_REG]
+				R16SRC	r0, r2
 				CPUWORK	#3
-				R16SRC	r0, r5
-				ldrh	r0, [r6, #CPU_REG]
-				strh	r0, [r5, #CPU_REG]
+				strh	r1, [r2, #CPU_REG]
 				mov		pc, r11
 movear16_1		CPUWORK	#5
 				bl		i286a_ea
@@ -746,61 +751,69 @@ movear16_1		CPUWORK	#5
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
-mov_r8_ea		REG8EA	r5, #2, #5
-				strb	r0, [r5, #CPU_REG]
+mov_r8_ea		REG8EA	r6, #2, #5
+				strb	r0, [r6, #CPU_REG]
 				mov		pc, r11
 
-mov_r16_ea		REG16EA	r5, #2, #5
-				strh	r0, [r5, #CPU_REG]
+mov_r16_ea		REG16EA	r6, #2, #5
+				strh	r0, [r6, #CPU_REG]
 				mov		pc, r11
 
-mov_ea_seg		GETPC8
+mov_ea_seg		GETPCF8
 				and		r1, r0, #(3 << 3)
 				add		r1, r9, r1 lsr #2
-				ldrh	r5, [r1, #CPU_SEG]
+				ldrh	r6, [r1, #CPU_SEG]
 				cmp		r0, #&c0
 				bcc		measegm
+				R16SRC	r0, r2
 				CPUWORK	#2
-				R16SRC	r0, r4
-				strh	r5, [r4, #CPU_REG]
+				strh	r6, [r2, #CPU_REG]
 				mov		pc, r11
 measegm			CPUWORK	#3
 				bl		i286a_ea
-				mov		r1, r5
+				mov		r1, r6
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
 lea_r16_ea		CPUWORK	#3
-				GETPC8
+				GETPCF8
 				cmp		r0, #&c0
 				bcs		leareg
-				R16DST	r0, r5
+				R16DST	r0, r6
 				bl		i286a_lea
-				strh	r0, [r5, #CPU_REG]
+				strh	r0, [r6, #CPU_REG]
 				mov		pc, r11
 leareg			mov		r6, #6
 				sub		r8, r8, #(2 << 16)
 				b		i286a_localint
 
-mov_seg_ea		GETPC8
-				adr		r6, msegea_tbl
+mov_seg_ea		ldrb	r6, [r9, #CPU_MSW]
+				GETPCF8
+				adr		r2, msegea_tbl
 				and		r1, r0, #(3 << 3)
-				mov		r5, r8
-				ldr		r6, [r6, r1 lsr #1]
+				tst		r6, #MSW_PE
+				orrne	r1, r1, #(4 << 3)
+				mov		r6, r8
+				ldr		r2, [r2, r1 lsr #1]
 				cmp		r0, #&c0
 				bcc		msegeam
-				CPUWORK	#2
 				R16SRC	r0, r4
+				CPUWORK	#2
 				ldrh	r0, [r4, #CPU_REG]
-				mov		pc, r6
-msegeam			CPUWORK	#5
+				mov		pc, r2
+msegeam			str		r2, [sp, #-4]!
+				CPUWORK	#5
 				bl		i286a_ea
-				bl		i286a_memoryread_w
-				mov		pc, r6
+				ldr		lr, [sp], #4
+				b		i286a_memoryread_w
 msegea_tbl		dcd		msegea_es
 				dcd		msegea_cs
 				dcd		msegea_ss
 				dcd		msegea_ds
+				dcd		msegea_es_p
+				dcd		msegea_cs
+				dcd		msegea_ss_p
+				dcd		msegea_ds_p
 msegea_es		mov		r1, r0 lsl #4
 				strh	r0, [r9, #CPU_ES]
 				str		r1, [r9, #CPU_ES_BASE]
@@ -815,17 +828,34 @@ msegea_ss		mov		r1, r0 lsl #4
 				str		r1, [r9, #CPU_SS_BASE]
 				str		r1, [r9, #CPU_SS_FIX]
 				NEXT_OPCODE
-msegea_cs		sub		r8, r5, #(2 << 16)
+
+msegea_es_p		strh	r0, [r9, #CPU_ES]
+				bl		i286a_selector
+				str		r0, [r9, #CPU_ES_BASE]
+				mov		pc, r11
+msegea_ds_p		strh	r0, [r9, #CPU_DS]
+				bl		i286a_selector
+				str		r0, [r9, #CPU_DS_BASE]
+				str		r0, [r9, #CPU_DS_FIX]
+				mov		pc, r11
+msegea_ss_p		strh	r0, [r9, #CPU_SS]
+				bl		i286a_selector
+				str		r0, [r9, #CPU_SS_BASE]
+				str		r0, [r9, #CPU_SS_FIX]
+				NEXT_OPCODE
+
+msegea_cs		sub		r8, r6, #(2 << 16)
 				mov		r6, #6
 				b		i286a_localint
 
+
 pop_ea			POP		#5
-				mov		r5, r0
-				GETPC8
+				mov		r6, r0
+				GETPCF8
 				cmp		r0, #&c0
 				bcs		popreg
 				bl		i286a_ea
-				mov		r1, r5
+				mov		r1, r6
 				mov		lr, r11
 				b		i286a_memorywrite_w
 popreg			R16SRC	r0, r1
@@ -835,7 +865,7 @@ popreg			R16SRC	r0, r1
 
 nopandbios		sub		r0, r8, #(1 << 16)
 				CPUWORK	#3
-			;	ldr		r5, [r9, #CPU_CS_BASE]
+			;;	ldr		r5, [r9, #CPU_CS_BASE]
 				add		r0, r5, r0 lsr #16
 				cmp		r0, #&0f8000
 				movcc	pc, r11
@@ -860,15 +890,15 @@ nopandbios		sub		r0, r8, #(1 << 16)
 				str		r3, [r9, #CPU_DS_FIX]
 				mov		pc, r11
 
-cbw				CPUWORK	#2
-				ldrb	r0, [r9, #CPU_AL]
+cbw				ldrb	r0, [r9, #CPU_AL]
+				CPUWORK	#2
 				mov		r1, r0 lsl #24
 				mov		r0, r1 asr #31
 				strb	r0, [r9, #CPU_AH]
 				mov		pc, r11
 
-cwd				CPUWORK	#2
-				ldrb	r0, [r9, #CPU_AH]
+cwd				ldrb	r0, [r9, #CPU_AH]
+				CPUWORK	#2
 				mov		r1, r0 lsl #24
 				mov		r0, r1 asr #31
 				strh	r0, [r9, #CPU_DX]
@@ -887,18 +917,21 @@ call_far		CPUWORK	#13
 				mov		r4, r4, lsr #16
 				mov		r1, r12 lsr #16
 				add		r0, r4, r5
-				bl		i286a_memorywrite_w			; ip
 				ldr		r5, [r9, #CPU_CS_BASE]
+				bl		i286a_memorywrite_w			; ip
 				strh	r4, [r9, #CPU_SP]
 				add		r0, r5, r8 lsr #16
 				bl		i286a_memoryread_w			; newip
 				add		r8, r8, #(2 << 16)
 				mov		r4, r0 lsl #16
 				add		r0, r5, r8 lsr #16
+				ldrb	r5, [r9, #CPU_MSW]
 				bl		i286a_memoryread_w
-				mov		r1, r0 lsl #4
 				strh	r0, [r9, #CPU_CS]
-				str		r1, [r9, #CPU_CS_BASE]
+				tst		r5, #MSW_PE
+				moveq	r0, r0 lsl #4
+				blne	i286a_selector
+				str		r0, [r9, #CPU_CS_BASE]
 				mov		r0, r8 lsl #16
 				orr		r8, r4, r0 lsr #16
 				mov		pc, r11
@@ -918,6 +951,14 @@ pushf			CPUWORK	#3
 				b		i286a_memorywrite_w
 
 popf			POP		#5
+		if 1
+				mov		r8, r8 lsr #16
+				bic		r1, r0, #&f000					; i286
+				and		r2, r0, #(I_FLAG + T_FLAG)
+				orr		r8, r1, r8 lsl #16
+				cmp		r2, #(I_FLAG + T_FLAG)
+				beq		popf_withirq
+		else
 				mov		r2, #3
 				mov		r8, r8 lsr #16
 				and		r2, r2, r0 lsr #8
@@ -926,15 +967,16 @@ popf			POP		#5
 				orr		r8, r1, r8 lsl #16
 				strb	r2, [r9, #CPU_TRAP]
 				bne		popf_withirq
+		endif
 				ldr		r0, popf_pic
 				NOINTREXIT
 popf_withirq	I286IRQCHECKTERM
 popf_pic		dcd		pic
 
-sahf			CPUWORK	#2
-				ldrb	r0, [r9, #CPU_AH]
+sahf			ldrb	r0, [r9, #CPU_AH]
+				CPUWORK	#2
 				bic		r8, r8, #&ff
-				orr		r8, r0, r8
+				orr		r8, r8, r0
 				mov		pc, r11
 
 lahf			CPUWORK	#2
@@ -943,88 +985,86 @@ lahf			CPUWORK	#2
 
 
 mov_al_m8		CPUWORK	#5
-				ldr		r5, [r9, #CPU_DS_FIX]
+				ldr		r6, [r9, #CPU_DS_FIX]
 				GETPC16
-				add		r0, r5, r0
+				add		r0, r0, r6
 				bl		i286a_memoryread
 				strb	r0, [r9, #CPU_AL]
 				mov		pc, r11
 
 mov_ax_m16		CPUWORK	#5
-				ldr		r5, [r9, #CPU_DS_FIX]
+				ldr		r6, [r9, #CPU_DS_FIX]
 				GETPC16
-				add		r0, r5, r0
+				add		r0, r0, r6
 				bl		i286a_memoryread_w
 				strh	r0, [r9, #CPU_AX]
 				mov		pc, r11
 
 mov_m8_al		CPUWORK	#5
-				ldr		r5, [r9, #CPU_DS_FIX]
+				ldr		r6, [r9, #CPU_DS_FIX]
 				GETPC16
 				ldrb	r1, [r9, #CPU_AL]
-				add		r0, r5, r0
+				add		r0, r0, r6
 				mov		lr, r11
 				b		i286a_memorywrite
 
 mov_m16_ax		CPUWORK	#5
-				ldr		r5, [r9, #CPU_DS_FIX]
+				ldr		r6, [r9, #CPU_DS_FIX]
 				GETPC16
 				ldrh	r1, [r9, #CPU_AX]
-				add		r0, r5, r0
+				add		r0, r0, r6
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
 movsb			CPUWORK	#5
-				ldrh	r5, [r9, #CPU_SI]
+				ldrh	r6, [r9, #CPU_SI]
 				ldr		r0, [r9, #CPU_DS_FIX]
 				tst		r8, #D_FLAG
 				moveq	r4, #1
 				movne	r4, #-1
-				add		r0, r5, r0
+				add		r0, r6, r0
 				bl		i286a_memoryread
 				ldrh	r3, [r9, #CPU_DI]
 				ldr		r2, [r9, #CPU_ES_BASE]
-				add		r5, r5, r4
+				add		r6, r6, r4
 				mov		r1, r0
 				add		r0, r3, r2
 				add		r3, r3, r4
-				strh	r5, [r9, #CPU_SI]
+				strh	r6, [r9, #CPU_SI]
 				strh	r3, [r9, #CPU_DI]
 				mov		lr, r11
 				b		i286a_memorywrite
 
 movsw			CPUWORK	#5
-				ldrh	r5, [r9, #CPU_SI]
+				ldrh	r6, [r9, #CPU_SI]
 				ldr		r0, [r9, #CPU_DS_FIX]
 				tst		r8, #D_FLAG
 				moveq	r4, #2
 				movne	r4, #-2
-				add		r0, r5, r0
+				add		r0, r6, r0
 				bl		i286a_memoryread_w
 				ldrh	r3, [r9, #CPU_DI]
 				ldr		r2, [r9, #CPU_ES_BASE]
-				add		r5, r5, r4
+				add		r6, r6, r4
 				mov		r1, r0
 				add		r0, r3, r2
 				add		r3, r3, r4
-				strh	r5, [r9, #CPU_SI]
+				strh	r6, [r9, #CPU_SI]
 				strh	r3, [r9, #CPU_DI]
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
-cmpsb			CPUWORK	#8
-				ldrh	r5, [r9, #CPU_SI]
+cmpsb			ldrh	r5, [r9, #CPU_SI]
 				ldr		r0, [r9, #CPU_DS_FIX]
-				;
-				;
-				add		r0, r5, r0
+				ldr		r4, [r9, #CPU_ES_BASE]
+				CPUWORK	#8
+				add		r0, r0, r5
 				bl		i286a_memoryread
-				ldr		r2, [r9, #CPU_ES_BASE]
 				ldrh	r3, [r9, #CPU_DI]
 				mov		r6, r0
 				and		r12, r8, #D_FLAG
 				mov		r12, r12 lsr #(10 - 1)
-				add		r0, r2, r3
+				add		r0, r3, r4
 				rsb		r2, r12, #1
 				add		r5, r2, r5
 				add		r3, r2, r3
@@ -1034,19 +1074,17 @@ cmpsb			CPUWORK	#8
 				SUB8	r6, r0
 				mov		pc, r11
 
-cmpsw			CPUWORK	#8
-				ldrh	r5, [r9, #CPU_SI]
+cmpsw			ldrh	r5, [r9, #CPU_SI]
 				ldr		r0, [r9, #CPU_DS_FIX]
-				;
-				;
-				add		r0, r5, r0
+				ldr		r4, [r9, #CPU_ES_BASE]
+				CPUWORK	#8
+				add		r0, r0, r5
 				bl		i286a_memoryread_w
-				ldr		r2, [r9, #CPU_ES_BASE]
 				ldrh	r3, [r9, #CPU_DI]
 				mov		r6, r0
 				and		r12, r8, #D_FLAG
 				mov		r12, r12 lsr #(10 - 2)
-				add		r0, r2, r3
+				add		r0, r3, r4
 				rsb		r2, r12, #2
 				add		r5, r2, r5
 				add		r3, r2, r3
@@ -1157,7 +1195,7 @@ ret_near		CPUWORK	#11
 				orr		r8, r8, r0 lsl #16
 				mov		pc, r11
 
-les_r16_ea		GETPC8
+les_r16_ea		GETPCF8
 				cmp		r0, #&c0
 				bcs		lr16_r
 				CPUWORK	#3
@@ -1169,16 +1207,19 @@ les_r16_ea		GETPC8
 				bl		i286a_memoryread_w
 				strh	r0, [r5, #CPU_REG]
 				add		r0, r4, r6
+				ldrb	r4, [r9, #CPU_MSW]
 				bl		i286a_memoryread_w
-				mov		r1, r0 lsl #4
 				strh	r0, [r9, #CPU_ES]
-				str		r1, [r9, #CPU_ES_BASE]
+				tst		r4, #MSW_PE
+				moveq	r0, r0 lsl #4
+				blne	i286a_selector
+				str		r0, [r9, #CPU_ES_BASE]
 				mov		pc, r11
 lr16_r			mov		r6, #6
 				sub		r8, r8, #(2 << 16)
 				b		i286a_localint
 
-lds_r16_ea		GETPC8
+lds_r16_ea		GETPCF8
 				cmp		r0, #&c0
 				bcs		lr16_r
 				CPUWORK	#3
@@ -1190,31 +1231,34 @@ lds_r16_ea		GETPC8
 				bl		i286a_memoryread_w
 				strh	r0, [r5, #CPU_REG]
 				add		r0, r4, r6
+				ldrb	r4, [r9, #CPU_MSW]
 				bl		i286a_memoryread_w
-				mov		r1, r0 lsl #4
 				strh	r0, [r9, #CPU_DS]
-				str		r1, [r9, #CPU_DS_BASE]
-				str		r1, [r9, #CPU_DS_FIX]
+				tst		r4, #MSW_PE
+				moveq	r0, r0 lsl #4
+				blne	i286a_selector
+				str		r0, [r9, #CPU_DS_BASE]
+				str		r0, [r9, #CPU_DS_FIX]
 				mov		pc, r11
 
-mov_ea8_d8		GETPC8
+mov_ea8_d8		GETPCF8
 				cmp		r0, #&c0
 				bcs		med8_r
 				CPUWORK	#3
 				bl		i286a_ea
 				mov		r4, r0
-				GETPC8
+				GETPCF8
 				mov		r1, r0
 				mov		r0, r4
 				mov		lr, r11
 				b		i286a_memorywrite
 med8_r			CPUWORK	#2
 				R8DST	r0, r4
-				GETPC8
+				GETPCF8
 				strb	r0, [r4, #CPU_REG]
 				mov		pc, r11
 
-mov_ea16_d16	GETPC8
+mov_ea16_d16	GETPCF8
 				cmp		r0, #&c0
 				bcs		med16_r
 				CPUWORK	#3
@@ -1263,7 +1307,7 @@ enterlv1		cmp		r0, #1
 				strh	r2, [r9, #CPU_SP]
 				bl		i286a_memorywrite_w
 enterlv2		mov		r1, r0, lsl #2
-				add		r1, r1, #12
+				add		r1, r1, #(12 + 4)
 				CPUWORK	r1
 				strh	r4, [r9, #CPU_BP]
 				str		r11, [sp, #-4]!
@@ -1294,20 +1338,18 @@ leave			ldrh	r1, [r9, #CPU_BP]
 				ldr		r0, [r9, #CPU_SS_BASE]
 				CPUWORK	#5
 				add		r4, r1, #2
-				add		r0, r1, r0
+				add		r0, r0, r1
 				bl		i286a_memoryread_w
 				strh	r4, [r9, #CPU_SP]
 				strh	r0, [r9, #CPU_BP]
 				mov		pc, r11
 
-ret_far_d16		CPUWORK	#15
-				GETPC16
-				mov		r6, r0
+ret_far_d16		GETPC16
 				ldrh	r4, [r9, #CPU_SP]
 				ldr		r5, [r9, #CPU_SS_BASE]
-				;
-				;
-				add		r0, r4, r5
+				mov		r6, r0
+				CPUWORK	#15
+				add		r0, r5, r4
 				add		r4, r4, #2
 				bl		i286a_memoryread_w
 				mov		r8, r8 lsl #16
@@ -1318,18 +1360,20 @@ ret_far_d16		CPUWORK	#15
 				add		r4, r4, #2
 				bl		i286a_memoryread_w
 				add		r4, r6, r4
-				mov		r1, r0 lsl #4
+				ldrb	r1, [r9, #CPU_MSW]
 				strh	r4, [r9, #CPU_SP]
 				strh	r0, [r9, #CPU_CS]
-				str		r1, [r9, #CPU_CS_BASE]
+				tst		r1, #MSW_PE
+				moveq	r0, r0 lsl #4
+				blne	i286a_selector
+				str		r0, [r9, #CPU_CS_BASE]
 				mov		pc, r11
 
-ret_far			CPUWORK	#15
-				ldrh	r4, [r9, #CPU_SP]
+ret_far			ldrh	r1, [r9, #CPU_SP]
 				ldr		r5, [r9, #CPU_SS_BASE]
-				;
-				add		r0, r4, r5
-				add		r4, r4, #2
+				CPUWORK	#15
+				add		r4, r1, #2
+				add		r0, r5, r1
 				bl		i286a_memoryread_w
 				mov		r8, r8 lsl #16
 				mov		r8, r8 lsr #16
@@ -1338,10 +1382,13 @@ ret_far			CPUWORK	#15
 				add		r0, r4, r5
 				add		r4, r4, #2
 				bl		i286a_memoryread_w
-				mov		r1, r0 lsl #4
+				ldrb	r1, [r9, #CPU_MSW]
 				strh	r4, [r9, #CPU_SP]
 				strh	r0, [r9, #CPU_CS]
-				str		r1, [r9, #CPU_CS_BASE]
+				tst		r1, #MSW_PE
+				moveq	r0, r0 lsl #4
+				blne	i286a_selector
+				str		r0, [r9, #CPU_CS_BASE]
 				mov		pc, r11
 
 int_03			CPUWORK	#3
@@ -1349,7 +1396,7 @@ int_03			CPUWORK	#3
 				b		i286a_localint
 
 int_d8			CPUWORK	#3
-				GETPC8
+				GETPCF8
 				mov		r6, r0
 				b		i286a_localint
 
@@ -1359,13 +1406,11 @@ into			CPUWORK	#4
 				mov		r6, #4
 				b		i286a_localint
 
-iret			bl		extirq_pop
-				CPUWORK	#31
-				ldrh	r1, [r9, #CPU_SP]
+iret			ldrh	r1, [r9, #CPU_SP]
 				ldr		r5, [r9, #CPU_SS_BASE]
-				;
+				CPUWORK	#31
 				add		r4, r1, #2
-				add		r0, r1, r5
+				add		r0, r5, r1
 				bl		i286a_memoryread_w
 				bic		r4, r4, #(1 << 16)
 				mov		r8, r0 lsl #16
@@ -1380,6 +1425,13 @@ iret			bl		extirq_pop
 				add		r4, r4, #2
 				bl		i286a_memoryread_w
 				strh	r4, [r9, #CPU_SP]
+		if 1
+				bic		r1, r0, #&f000
+				and		r2, r0, #(I_FLAG + T_FLAG)
+				orr		r8, r1, r8
+				cmp		r2, #(I_FLAG + T_FLAG)
+				beq		iret_withirq
+		else
 				mov		r2, #3
 				bic		r1, r0, #&f000					; i286
 				and		r2, r2, r0 lsr #8
@@ -1387,6 +1439,7 @@ iret			bl		extirq_pop
 				ands	r2, r2, r2 lsr #1
 				strb	r2, [r9, #CPU_TRAP]
 				bne		iret_withirq
+		endif
 				ldr		r0, iret_pic
 				NOINTREXIT
 iret_withirq	I286IRQCHECKTERM
@@ -1394,7 +1447,7 @@ iret_pic		dcd		pic
 
 
 aam				CPUWORK	#16
-				GETPC8
+				GETPCF8
 				movs	r0, r0 lsl #7
 				beq		aamzero
 				ldrb	r1, [r9, #CPU_AL]
@@ -1420,19 +1473,15 @@ aamzero			sub		r8, r8, #(2 << 16)
 				mov		r6, #0
 				b		i286a_localint
 
-aad				CPUWORK	#14
-				GETPC8
-				ldrh	r1, [r9, #CPU_AX]
+aad				ldrh	r6, [r9, #CPU_AX]
+				GETPCF8
+				mov		r2, r6 lsr #8
+				mla		r3, r2, r0, r6
 				bic		r8, r8, #(S_FLAG + Z_FLAG + P_FLAG)
-				;
-				mov		r2, r1 lsr #8
-				mla		r3, r2, r0, r1
-				;
 				and		r1, r3, #&ff
-				;
-				ldrb	r2, [r10, r1]
+				ldrb	r2, [r1, r10]
 				strh	r1, [r9, #CPU_AX]
-				;
+				CPUWORK	#14
 				orr		r8, r2, r8
 				mov		pc, r11
 
@@ -1454,7 +1503,7 @@ xlat			ldrb	r0, [r9, #CPU_AL]
 				mov		pc, r11
 
 esc				CPUWORK	#2
-				GETPC8
+				GETPCF8
 				cmp		r0, #&c0
 				movcs	pc, r11
 				mov		lr, r11
@@ -1508,9 +1557,9 @@ jcxz			ldrh	r0, [r9, #CPU_CX]
 				mov		pc, r11
 jcxzj			JMPS	#8
 
-in_al_d8		CPUWORK	#5
-				GETPC8
-				add		r3, r0, r8 lsr #16
+in_al_d8		GETPCF8
+				CPUWORK	#5
+				add		r3, r5, r8 lsr #16
 				CPUSV
 				str		r3, [r9, #CPU_INPUT]
 				bl		iocore_inp8
@@ -1521,7 +1570,7 @@ in_al_d8		CPUWORK	#5
 				mov		pc, r11
 
 in_ax_d8		CPUWORK	#5
-				GETPC8
+				GETPCF8
 				CPUSV
 				bl		iocore_inp16
 				CPULD
@@ -1529,7 +1578,7 @@ in_ax_d8		CPUWORK	#5
 				mov		pc, r11
 
 out_d8_al		CPUWORK	#3
-				GETPC8
+				GETPCF8
 				ldrb	r1, [r9, #CPU_AL]
 				CPUSV
 				bl		iocore_out8
@@ -1537,18 +1586,17 @@ out_d8_al		CPUWORK	#3
 				mov		pc, r11
 
 out_d8_ax		CPUWORK	#3
-				GETPC8
+				GETPCF8
 				ldrh	r1, [r9, #CPU_AX]
 				CPUSV
 				bl		iocore_out16
 				CPULD
 				mov		pc, r11
 
-call_near		CPUWORK	#7
-				GETPC16
+call_near		GETPC16
 				ldrh	r2, [r9, #CPU_SP]
 				ldr		r3, [r9, #CPU_SS_BASE]
-				;
+				CPUWORK	#7
 				sub		r1, r2, #2
 				mov		r2, r1 lsl #16
 				strh	r1, [r9, #CPU_SP]
@@ -1575,10 +1623,13 @@ jmp_far			CPUWORK	#11
 				mov		r8, r0 lsl #16
 				add		r0, r4, r5 lsr #16
 				bl		i286a_memoryread_w
+				ldrb	r1, [r9, #CPU_MSW]
 				add		r8, r8, r6 lsr #16
-				mov		r1, r0 lsl #4
 				strh	r0, [r9, #CPU_CS]
-				str		r1, [r9, #CPU_CS_BASE]
+				tst		r1, #MSW_PE
+				moveq	r0, r0 lsl #4
+				blne	i286a_selector
+				str		r0, [r9, #CPU_CS_BASE]
 				mov		pc, r11
 
 in_al_dx		CPUWORK	#5
@@ -1634,21 +1685,31 @@ stc				CPUWORK	#2
 				mov		pc, r11
 
 cli				CPUWORK	#2
+		if 1
+				bic		r8, r8, #I_FLAG
+		else
 				mov		r0, #0
 				bic		r8, r8, #I_FLAG
 				strb	r0, [r9, #CPU_TRAP]
+		endif
 				mov		pc, r11
 
 sti				CPUWORK	#2
 				tst		r8, #I_FLAG
 				bne		sti_noirq
 sti_set			orr		r8, r8, #I_FLAG
+		if 1
+				ldr		r0, sti_pic
+				tst		r8, #T_FLAG
+				bne		sti_withirq
+		else
 				mov		r1, #(T_FLAG >> 8)
 				ands	r1, r1, r8 lsr #8
 				ldr		r0, sti_pic
 				strneb	r1, [r9, #CPU_TRAP]
 				bne		sti_withirq
-				PICEXISTINTR	sti_noirq
+		endif
+				PICEXISTINTR
 				bne		sti_withirq
 sti_noirq		NEXT_OPCODE
 sti_pic			dcd		pic
@@ -1680,7 +1741,7 @@ i286a_step		stmdb	sp!, {r4 - r11, lr}
 				mov		r11, pc
 				mov		pc, r1
 
-				bl		dmap_i286
+				bl		dmax86
 				CPUSV
 				ldmia	sp!, {r4 - r11, pc}
 
@@ -1691,59 +1752,57 @@ i286a			stmdb	sp!, {r4 - r11, lr}
 				ldr		r10, ias_r10
 				CPULD
 				ldr		r5, [r9, #CPU_CS_BASE]
-				ldr		r1, [r2, #DMAC_WORKING]
+				ldrb	r1, [r2, #DMAC_WORKING]
 				and		r0, r8, #(I_FLAG + T_FLAG)
 				cmp		r0, #(I_FLAG + T_FLAG)
 				beq		i286awithtrap
 				cmp		r1, #0
 				bne		i286awithdma
-				adr		r4, optbl1
-i286a_lp		add		r0, r5, r8 lsr #16
-				bl		i286a_memoryread
+i286a_lp		adr		r4, optbl1
+				add		r0, r5, r8 lsr #16
+				GETR0
 				ldr		r1, [r4, r0 lsl #2]
 				add		r8, r8, #(1 << 16)
 				mov		r11, pc
 				mov		pc, r1
-				ldr		r7, [r9, #CPU_REMAINCLOCK]
-				ldr		r5, [r9, #CPU_CS_BASE]
-				adr		r4, optbl1
+				CPUDBGL
 				cmp		r7, #0
+				ldrgt	r5, [r9, #CPU_CS_BASE]
 				bgt		i286a_lp
 				CPUSV
 				ldmia	sp!, {r4 - r11, pc}
 
-ias_r9			dcd		i286core + CPU_SIZE
+ias_r9			dcd		i286acore + CPU_SIZE
 ias_r1			dcd		dmac
 ias_r10			dcd		iflags
 
 i286awithdma	adr		r4, optbl1
-i286awdma_lp	add		r0, r5, r8 lsr #16
-				bl		i286a_memoryread
+				add		r0, r5, r8 lsr #16
+				GETR0
 				ldr		r1, [r4, r0 lsl #2]
 				add		r8, r8, #(1 << 16)
 				mov		r11, pc
 				mov		pc, r1
-				bl		dmap_i286
-				ldr		r7, [r9, #CPU_REMAINCLOCK]
-				ldr		r5, [r9, #CPU_CS_BASE]
-				adr		r4, optbl1
+				bl		dmax86
+				CPUDBGL
 				cmp		r7, #0
-				bgt		i286awdma_lp
+				ldrgt	r5, [r9, #CPU_CS_BASE]
+				bgt		i286awithdma
 				CPUSV
 				ldmia	sp!, {r4 - r11, pc}
 
 i286awithtrap	adr		r4, optbl1
-i286awtrp_lp	add		r0, r5, r8 lsr #16
-				bl		i286a_memoryread
+				add		r0, r5, r8 lsr #16
+				GETR0
 				ldr		r1, [r4, r0 lsl #2]
 				add		r8, r8, #(1 << 16)
 				mov		r11, pc
 				mov		pc, r1
-				bl		dmap_i286
+				bl		dmax86
 				and		r0, r8, #(I_FLAG + T_FLAG)
 				cmp		r0, #(I_FLAG + T_FLAG)
-				beq		i286a_trapint
-i286a_trapintr	CPUSV
+				bleq	i286a_trapint
+				CPUSV
 				ldmia	sp!, {r4 - r11, pc}
 
 optbl1			dcd		add_ea_r8			; 00
@@ -1954,8 +2013,8 @@ optbl1			dcd		add_ea_r8			; 00
 				dcd		i286asft16_d8
 				dcd			ret_near_d16
 				dcd		ret_near
-				dcd				les_r16_ea		; (now testing i286a_a)
-				dcd				lds_r16_ea		; (now testing i286a_a)
+				dcd				les_r16_ea
+				dcd				lds_r16_ea
 				dcd			mov_ea8_d8
 				dcd			mov_ea16_d16
 				dcd		enter
@@ -2033,7 +2092,7 @@ $label		ldr		r1, [r9, $b]
 			add		r6, r6, #1
 			cmp		r6, #MAX_PREFIX
 			bcs		prefix_fault
-			bl		i286a_memoryread
+			GETR0
 			ldr		r1, [r4, r0 lsl #2]
 			add		r8, r8, #(1 << 16)
 			strb	r6, [r9, #CPU_PREFIX]
@@ -2070,7 +2129,7 @@ repne			ldrb	r6, [r9, #CPU_PREFIX]
 				add		r6, r6, #1
 				cmp		r6, #MAX_PREFIX
 				bcs		prefix_fault
-				bl		i286a_memoryread
+				GETR0
 				ldr		r1, [r4, r0 lsl #2]
 				add		r8, r8, #(1 << 16)
 				strb	r6, [r9, #CPU_PREFIX]
@@ -2360,7 +2419,7 @@ repe			ldrb	r6, [r9, #CPU_PREFIX]
 				add		r6, r6, #1
 				cmp		r6, #MAX_PREFIX
 				bcs		prefix_fault
-				bl		i286a_memoryread
+				GETR0
 				ldr		r1, [r4, r0 lsl #2]
 				add		r8, r8, #(1 << 16)
 				strb	r6, [r9, #CPU_PREFIX]