--- np2/i386c/ia32/instructions/system_inst.c 2004/02/04 13:24:35 1.13 +++ np2/i386c/ia32/instructions/system_inst.c 2004/02/20 16:09:05 1.18 @@ -1,4 +1,4 @@ -/* $Id: system_inst.c,v 1.13 2004/02/04 13:24:35 monaka Exp $ */ +/* $Id: system_inst.c,v 1.18 2004/02/20 16:09:05 monaka Exp $ */ /* * Copyright (c) 2003 NONAKA Kimihiro @@ -35,16 +35,16 @@ void -LGDT_Ms(DWORD op) +LGDT_Ms(UINT32 op) { - DWORD madr; - DWORD base; - WORD limit; + UINT32 madr; + UINT32 base; + UINT16 limit; if (op < 0xc0) { if (!CPU_STAT_PM || !CPU_STAT_VM86 || CPU_STAT_CPL == 0) { CPU_WORKCLOCK(11); - madr = get_ea(op); + madr = calc_ea_dst(op); limit = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr); base = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr + 2); if (!CPU_INST_OP32) { @@ -66,11 +66,11 @@ LGDT_Ms(DWORD op) } void -SGDT_Ms(DWORD op) +SGDT_Ms(UINT32 op) { - DWORD madr; - DWORD base; - WORD limit; + UINT32 madr; + UINT32 base; + UINT16 limit; if (op < 0xc0) { CPU_WORKCLOCK(11); @@ -79,7 +79,7 @@ SGDT_Ms(DWORD op) if (!CPU_INST_OP32) { base &= 0x00ffffff; } - madr = get_ea(op); + madr = calc_ea_dst(op); cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, limit); cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr + 2, base); return; @@ -88,9 +88,9 @@ SGDT_Ms(DWORD op) } void -LLDT_Ew(DWORD op) +LLDT_Ew(UINT32 op) { - DWORD src, madr; + UINT32 src, madr; if (CPU_STAT_PM && !CPU_STAT_VM86) { if (CPU_STAT_CPL == 0) { @@ -102,7 +102,7 @@ LLDT_Ew(DWORD op) madr = calc_ea_dst(op); src = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr); } - load_ldtr(src, GP_EXCEPTION); + load_ldtr((UINT16)src, GP_EXCEPTION); return; } VERBOSE(("LLDT: CPL(%d) != 0", CPU_STAT_CPL)); @@ -113,10 +113,10 @@ LLDT_Ew(DWORD op) } void -SLDT_Ew(DWORD op) +SLDT_Ew(UINT32 op) { - DWORD madr; - WORD ldtr; + UINT32 madr; + UINT16 ldtr; if (CPU_STAT_PM && !CPU_STAT_VM86) { ldtr = CPU_LDTR; @@ -139,9 +139,9 @@ SLDT_Ew(DWORD op) } void -LTR_Ew(DWORD op) +LTR_Ew(UINT32 op) { - DWORD src, madr; + UINT32 src, madr; if (CPU_STAT_PM && !CPU_STAT_VM86) { if (CPU_STAT_CPL == 0) { @@ -153,7 +153,7 @@ LTR_Ew(DWORD op) madr = calc_ea_dst(op); src = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr); } - load_tr(src); + load_tr((UINT16)src); return; } VERBOSE(("LTR: CPL(%d) != 0", CPU_STAT_CPL)); @@ -164,10 +164,10 @@ LTR_Ew(DWORD op) } void -STR_Ew(DWORD op) +STR_Ew(UINT32 op) { - DWORD madr; - WORD tr; + UINT32 madr; + UINT16 tr; if (CPU_STAT_PM && !CPU_STAT_VM86) { tr = CPU_TR; @@ -190,16 +190,16 @@ STR_Ew(DWORD op) } void -LIDT_Ms(DWORD op) +LIDT_Ms(UINT32 op) { - DWORD madr; - DWORD base; - WORD limit; + UINT32 madr; + UINT32 base; + UINT16 limit; if (op < 0xc0) { if (!CPU_STAT_PM || !CPU_STAT_VM86 || CPU_STAT_CPL == 0) { CPU_WORKCLOCK(11); - madr = get_ea(op); + madr = calc_ea_dst(op); limit = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr); base = cpu_vmemoryread_d(CPU_INST_SEGREG_INDEX, madr + 2); if (!CPU_INST_OP32) { @@ -221,11 +221,11 @@ LIDT_Ms(DWORD op) } void -SIDT_Ms(DWORD op) +SIDT_Ms(UINT32 op) { - DWORD madr; - DWORD base; - WORD limit; + UINT32 madr; + UINT32 base; + UINT16 limit; if (op < 0xc0) { CPU_WORKCLOCK(11); @@ -234,7 +234,7 @@ SIDT_Ms(DWORD op) if (!CPU_INST_OP32) { base &= 0x00ffffff; } - madr = get_ea(op); + madr = calc_ea_dst(op); cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, limit); cpu_vmemorywrite_d(CPU_INST_SEGREG_INDEX, madr + 2, base); return; @@ -245,8 +245,8 @@ SIDT_Ms(DWORD op) void MOV_CdRd(void) { - DWORD op, src; - DWORD reg; + UINT32 op, src; + UINT32 reg; int idx; CPU_WORKCLOCK(11); @@ -277,7 +277,7 @@ MOV_CdRd(void) */ /* 下巻 p.182 割り込み 13 - 一般保護例外 */ - if ((src & (CPU_CR0_PE|CPU_CR0_PG)) == (DWORD)CPU_CR0_PG) { + if ((src & (CPU_CR0_PE|CPU_CR0_PG)) == (UINT32)CPU_CR0_PG) { EXCEPTION(GP_EXCEPTION, 0); } if ((src & (CPU_CR0_NW|CPU_CR0_CD)) == CPU_CR0_NW) { @@ -314,6 +314,8 @@ MOV_CdRd(void) change_pm(0); } } + + CPU_STAT_WP = (CPU_CR0 & CPU_CR0_WP) ? 0x10 : 0; break; case 2: /* CR2 */ @@ -379,8 +381,8 @@ MOV_CdRd(void) void MOV_RdCd(void) { - DWORD *out; - DWORD op; + UINT32 *out; + UINT32 op; int idx; CPU_WORKCLOCK(11); @@ -425,10 +427,10 @@ MOV_RdCd(void) } void -LMSW_Ew(DWORD op) +LMSW_Ew(UINT32 op) { - DWORD src, madr; - DWORD cr0; + UINT32 src, madr; + UINT32 cr0; if (!CPU_STAT_PM || CPU_STAT_CPL == 0) { if (op >= 0xc0) { @@ -453,17 +455,17 @@ LMSW_Ew(DWORD op) } void -SMSW_Ew(DWORD op) +SMSW_Ew(UINT32 op) { - DWORD madr; + UINT32 madr; if (op >= 0xc0) { CPU_WORKCLOCK(2); - *(reg16_b20[op]) = (WORD)CPU_CR0; + *(reg16_b20[op]) = (UINT16)CPU_CR0; } else { CPU_WORKCLOCK(3); madr = calc_ea_dst(op); - cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (WORD)CPU_CR0); + cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (UINT16)CPU_CR0); } } @@ -471,7 +473,7 @@ void CLTS(void) { - CPU_WORKCLOCK(2); + CPU_WORKCLOCK(5); if (CPU_STAT_PM && (CPU_STAT_VM86 || (CPU_STAT_CPL != 0))) { VERBOSE(("CLTS: VM86(%s) or CPL(%d) != 0", CPU_STAT_VM86 ? "true" : "false", CPU_STAT_CPL)); EXCEPTION(GP_EXCEPTION, 0); @@ -482,7 +484,7 @@ CLTS(void) void ARPL_EwGw(void) { - DWORD op, src, dst, madr; + UINT32 op, src, dst, madr; if (CPU_STAT_PM && !CPU_STAT_VM86) { PREPART_EA_REG16(op, src); @@ -493,7 +495,7 @@ ARPL_EwGw(void) CPU_FLAGL |= Z_FLAG; dst &= ~3; dst |= (src & 3); - *(reg16_b20[op]) = dst; + *(reg16_b20[op]) = (UINT16)dst; } else { CPU_FLAGL &= ~Z_FLAG; } @@ -505,7 +507,7 @@ ARPL_EwGw(void) CPU_FLAGL |= Z_FLAG; dst &= ~3; dst |= (src & 3); - cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, dst); + cpu_vmemorywrite_w(CPU_INST_SEGREG_INDEX, madr, (UINT16)dst); } else { CPU_FLAGL &= ~Z_FLAG; } @@ -523,30 +525,33 @@ void LAR_GwEw(void) { selector_t sel; - WORD *out; - DWORD op; - DWORD h; - int user_mode; + UINT16 *out; + UINT32 op; + UINT32 h; int rv; - WORD selector; + UINT16 selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { PREPART_REG16_EA(op, selector, out, 5, 11); - user_mode = CPU_IS_USER_MODE(); - rv = parse_selector(&sel, selector, user_mode); + rv = parse_selector(&sel, selector); if (rv < 0) { CPU_FLAGL &= ~Z_FLAG; return; } if (sel.desc.s) { - if (!(sel.desc.u.seg.c && !sel.desc.u.seg.ec) && - ((sel.desc.dpl < CPU_STAT_CPL) || (sel.desc.dpl < sel.rpl))) { - CPU_FLAGL &= ~Z_FLAG; - return; + /* code or data segment */ + if (!(sel.desc.u.seg.c && sel.desc.u.seg.ec)) { + /* not conforming code segment */ + if ((sel.desc.dpl < CPU_STAT_CPL) + || (sel.desc.dpl < sel.rpl)) { + CPU_FLAGL &= ~Z_FLAG; + return; + } } } else { + /* system segment */ switch (sel.desc.type) { case CPU_SYSDESC_TYPE_TSS_16: case CPU_SYSDESC_TYPE_LDT: @@ -564,8 +569,8 @@ LAR_GwEw(void) } } - h = cpu_lmemoryread_d(sel.addr + 4, user_mode); - *out = h & 0xff00; + h = cpu_kmemoryread_d(sel.addr + 4); + *out = (UINT16)(h & 0xff00); CPU_FLAGL |= Z_FLAG; return; } @@ -577,30 +582,33 @@ void LAR_GdEw(void) { selector_t sel; - DWORD *out; - DWORD op; - DWORD h; - int user_mode; + UINT32 *out; + UINT32 op; + UINT32 h; int rv; - WORD selector; + UINT32 selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { PREPART_REG32_EA(op, selector, out, 5, 11); - user_mode = CPU_IS_USER_MODE(); - rv = parse_selector(&sel, selector, user_mode); + rv = parse_selector(&sel, (UINT16)selector); if (rv < 0) { CPU_FLAGL &= ~Z_FLAG; return; } if (sel.desc.s) { - if (!(sel.desc.u.seg.c && !sel.desc.u.seg.ec) - && ((sel.desc.dpl < CPU_STAT_CPL) || (sel.desc.dpl < sel.rpl))) { - CPU_FLAGL &= ~Z_FLAG; - return; + /* code or data segment */ + if (!(sel.desc.u.seg.c && sel.desc.u.seg.ec)) { + /* not conforming code segment */ + if ((sel.desc.dpl < CPU_STAT_CPL) + || (sel.desc.dpl < sel.rpl)) { + CPU_FLAGL &= ~Z_FLAG; + return; + } } } else { + /* system segment */ switch (sel.desc.type) { case CPU_SYSDESC_TYPE_TSS_16: case CPU_SYSDESC_TYPE_LDT: @@ -618,7 +626,7 @@ LAR_GdEw(void) } } - h = cpu_lmemoryread_d(sel.addr + 4, user_mode); + h = cpu_kmemoryread_d(sel.addr + 4); *out = h & 0x00ffff00; /* 0x00fxff00, x? */ CPU_FLAGL |= Z_FLAG; return; @@ -631,27 +639,32 @@ void LSL_GwEw(void) { selector_t sel; - WORD *out; - DWORD op; + UINT16 *out; + UINT32 op; int rv; - WORD selector; + UINT16 selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { PREPART_REG16_EA(op, selector, out, 5, 11); - rv = parse_selector(&sel, selector, CPU_IS_USER_MODE()); + rv = parse_selector(&sel, selector); if (rv < 0) { CPU_FLAGL &= ~Z_FLAG; return; } if (sel.desc.s) { - if (!(sel.desc.u.seg.c && !sel.desc.u.seg.ec) - && ((sel.desc.dpl < CPU_STAT_CPL) || (sel.desc.dpl < sel.rpl))) { - CPU_FLAGL &= ~Z_FLAG; - return; + /* code or data segment */ + if (!(sel.desc.u.seg.c && sel.desc.u.seg.ec)) { + /* not conforming code segment */ + if ((sel.desc.dpl < CPU_STAT_CPL) + || (sel.desc.dpl < sel.rpl)) { + CPU_FLAGL &= ~Z_FLAG; + return; + } } } else { + /* system segment */ switch (sel.desc.type) { case CPU_SYSDESC_TYPE_TSS_16: case CPU_SYSDESC_TYPE_LDT: @@ -666,7 +679,7 @@ LSL_GwEw(void) } } - *out = (WORD)sel.desc.u.seg.limit; + *out = (UINT16)sel.desc.u.seg.limit; CPU_FLAGL |= Z_FLAG; return; } @@ -678,27 +691,32 @@ void LSL_GdEw(void) { selector_t sel; - DWORD *out; - DWORD op; + UINT32 *out; + UINT32 op; int rv; - WORD selector; + UINT32 selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { PREPART_REG32_EA(op, selector, out, 5, 11); - rv = parse_selector(&sel, selector, CPU_IS_USER_MODE()); + rv = parse_selector(&sel, (UINT16)selector); if (rv < 0) { CPU_FLAGL &= ~Z_FLAG; return; } if (sel.desc.s) { - if (!(sel.desc.u.seg.c && !sel.desc.u.seg.ec) - && ((CPU_STAT_CPL > sel.desc.dpl) || (sel.rpl > sel.desc.dpl))) { - CPU_FLAGL &= ~Z_FLAG; - return; + /* code or data segment */ + if (!(sel.desc.u.seg.c && sel.desc.u.seg.ec)) { + /* not conforming code segment */ + if ((sel.desc.dpl < CPU_STAT_CPL) + || (sel.desc.dpl < sel.rpl)) { + CPU_FLAGL &= ~Z_FLAG; + return; + } } } else { + /* system segment */ switch (sel.desc.type) { case CPU_SYSDESC_TYPE_TSS_16: case CPU_SYSDESC_TYPE_LDT: @@ -722,12 +740,12 @@ LSL_GdEw(void) } void -VERR_Ew(DWORD op) +VERR_Ew(UINT32 op) { selector_t sel; - DWORD madr; + UINT32 madr; int rv; - WORD selector; + UINT16 selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { if (op >= 0xc0) { @@ -739,7 +757,7 @@ VERR_Ew(DWORD op) selector = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr); } - rv = parse_selector(&sel, selector, CPU_IS_USER_MODE()); + rv = parse_selector(&sel, selector); if (rv < 0) { CPU_FLAGL &= ~Z_FLAG; return; @@ -750,17 +768,21 @@ VERR_Ew(DWORD op) CPU_FLAGL &= ~Z_FLAG; return; } - /* non-conforming code segment && (CPL > DPL || RPL > DPL) */ - if ((sel.desc.u.seg.c && !sel.desc.u.seg.ec) - && ((CPU_STAT_CPL > sel.desc.dpl) || (sel.rpl > sel.desc.dpl))) { - CPU_FLAGL &= ~Z_FLAG; - return; + /* not conforming code segment && (CPL > DPL || RPL > DPL) */ + if (!(sel.desc.u.seg.c && sel.desc.u.seg.ec)) { + /* not conforming code segment */ + if ((sel.desc.dpl < CPU_STAT_CPL) + || (sel.desc.dpl < sel.rpl)) { + CPU_FLAGL &= ~Z_FLAG; + return; + } } /* code segment is not readable */ if (sel.desc.u.seg.c && !sel.desc.u.seg.wr) { CPU_FLAGL &= ~Z_FLAG; return; } + CPU_FLAGL |= Z_FLAG; return; } @@ -769,12 +791,12 @@ VERR_Ew(DWORD op) } void -VERW_Ew(DWORD op) +VERW_Ew(UINT32 op) { selector_t sel; - DWORD madr; + UINT32 madr; int rv; - WORD selector; + UINT16 selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { if (op >= 0xc0) { @@ -786,7 +808,7 @@ VERW_Ew(DWORD op) selector = cpu_vmemoryread_w(CPU_INST_SEGREG_INDEX, madr); } - rv = parse_selector(&sel, selector, CPU_IS_USER_MODE()); + rv = parse_selector(&sel, selector); if (rv < 0) { CPU_FLAGL &= ~Z_FLAG; return; @@ -807,6 +829,7 @@ VERW_Ew(DWORD op) CPU_FLAGL &= ~Z_FLAG; return; } + CPU_FLAGL |= Z_FLAG; return; } @@ -853,9 +876,9 @@ WBINVD(void) } void -INVLPG(DWORD op) +INVLPG(UINT32 op) { - DWORD madr; + UINT32 madr; if (CPU_STAT_PM && (CPU_STAT_VM86 || CPU_STAT_CPL != 0)) { VERBOSE(("INVLPG: VM86(%s) or CPL(%d) != 0", CPU_STAT_VM86 ? "true" : "false", CPU_STAT_CPL)); @@ -864,7 +887,7 @@ INVLPG(DWORD op) if (op < 0xc0) { CPU_WORKCLOCK(11); - madr = get_ea(op); + madr = calc_ea_dst(op); tlb_flush_page(madr); return; } @@ -889,6 +912,7 @@ HLT(void) CPU_HALT(); CPU_EIP--; + CPU_STAT_HLT = 1; } void