--- np2/i386c/ia32/instructions/system_inst.c 2004/02/04 13:24:35 1.13 +++ np2/i386c/ia32/instructions/system_inst.c 2004/02/18 20:11:37 1.16 @@ -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.16 2004/02/18 20:11:37 yui Exp $ */ /* * Copyright (c) 2003 NONAKA Kimihiro @@ -44,7 +44,7 @@ LGDT_Ms(DWORD op) 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) { @@ -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; @@ -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((WORD)src, GP_EXCEPTION); return; } VERBOSE(("LLDT: CPL(%d) != 0", CPU_STAT_CPL)); @@ -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((WORD)src); return; } VERBOSE(("LTR: CPL(%d) != 0", CPU_STAT_CPL)); @@ -199,7 +199,7 @@ LIDT_Ms(DWORD op) 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) { @@ -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; @@ -314,6 +314,8 @@ MOV_CdRd(void) change_pm(0); } } + + CPU_STAT_WP = (BYTE)((CPU_CR0 & CPU_CR0_WP) >> 12); break; case 2: /* CR2 */ @@ -493,7 +495,7 @@ ARPL_EwGw(void) CPU_FLAGL |= Z_FLAG; dst &= ~3; dst |= (src & 3); - *(reg16_b20[op]) = dst; + *(reg16_b20[op]) = (WORD)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, (WORD)dst); } else { CPU_FLAGL &= ~Z_FLAG; } @@ -526,27 +528,30 @@ LAR_GwEw(void) WORD *out; DWORD op; DWORD h; - int user_mode; int rv; WORD 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 = h & 0xff00; // read DWORD? CPU_FLAGL |= Z_FLAG; return; } @@ -580,27 +585,30 @@ LAR_GdEw(void) DWORD *out; DWORD op; DWORD h; - int user_mode; int rv; WORD selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { - PREPART_REG32_EA(op, selector, out, 5, 11); + PREPART_REG32_EA(op, selector, out, 5, 11); // EA16? - 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: @@ -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; @@ -639,19 +647,24 @@ LSL_GwEw(void) 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: @@ -684,21 +697,26 @@ LSL_GdEw(void) WORD selector; if (CPU_STAT_PM && !CPU_STAT_VM86) { - PREPART_REG32_EA(op, selector, out, 5, 11); + PREPART_REG32_EA(op, selector, out, 5, 11); // EA16? - 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) - && ((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: @@ -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; } @@ -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; } @@ -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