--- np2/i286a/i286a_0f.s	2003/12/21 23:27:08	1.4
+++ np2/i286a/i286a_0f.s	2004/01/07 06:53:47	1.5
@@ -3,6 +3,7 @@
 	INCLUDE		i286aea.inc
 	INCLUDE		i286aalu.inc
 
+	IMPORT		i286a_selector
 	IMPORT		i286a_ea
 	IMPORT		i286a_a
 	IMPORT		i286a_memoryread
@@ -19,9 +20,121 @@
 
 i286a_cts		mov		r6, r8
 				GETPCF8
+				cmp		r0, #0
+				beq		cts_0
 				cmp		r0, #1
-				bne		cts_ldall
+				beq		cts_1
+				cmp		r0, #5
+				beq		cts_ldall
+
+cts_intr		sub		r8, r6, #(1 << 16)
+				mov		r6, #6
+				b		i286a_localint
+
+cts_0			ldrh	r4, [r9, #CPU_MSW]
 				GETPCF8
+				tst		r4, #MSW_PE
+				and		r12, r0, #(7 << 3)
+				beq		cts_intr
+				add		pc, pc, r12 lsr #1
+				nop
+				b		sldt
+				b		_str
+				b		lldt
+				b		_ltr
+				b		verr
+				b		verw
+				b		verr
+				b		verw
+
+sldt			cmp		r0, #&c0
+				bcc		sldtm
+				CPUWORK	#2
+				R16SRC	r0, r5
+				ldrh	r1, [r9, #CPU_LDTR]
+				strh	r1, [r5, #CPU_REG]
+				mov		pc, r11
+sldtm			CPUWORK	#3
+				bl		i286a_ea
+				strh	r1, [r9, #CPU_LDTR]
+				mov		lr, r11
+				b		i286a_memorywrite_w
+
+_str			cmp		r0, #&c0
+				bcc		_strm
+				CPUWORK	#3
+				R16SRC	r0, r5
+				ldrh	r1, [r9, #CPU_TR]
+				strh	r1, [r5, #CPU_REG]
+				mov		pc, r11
+_strm			CPUWORK	#6
+				bl		i286a_ea
+				strh	r1, [r9, #CPU_TR]
+				mov		lr, r11
+				b		i286a_memorywrite_w
+
+lldt			cmp		r0, #&c0
+				bcc		lldtm
+				CPUWORK	#17
+				R16SRC	r0, r5
+				ldrh	r0, [r5, #CPU_REG]
+				b		lldte
+lldtm			CPUWORK	#19
+				bl		i286a_ea
+				bl		i286a_memoryread_w
+lldte			strh	r0, [r9, #CPU_LDTR]
+				bl		i286a_selector
+				mov		r4, r0
+				bl		i286a_memoryread_w
+				strh	r0, [r9, #(CPU_LDTRC + 0)]
+				add		r0, r4, #2
+				bl		i286a_memoryread_w
+				strh	r0, [r9, #(CPU_LDTRC + 2)]
+				add		r0, r4, #4
+				bl		i286a_memoryread
+				strb	r0, [r9, #(CPU_LDTRC + 4)]
+				mov		pc, r11
+
+_ltr			cmp		r0, #&c0
+				bcc		_ltrm
+				CPUWORK	#17
+				R16SRC	r0, r5
+				ldrh	r0, [r5, #CPU_REG]
+				b		_ltre
+_ltrm			CPUWORK	#19
+				bl		i286a_ea
+				bl		i286a_memoryread_w
+_ltre			strh	r0, [r9, #CPU_TR]
+				bl		i286a_selector
+				mov		r4, r0
+				bl		i286a_memoryread_w
+				strh	r0, [r9, #(CPU_TRC + 0)]
+				add		r0, r4, #2
+				bl		i286a_memoryread_w
+				strh	r0, [r9, #(CPU_TRC + 2)]
+				add		r0, r4, #4
+				bl		i286a_memoryread
+				strb	r0, [r9, #(CPU_TRC + 4)]
+				mov		pc, r11
+
+verr			cmp		r0, #&c0
+				bcc		verrm
+				CPUWORK	#14
+				mov		pc, r11
+verrm			CPUWORK	#16
+				bl		i286a_ea
+				mov		pc, r11
+
+verw			cmp		r0, #&c0
+				bcc		verwm
+				CPUWORK	#14
+				mov		pc, r11
+verwm			CPUWORK	#16
+				bl		i286a_ea
+				mov		pc, r11
+
+
+cts_1			GETPCF8
 				and		r12, r0, #(7 << 3)
 				add		pc, pc, r12 lsr #1
 				nop
@@ -115,8 +228,8 @@ lidt			cmp		r0, #&c0
 smsw			cmp		r0, #&c0
 				bcc		smswm
 				CPUWORK	#3
-				R16SRC	r0, r5
 				ldrh	r1, [r9, #CPU_MSW]
+				R16SRC	r0, r5
 				strh	r1, [r5, #CPU_REG]
 				mov		pc, r11
 smswm			CPUWORK	#6
@@ -125,41 +238,57 @@ smswm			CPUWORK	#6
 				mov		lr, r11
 				b		i286a_memorywrite_w
 
-lmsw			cmp		r0, #&c0
+lmsw			ldrh	r6, [r9, #CPU_MSW]
+				cmp		r0, #&c0
 				bcc		lmswm
 				CPUWORK	#3
 				R16SRC	r0, r5
 				ldrh	r0, [r5, #CPU_REG]
+				and		r6, r6, #MSW_PE
+				orr		r0, r6, r0
 				strh	r0, [r9, #CPU_MSW]
 				mov		pc, r11
 lmswm			CPUWORK	#6
 				bl		i286a_ea
 				bl		i286a_memoryread_w
+				and		r6, r6, #MSW_PE
+				orr		r0, r6, r0
 				strh	r0, [r9, #CPU_MSW]
 				mov		pc, r11
 
+
 cts_ldall		cmp		r0, #5
 				bne		cts_intr
 				add		r6, r9, #&800
 				CPUWORK	#195
 				ldrh	r0, [r6, #&04]			; MSW
+				ldrh	r1, [r6, #&16]			; TR
 				ldr		r8, [r6, #&18]			; IP:flag
+		if 1
+				strh	r0, [r9, #CPU_MSW]
+				strh	r1, [r9, #CPU_TR]
+				bic		r8, r8, #&f000
+		else
 				mov		r2, #3
 				strh	r0, [r9, #CPU_MSW]
+				strh	r1, [r9, #CPU_TR]
 				and		r2, r2, r8 lsr #8
 				bic		r8, r8, #&f000
 				and		r2, r2, r2 lsr #1
 				strb	r2, [r9, #CPU_TRAP]
-				ldrh	r0, [r6, #&1e]			; DS
+		endif
+				ldr		r0, [r6, #&1c]			; DS:LDTR
 				ldr		r1, [r6, #&20]			; CS:SS
 				ldr		r2, [r6, #&24]			; DI:ES
-				strh	r0, [r9, #CPU_DS]
-				mov		r0, r1 lsr #16
+				mov		r3, r0 lsr #16
+				strh	r0, [r9, #CPU_LDTR]
+				strh	r3, [r9, #CPU_DS]
+				mov		r3, r1 lsr #16
 				strh	r1, [r9, #CPU_SS]
-				strh	r0, [r9, #CPU_CS]
-				mov		r0, r2 lsr #16
+				strh	r3, [r9, #CPU_CS]
+				mov		r3, r2 lsr #16
 				strh	r2, [r9, #CPU_ES]
-				strh	r0, [r9, #CPU_DI]
+				strh	r3, [r9, #CPU_DI]
 
 				ldr		r0, [r6, #&28]			; BP:SI
 				ldr		r1, [r6, #&2c]			; BX:SP
@@ -192,11 +321,32 @@ cts_ldall		cmp		r0, #5
 				str		r6, [r9, #CPU_DS_BASE]
 				str		r4, [r9, #CPU_SS_FIX]
 				str		r6, [r9, #CPU_DS_FIX]
-				I286IRQCHECKTERM
 
-cts_intr		sub		r8, r6, #(1 << 16)
-				mov		r6, #6
-				b		i286a_localint
+				ldrh	r0, [r6, #&4e]			; GDTR.base
+				ldr		r1, [r6, #&50]			; GDTR.limit:ar:base24
+				ldr		r2, [r6, #&54]			; LDTRC.ar:base24:base
+				ldr		r3, [r6, #&58]			; IDTR.base:LDTRC.limit
+				mov		r4, r1 lsr #16
+				strh	r4, [r9, #(CPU_GDTR + 0)]
+				strh	r0, [r9, #(CPU_GDTR + 2)]
+				strh	r1, [r9, #(CPU_GDTR + 4)]
+				mov		r4, r2 lsr #16
+				strh	r3, [r9, #(CPU_LDTRC + 0)]
+				strh	r2, [r9, #(CPU_LDTRC + 2)]
+				strh	r4, [r9, #(CPU_LDTRC + 4)]
+				ldr		r0, [r6, #&5c]			; IDTR.limit:ar:base24
+				ldr		r1, [r6, #&60]			; TRC.ar:base24:base
+				ldrh	r2, [r6, #&64]			; TRC.limit
+				mov		r3, r3 lsr #16
+				mov		r4, r0 lsr #16
+				strh	r4, [r9, #(CPU_IDTR + 0)]
+				strh	r3, [r9, #(CPU_IDTR + 2)]
+				strh	r0, [r9, #(CPU_IDTR + 4)]
+				mov		r4, r1 lsr #16
+				strh	r2, [r9, #(CPU_TRC + 0)]
+				strh	r1, [r9, #(CPU_TRC + 2)]
+				strh	r4, [r9, #(CPU_TRC + 4)]
+				I286IRQCHECKTERM
 
 	END