--- np2/i386c/ia32/segments.c 2004/01/27 15:56:57 1.8 +++ np2/i386c/ia32/segments.c 2004/02/19 03:04:01 1.12 @@ -1,4 +1,4 @@ -/* $Id: segments.c,v 1.8 2004/01/27 15:56:57 monaka Exp $ */ +/* $Id: segments.c,v 1.12 2004/02/19 03:04:01 yui Exp $ */ /* * Copyright (c) 2003 NONAKA Kimihiro @@ -47,17 +47,12 @@ load_segreg(int idx, WORD selector, int CPU_REGS_SREG(idx) = selector; memset(&sd, 0, sizeof(sd)); + if (idx == CPU_CS_INDEX) { + sd.rpl = CPU_STAT_CPL; + } sd.u.seg.limit = CPU_STAT_SREGLIMIT(idx); CPU_SET_SEGDESC_DEFAULT(&sd, idx, selector); CPU_STAT_SREG(idx) = sd; - - if (idx == CPU_CS_INDEX) { - CPU_INST_OP32 = CPU_INST_AS32 = - CPU_STATSAVE.cpu_inst_default.op_32 = - CPU_STATSAVE.cpu_inst_default.as_32 = 0; - } else if (idx == CPU_SS_INDEX) { - CPU_STAT_SS32 = 0; - } return; } @@ -134,11 +129,11 @@ load_segreg(int idx, WORD selector, int * load SS register */ void -load_ss(WORD selector, descriptor_t* sdp, BYTE cpl) +load_ss(WORD selector, descriptor_t* sdp, DWORD cpl) { CPU_STAT_SS32 = sdp->d; - CPU_REGS_SREG(CPU_SS_INDEX) = (selector & ~3) | (cpl & 3); + CPU_REGS_SREG(CPU_SS_INDEX) = (WORD)((selector & ~3) | (cpl & 3)); CPU_STAT_SREG(CPU_SS_INDEX) = *sdp; } @@ -146,15 +141,15 @@ load_ss(WORD selector, descriptor_t* sdp * load CS register */ void -load_cs(WORD selector, descriptor_t* sdp, BYTE cpl) +load_cs(WORD selector, descriptor_t* sdp, DWORD cpl) { CPU_INST_OP32 = CPU_INST_AS32 = CPU_STATSAVE.cpu_inst_default.op_32 = CPU_STATSAVE.cpu_inst_default.as_32 = sdp->d; - CPU_REGS_SREG(CPU_CS_INDEX) = (selector & ~3) | (cpl & 3); + CPU_REGS_SREG(CPU_CS_INDEX) = (WORD)((selector & ~3) | (cpl & 3)); CPU_STAT_SREG(CPU_CS_INDEX) = *sdp; - CPU_STAT_CPL = cpl & 3; + CPU_SET_CPL(cpl & 3); } /* @@ -204,37 +199,37 @@ load_ldtr(WORD selector, int exc) void load_descriptor(descriptor_t *descp, DWORD addr) { + DWORD l, h; memset(descp, 0, sizeof(*descp)); - descp->addr = addr; - descp->l = cpu_lmemoryread_d(descp->addr); - descp->h = cpu_lmemoryread_d(descp->addr + 4); - VERBOSE(("load_descriptor: descriptor address = 0x%08x, h = 0x%08x, l = %08x", descp->addr, descp->h, descp->l)); + l = cpu_kmemoryread_d(addr); + h = cpu_kmemoryread_d(addr + 4); + VERBOSE(("load_descriptor: descriptor address = 0x%08x, h = 0x%08x, l = %08x", addr, h, l)); descp->flag = 0; - descp->p = (descp->h & CPU_DESC_H_P) == CPU_DESC_H_P; - descp->type = (descp->h & CPU_DESC_H_TYPE) >> 8; - descp->dpl = (descp->h & CPU_DESC_H_DPL) >> 13; - descp->s = (descp->h & CPU_DESC_H_S) == CPU_DESC_H_S; + descp->p = (h & CPU_DESC_H_P) == CPU_DESC_H_P; + descp->type = (BYTE)((h & CPU_DESC_H_TYPE) >> 8); + descp->dpl = (BYTE)((h & CPU_DESC_H_DPL) >> 13); + descp->s = (h & CPU_DESC_H_S) == CPU_DESC_H_S; VERBOSE(("load_descriptor: present = %s, type = %d, DPL = %d", descp->p ? "true" : "false", descp->type, descp->dpl)); if (descp->s) { /* code/data */ descp->valid = 1; - descp->d = (descp->h & CPU_SEGDESC_H_D) ? 1 : 0; + descp->d = (h & CPU_SEGDESC_H_D) ? 1 : 0; - descp->u.seg.c = (descp->h & CPU_SEGDESC_H_D_C) ? 1 : 0; - descp->u.seg.g = (descp->h & CPU_SEGDESC_H_G) ? 1 : 0; + descp->u.seg.c = (h & CPU_SEGDESC_H_D_C) ? 1 : 0; + descp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; descp->u.seg.wr = (descp->type & CPU_SEGDESC_TYPE_WR) ? 1 : 0; descp->u.seg.ec = (descp->type & CPU_SEGDESC_TYPE_EC) ? 1 : 0; - descp->u.seg.segbase = (descp->l >> 16) & 0xffff; - descp->u.seg.segbase |= (descp->h & 0xff) << 16; - descp->u.seg.segbase |= descp->h & 0xff000000; - descp->u.seg.limit = (descp->h & 0xf0000) | (descp->l & 0xffff); + descp->u.seg.segbase = (l >> 16) & 0xffff; + descp->u.seg.segbase |= (h & 0xff) << 16; + descp->u.seg.segbase |= h & 0xff000000; + descp->u.seg.limit = (h & 0xf0000) | (l & 0xffff); if (descp->u.seg.g) { descp->u.seg.limit <<= 12; descp->u.seg.limit |= 0xfff; @@ -250,13 +245,13 @@ load_descriptor(descriptor_t *descp, DWO switch (descp->type) { case CPU_SYSDESC_TYPE_LDT: /* LDT */ descp->valid = 1; - descp->u.seg.g = (descp->h & CPU_SEGDESC_H_G) ? 1 : 0; + descp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; - descp->u.seg.segbase = descp->h & 0xff000000; - descp->u.seg.segbase |= (descp->h & 0xff) << 16; - descp->u.seg.segbase |= descp->l >> 16; - descp->u.seg.limit = descp->h & 0xf0000; - descp->u.seg.limit |= descp->l & 0xffff; + descp->u.seg.segbase = h & 0xff000000; + descp->u.seg.segbase |= (h & 0xff) << 16; + descp->u.seg.segbase |= l >> 16; + descp->u.seg.limit = h & 0xf0000; + descp->u.seg.limit |= l & 0xffff; if (descp->u.seg.g) { descp->u.seg.limit <<= 12; descp->u.seg.limit |= 0xfff; @@ -269,7 +264,7 @@ load_descriptor(descriptor_t *descp, DWO case CPU_SYSDESC_TYPE_TASK: /* task gate */ descp->valid = 1; - descp->u.gate.selector = descp->l >> 16; + descp->u.gate.selector = (WORD)(l >> 16); VERBOSE(("load_descriptor: task descriptor: selector = 0x%04x", descp->u.gate.selector)); break; @@ -279,21 +274,21 @@ load_descriptor(descriptor_t *descp, DWO case CPU_SYSDESC_TYPE_TSS_32: /* 386 TSS */ case CPU_SYSDESC_TYPE_TSS_BUSY_32: /* 386 TSS Busy */ descp->valid = 1; - descp->d = (descp->h & CPU_GATEDESC_H_D) ? 1 : 0; - descp->u.seg.g = (descp->h & CPU_SEGDESC_H_G) ? 1 : 0; + descp->d = (h & CPU_GATEDESC_H_D) ? 1 : 0; + descp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; - descp->u.seg.segbase = descp->h & 0xff000000; - descp->u.seg.segbase |= (descp->h & 0xff) << 16; - descp->u.seg.segbase |= descp->l >> 16; - descp->u.seg.limit = descp->h & 0xf0000; - descp->u.seg.limit |= descp->l & 0xffff; + descp->u.seg.segbase = h & 0xff000000; + descp->u.seg.segbase |= (h & 0xff) << 16; + descp->u.seg.segbase |= l >> 16; + descp->u.seg.limit = h & 0xf0000; + descp->u.seg.limit |= l & 0xffff; if (descp->u.seg.g) { descp->u.seg.limit <<= 12; descp->u.seg.limit |= 0xfff; } descp->u.seg.segend = descp->u.seg.segbase + descp->u.seg.limit; - VERBOSE(("load_descriptor: %dbit %sTSS descriptor", descp->d ? 32 : 16, (descp->type & CPU_SYSDESC_TYPE_TSS_BUSY) ? "busy " : "")); + VERBOSE(("load_descriptor: %dbit %sTSS descriptor", descp->d ? 32 : 16, (descp->type & CPU_SYSDESC_TYPE_TSS_BUSY_IND) ? "busy " : "")); VERBOSE(("load_descriptor: TSS base address = 0x%08x, limit = 0x%08x", descp->u.seg.segbase, descp->u.seg.limit)); VERBOSE(("load_descriptor: d = %s, g = %s", descp->d ? "on" : "off", descp->u.seg.g ? "on" : "off")); break; @@ -304,13 +299,13 @@ load_descriptor(descriptor_t *descp, DWO case CPU_SYSDESC_TYPE_CALL_32: /* 386 call gate */ case CPU_SYSDESC_TYPE_INTR_32: /* 386 interrupt gate */ case CPU_SYSDESC_TYPE_TRAP_32: /* 386 trap gate */ - if ((descp->h & 0x0000000e0) == 0) { + if ((h & 0x0000000e0) == 0) { descp->valid = 1; - descp->d = (descp->h & CPU_GATEDESC_H_D) ? 1:0; - descp->u.gate.selector = descp->l >> 16; - descp->u.gate.offset = descp->h & 0xffff0000; - descp->u.gate.offset |= descp->l & 0xffff; - descp->u.gate.count = descp->h & 0x1f; + descp->d = (h & CPU_GATEDESC_H_D) ? 1:0; + descp->u.gate.selector = (WORD)(l >> 16); + descp->u.gate.offset = h & 0xffff0000; + descp->u.gate.offset |= l & 0xffff; + descp->u.gate.count = (BYTE)(h & 0x1f); VERBOSE(("load_descriptor: %dbit %s gate descriptor", descp->d ? 32 : 16, ((descp->type & CPU_SYSDESC_TYPE_MASKBIT) == CPU_SYSDESC_TYPE_CALL) ? "call" : (((descp->type & CPU_SYSDESC_TYPE_MASKBIT) == CPU_SYSDESC_TYPE_INTR) ? "interrupt" : "trap"))); VERBOSE(("load_descriptor: selector = 0x%04x, offset = 0x%08x, count = %d, d = %s", descp->u.gate.selector, descp->u.gate.offset, descp->u.gate.count, descp->d ? "on" : "off")); @@ -338,12 +333,12 @@ parse_selector(selector_t* ssp, WORD sel ssp->selector = selector; ssp->idx = selector & ~3; ssp->rpl = selector & 3; - ssp->ldt = selector & CPU_SEGMENT_TABLE_IND; + ssp->ldt = (BYTE)(selector & CPU_SEGMENT_TABLE_IND); VERBOSE(("parse_selector: selector = %04x, index = %d, RPL = %d, %cDT", ssp->selector, ssp->idx >> 3, ssp->rpl, ssp->ldt ? 'L' : 'G')); /* descriptor table */ - idx = selector & ~7; + idx = selector & CPU_SEGMENT_SELECTOR_INDEX_MASK; if (ssp->ldt) { /* LDT */ if (!CPU_LDTR_DESC.valid) { @@ -351,7 +346,7 @@ parse_selector(selector_t* ssp, WORD sel return -1; } base = CPU_LDTR_BASE; - limit = CPU_LDTR_LIMIT; + limit = (WORD)CPU_LDTR_LIMIT; } else { /* check null segment */ if (idx == 0) { @@ -365,23 +360,37 @@ parse_selector(selector_t* ssp, WORD sel VERBOSE(("parse_selector: segment limit check failed")); return -3; } + /* load descriptor */ - CPU_SET_SEGDESC(&ssp->desc, base + idx); + ssp->addr = base + idx; + load_descriptor(&ssp->desc, ssp->addr); if (!ssp->desc.valid) { VERBOSE(("parse_selector: segment descriptor is invalid")); return -4; } + return 0; } int -selector_is_not_present(selector_t* ssp) +selector_is_not_present(selector_t *ssp) { + DWORD h; + /* not present */ if (!ssp->desc.p) { VERBOSE(("selector_is_not_present: not present")); return -1; } - CPU_SET_SEGDESC_POSTPART(&ssp->desc); + + /* set access bit if code/data segment descriptor */ + if (ssp->desc.s) { + h = cpu_kmemoryread_d(ssp->addr + 4); + if (!(h & CPU_SEGDESC_H_A)) { + h |= CPU_SEGDESC_H_A; + cpu_kmemorywrite_d(ssp->addr + 4, h); + } + } + return 0; }