| version 1.16, 2004/03/23 22:39:40 | version 1.21, 2011/12/23 04:17:47 | 
| Line 1 | Line 1 | 
 | /*      $Id$    */ |  | 
 |  |  | 
 | /* | /* | 
 | * Copyright (c) 2003 NONAKA Kimihiro | * Copyright (c) 2003 NONAKA Kimihiro | 
 | * All rights reserved. | * All rights reserved. | 
| Line 12 | Line 10 | 
 | * 2. Redistributions in binary form must reproduce the above copyright | * 2. Redistributions in binary form must reproduce the above copyright | 
 | *    notice, this list of conditions and the following disclaimer in the | *    notice, this list of conditions and the following disclaimer in the | 
 | *    documentation and/or other materials provided with the distribution. | *    documentation and/or other materials provided with the distribution. | 
 | * 3. The name of the author may not be used to endorse or promote products |  | 
 | *    derived from this software without specific prior written permission. |  | 
 | * | * | 
 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR | 
 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES | 
| Line 33 | Line 29 | 
 |  |  | 
 |  |  | 
 | void | void | 
| load_segreg(int idx, UINT16 selector, int exc) | load_segreg(int idx, UINT16 selector, UINT16 *sregp, descriptor_t *sdp, int exc) | 
 | { | { | 
 | selector_t sel; | selector_t sel; | 
 | int rv; | int rv; | 
 |  |  | 
 | __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | __ASSERT((unsigned int)idx < CPU_SEGREG_NUM); | 
 |  | __ASSERT((sregp != NULL)); | 
 |  | __ASSERT((sdp != NULL)); | 
 |  |  | 
 | if (!CPU_STAT_PM || CPU_STAT_VM86) { | if (!CPU_STAT_PM || CPU_STAT_VM86) { | 
 | descriptor_t sd; |  | 
 |  |  | 
 | /* real-mode or vm86 mode */ | /* real-mode or vm86 mode */ | 
| CPU_REGS_SREG(idx) = selector; | *sregp = selector; | 
|  | segdesc_clear(&sel.desc); | 
| memset(&sd, 0, sizeof(sd)); | sel.desc.u.seg.limit = CPU_STAT_SREGLIMIT(idx); | 
| if (idx == CPU_CS_INDEX) { | segdesc_set_default(idx, selector, &sel.desc); | 
| sd.rpl = CPU_STAT_CPL; | *sdp = sel.desc; | 
| } |  | 
| sd.u.seg.limit = CPU_STAT_SREGLIMIT(idx); |  | 
| CPU_SET_SEGDESC_DEFAULT(&sd, idx, selector); |  | 
| CPU_STAT_SREG(idx) = sd; |  | 
 | return; | return; | 
 | } | } | 
 |  |  | 
 |  | VERBOSE(("load_segreg: EIP = %04x:%08x, idx = %d, selector = %04x, sregp = %p, dp = %p, exc = %d", CPU_CS, CPU_PREV_EIP, idx, selector, sregp, sdp, exc)); | 
 |  |  | 
 | /* | /* | 
 | * protected mode | * protected mode | 
 | */ | */ | 
 | VERBOSE(("load_segreg: EIP = %04x:%08x, idx = %d, selector = %04x, exc = %d", CPU_CS, CPU_PREV_EIP, idx, selector, exc)); |  | 
 |  |  | 
 | if (idx == CPU_CS_INDEX) { | if (idx == CPU_CS_INDEX) { | 
 | ia32_panic("load_segreg: CS"); | ia32_panic("load_segreg: CS"); | 
 | } | } | 
| Line 70  load_segreg(int idx, UINT16 selector, in | Line 62  load_segreg(int idx, UINT16 selector, in | 
 | if ((rv != -2) || (idx == CPU_SS_INDEX)) { | if ((rv != -2) || (idx == CPU_SS_INDEX)) { | 
 | EXCEPTION(exc, sel.idx); | EXCEPTION(exc, sel.idx); | 
 | } | } | 
| CPU_REGS_SREG(idx) = sel.selector; | *sregp = sel.selector; | 
| CPU_STAT_SREG_CLEAR(idx); | segdesc_clear(sdp); | 
 | return; | return; | 
 | } | } | 
 |  |  | 
| Line 79  load_segreg(int idx, UINT16 selector, in | Line 71  load_segreg(int idx, UINT16 selector, in | 
 | case CPU_SS_INDEX: | case CPU_SS_INDEX: | 
 | if ((CPU_STAT_CPL != sel.rpl) | if ((CPU_STAT_CPL != sel.rpl) | 
 | || (CPU_STAT_CPL != sel.desc.dpl) | || (CPU_STAT_CPL != sel.desc.dpl) | 
| || !sel.desc.s | || SEG_IS_SYSTEM(&sel.desc) | 
| || sel.desc.u.seg.c | || SEG_IS_CODE(&sel.desc) | 
| || !sel.desc.u.seg.wr) { | || !SEG_IS_WRITABLE_DATA(&sel.desc)) { | 
 | EXCEPTION(exc, sel.idx); | EXCEPTION(exc, sel.idx); | 
 | } | } | 
 |  |  | 
| Line 91  load_segreg(int idx, UINT16 selector, in | Line 83  load_segreg(int idx, UINT16 selector, in | 
 | EXCEPTION(SS_EXCEPTION, sel.idx); | EXCEPTION(SS_EXCEPTION, sel.idx); | 
 | } | } | 
 |  |  | 
| load_ss(sel.selector, &sel.desc, sel.selector & 3); | load_ss(sel.selector, &sel.desc, CPU_STAT_CPL); | 
 | break; | break; | 
 |  |  | 
 | case CPU_ES_INDEX: | case CPU_ES_INDEX: | 
 | case CPU_DS_INDEX: | case CPU_DS_INDEX: | 
 | case CPU_FS_INDEX: | case CPU_FS_INDEX: | 
 | case CPU_GS_INDEX: | case CPU_GS_INDEX: | 
| /* !(system segment || non-readable code segment) */ | if (SEG_IS_SYSTEM(&sel.desc) | 
| if (!sel.desc.s | || (SEG_IS_CODE(&sel.desc) && !SEG_IS_READABLE_CODE(&sel.desc))) { | 
| || (sel.desc.u.seg.c && !sel.desc.u.seg.wr)) { |  | 
 | EXCEPTION(exc, sel.idx); | EXCEPTION(exc, sel.idx); | 
 | } | } | 
| /* data segment || non-conforming code segment */ | if (SEG_IS_DATA(&sel.desc) | 
| if (!sel.desc.u.seg.c || !sel.desc.u.seg.ec) { | || !SEG_IS_CONFORMING_CODE(&sel.desc)) { | 
 | /* check privilege level */ | /* check privilege level */ | 
| if ((sel.rpl > sel.desc.dpl) || (CPU_STAT_CPL > sel.desc.dpl)) { | if ((sel.rpl > sel.desc.dpl) | 
|  | || (CPU_STAT_CPL > sel.desc.dpl)) { | 
 | EXCEPTION(exc, sel.idx); | EXCEPTION(exc, sel.idx); | 
 | } | } | 
 | } | } | 
| Line 117  load_segreg(int idx, UINT16 selector, in | Line 109  load_segreg(int idx, UINT16 selector, in | 
 | EXCEPTION(NP_EXCEPTION, sel.idx); | EXCEPTION(NP_EXCEPTION, sel.idx); | 
 | } | } | 
 |  |  | 
| CPU_REGS_SREG(idx) = sel.selector; | *sregp = sel.selector; | 
| CPU_STAT_SREG(idx) = sel.desc; | *sdp = sel.desc; | 
 | break; | break; | 
 |  |  | 
 | default: | default: | 
| Line 131  load_segreg(int idx, UINT16 selector, in | Line 123  load_segreg(int idx, UINT16 selector, in | 
 | * load SS register | * load SS register | 
 | */ | */ | 
 | void | void | 
| load_ss(UINT16 selector, const descriptor_t *sd, UINT cpl) | load_ss(UINT16 selector, const descriptor_t *sdp, int cpl) | 
 | { | { | 
 |  |  | 
| CPU_STAT_SS32 = sd->d; | CPU_STAT_SS32 = sdp->d; | 
| CPU_REGS_SREG(CPU_SS_INDEX) = (UINT16)((selector & ~3) | (cpl & 3)); | CPU_SS = (UINT16)((selector & ~3) | (cpl & 3)); | 
| CPU_STAT_SREG(CPU_SS_INDEX) = *sd; | CPU_SS_DESC = *sdp; | 
 | } | } | 
 |  |  | 
 | /* | /* | 
 | * load CS register | * load CS register | 
 | */ | */ | 
 | void | void | 
| load_cs(UINT16 selector, const descriptor_t *sd, UINT cpl) | load_cs(UINT16 selector, const descriptor_t *sdp, int new_cpl) | 
 | { | { | 
 |  | int cpl = new_cpl & 3; | 
 |  |  | 
 | CPU_INST_OP32 = CPU_INST_AS32 = | CPU_INST_OP32 = CPU_INST_AS32 = | 
 | CPU_STATSAVE.cpu_inst_default.op_32 = | CPU_STATSAVE.cpu_inst_default.op_32 = | 
| CPU_STATSAVE.cpu_inst_default.as_32 = sd->d; | CPU_STATSAVE.cpu_inst_default.as_32 = sdp->d; | 
| CPU_REGS_SREG(CPU_CS_INDEX) = (UINT16)((selector & ~3) | (cpl & 3)); | CPU_CS = (UINT16)((selector & ~3) | cpl); | 
| CPU_STAT_SREG(CPU_CS_INDEX) = *sd; | CPU_CS_DESC = *sdp; | 
| CPU_SET_CPL(cpl & 3); | set_cpl(cpl); | 
 | } | } | 
 |  |  | 
 | /* | /* | 
| Line 163  load_ldtr(UINT16 selector, int exc) | Line 156  load_ldtr(UINT16 selector, int exc) | 
 | selector_t sel; | selector_t sel; | 
 | int rv; | int rv; | 
 |  |  | 
 |  | memset(&sel, 0, sizeof(sel)); | 
 |  |  | 
 | rv = parse_selector(&sel, selector); | rv = parse_selector(&sel, selector); | 
 | if (rv < 0 || sel.ldt) { | if (rv < 0 || sel.ldt) { | 
 | if (rv == -2) { | if (rv == -2) { | 
| Line 175  load_ldtr(UINT16 selector, int exc) | Line 170  load_ldtr(UINT16 selector, int exc) | 
 | } | } | 
 |  |  | 
 | /* check descriptor type */ | /* check descriptor type */ | 
| if (sel.desc.s || (sel.desc.type != CPU_SYSDESC_TYPE_LDT)) { | if (!SEG_IS_SYSTEM(&sel.desc) | 
|  | || (sel.desc.type != CPU_SYSDESC_TYPE_LDT)) { | 
 | EXCEPTION(exc, sel.selector); | EXCEPTION(exc, sel.selector); | 
 | } | } | 
 |  |  | 
 | /* check limit */ |  | 
 | if (sel.desc.u.seg.limit < 7) { |  | 
 | ia32_panic("load_ldtr: LDTR descriptor limit < 7 (limit = %d)", sel.desc.u.seg.limit); |  | 
 | } |  | 
 |  |  | 
 | /* not present */ | /* not present */ | 
 | rv = selector_is_not_present(&sel); | rv = selector_is_not_present(&sel); | 
 | if (rv < 0) { | if (rv < 0) { | 
| Line 199  load_ldtr(UINT16 selector, int exc) | Line 190  load_ldtr(UINT16 selector, int exc) | 
 | } | } | 
 |  |  | 
 | void | void | 
| load_descriptor(descriptor_t *descp, UINT32 addr) | load_descriptor(descriptor_t *sdp, UINT32 addr) | 
 | { | { | 
 | UINT32 l, h; | UINT32 l, h; | 
 |  |  | 
| memset(descp, 0, sizeof(*descp)); | __ASSERT(sdp != NULL); | 
|  |  | 
|  | VERBOSE(("load_descriptor: address = 0x%08x", addr)); | 
 |  |  | 
 | l = cpu_kmemoryread_d(addr); | l = cpu_kmemoryread_d(addr); | 
 | h = cpu_kmemoryread_d(addr + 4); | h = cpu_kmemoryread_d(addr + 4); | 
| VERBOSE(("load_descriptor: descriptor address = 0x%08x, h = 0x%08x, l = %08x", addr, h, l)); | VERBOSE(("descriptor value = 0x%08x%08x", h, l)); | 
|  |  | 
| descp->flag = 0; |  | 
 |  |  | 
| descp->p = (h & CPU_DESC_H_P) == CPU_DESC_H_P; | segdesc_clear(sdp); | 
| descp->type = (UINT8)((h & CPU_DESC_H_TYPE) >> 8); | sdp->flag = 0; | 
| descp->dpl = (UINT8)((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)); | sdp->p = (h & CPU_DESC_H_P) ? 1 : 0; | 
|  | sdp->type = (UINT8)((h & CPU_DESC_H_TYPE) >> CPU_DESC_H_TYPE_SHIFT); | 
|  | sdp->dpl = (UINT8)((h & CPU_DESC_H_DPL) >> CPU_DESC_H_DPL_SHIFT); | 
|  | sdp->s = (h & CPU_DESC_H_S) ? 1 : 0; | 
 |  |  | 
| if (descp->s) { | if (!SEG_IS_SYSTEM(sdp)) { | 
 | /* code/data */ | /* code/data */ | 
| descp->valid = 1; | sdp->valid = 1; | 
| descp->d = (h & CPU_SEGDESC_H_D) ? 1 : 0; | sdp->d = (h & CPU_SEGDESC_H_D) ? 1 : 0; | 
 |  |  | 
| descp->u.seg.c = (h & CPU_SEGDESC_H_D_C) ? 1 : 0; | sdp->u.seg.c = (h & CPU_SEGDESC_H_D_C) ? 1 : 0; | 
| descp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; | sdp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; | 
| descp->u.seg.wr = (descp->type & CPU_SEGDESC_TYPE_WR) ? 1 : 0; | sdp->u.seg.wr = (sdp->type & CPU_SEGDESC_TYPE_WR) ? 1 : 0; | 
| descp->u.seg.ec = (descp->type & CPU_SEGDESC_TYPE_EC) ? 1 : 0; | sdp->u.seg.ec = (sdp->type & CPU_SEGDESC_TYPE_EC) ? 1 : 0; | 
|  |  | 
| descp->u.seg.segbase  = (l >> 16) & 0xffff; | sdp->u.seg.segbase  = (l >> 16) & 0xffff; | 
| descp->u.seg.segbase |= (h & 0xff) << 16; | sdp->u.seg.segbase |= (h & 0xff) << 16; | 
| descp->u.seg.segbase |= h & 0xff000000; | sdp->u.seg.segbase |= h & 0xff000000; | 
| descp->u.seg.limit = (h & 0xf0000) | (l & 0xffff); | sdp->u.seg.limit = (h & 0xf0000) | (l & 0xffff); | 
| if (descp->u.seg.g) { | if (sdp->u.seg.g) { | 
| descp->u.seg.limit <<= 12; | sdp->u.seg.limit <<= 12; | 
| descp->u.seg.limit |= 0xfff; | if (SEG_IS_CODE(sdp) || !SEG_IS_EXPANDDOWN_DATA(sdp)) { | 
| } | /* expand-up segment */ | 
| descp->u.seg.segend = descp->u.seg.segbase + descp->u.seg.limit; | sdp->u.seg.limit |= 0xfff; | 
|  | } | 
| VERBOSE(("load_descriptor: %s segment descriptor", descp->u.seg.c ? "code" : "data")); | } | 
| VERBOSE(("load_descriptor: segment base address = 0x%08x, segment 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")); |  | 
| VERBOSE(("load_descriptor: %s, %s", descp->u.seg.c ? (descp->u.seg.wr ? "executable/readable" : "execute-only") : (descp->u.seg.wr ? "writable" : "read-only"), (descp->u.seg.c ? (descp->u.seg.ec ? "conforming" : "non-conforming") : (descp->u.seg.ec ? "expand-down" : "expand-up")))); |  | 
 | } else { | } else { | 
 | /* system */ | /* system */ | 
| switch (descp->type) { | switch (sdp->type) { | 
 | case CPU_SYSDESC_TYPE_LDT:              /* LDT */ | case CPU_SYSDESC_TYPE_LDT:              /* LDT */ | 
| descp->valid = 1; | sdp->valid = 1; | 
| descp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; | sdp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; | 
 |  |  | 
| descp->u.seg.segbase  = h & 0xff000000; | sdp->u.seg.segbase  = h & 0xff000000; | 
| descp->u.seg.segbase |= (h & 0xff) << 16; | sdp->u.seg.segbase |= (h & 0xff) << 16; | 
| descp->u.seg.segbase |= l >> 16; | sdp->u.seg.segbase |= l >> 16; | 
| descp->u.seg.limit  = h & 0xf0000; | sdp->u.seg.limit  = h & 0xf0000; | 
| descp->u.seg.limit |= l & 0xffff; | sdp->u.seg.limit |= l & 0xffff; | 
| if (descp->u.seg.g) { | if (sdp->u.seg.g) { | 
| descp->u.seg.limit <<= 12; | sdp->u.seg.limit <<= 12; | 
| descp->u.seg.limit |= 0xfff; | sdp->u.seg.limit |= 0xfff; | 
 | } | } | 
 | descp->u.seg.segend = descp->u.seg.segbase + descp->u.seg.limit; |  | 
 |  |  | 
 | VERBOSE(("load_descriptor: LDT descriptor")); |  | 
 | VERBOSE(("load_descriptor: LDT base address = 0x%08x, limit size = 0x%08x", descp->u.seg.segbase, descp->u.seg.limit)); |  | 
 | break; | break; | 
 |  |  | 
 | case CPU_SYSDESC_TYPE_TASK:             /* task gate */ | case CPU_SYSDESC_TYPE_TASK:             /* task gate */ | 
| descp->valid = 1; | sdp->valid = 1; | 
| descp->u.gate.selector = (UINT16)(l >> 16); | sdp->u.gate.selector = (UINT16)(l >> 16); | 
|  |  | 
| VERBOSE(("load_descriptor: task descriptor: selector = 0x%04x", descp->u.gate.selector)); |  | 
 | break; | break; | 
 |  |  | 
 | case CPU_SYSDESC_TYPE_TSS_16:           /* 286 TSS */ | case CPU_SYSDESC_TYPE_TSS_16:           /* 286 TSS */ | 
 | case CPU_SYSDESC_TYPE_TSS_BUSY_16:      /* 286 TSS Busy */ | case CPU_SYSDESC_TYPE_TSS_BUSY_16:      /* 286 TSS Busy */ | 
 | case CPU_SYSDESC_TYPE_TSS_32:           /* 386 TSS */ | case CPU_SYSDESC_TYPE_TSS_32:           /* 386 TSS */ | 
 | case CPU_SYSDESC_TYPE_TSS_BUSY_32:      /* 386 TSS Busy */ | case CPU_SYSDESC_TYPE_TSS_BUSY_32:      /* 386 TSS Busy */ | 
| descp->valid = 1; | sdp->valid = 1; | 
| descp->d = (h & CPU_GATEDESC_H_D) ? 1 : 0; | sdp->d = (h & CPU_GATEDESC_H_D) ? 1 : 0; | 
| descp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; | sdp->u.seg.g = (h & CPU_SEGDESC_H_G) ? 1 : 0; | 
|  |  | 
| descp->u.seg.segbase  = h & 0xff000000; | sdp->u.seg.segbase  = h & 0xff000000; | 
| descp->u.seg.segbase |= (h & 0xff) << 16; | sdp->u.seg.segbase |= (h & 0xff) << 16; | 
| descp->u.seg.segbase |= l >> 16; | sdp->u.seg.segbase |= l >> 16; | 
| descp->u.seg.limit  = h & 0xf0000; | sdp->u.seg.limit  = h & 0xf0000; | 
| descp->u.seg.limit |= l & 0xffff; | sdp->u.seg.limit |= l & 0xffff; | 
| if (descp->u.seg.g) { | if (sdp->u.seg.g) { | 
| descp->u.seg.limit <<= 12; | sdp->u.seg.limit <<= 12; | 
| descp->u.seg.limit |= 0xfff; | sdp->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_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; | break; | 
 |  |  | 
 | case CPU_SYSDESC_TYPE_CALL_16:          /* 286 call gate */ | case CPU_SYSDESC_TYPE_CALL_16:          /* 286 call gate */ | 
| Line 302  load_descriptor(descriptor_t *descp, UIN | Line 280  load_descriptor(descriptor_t *descp, UIN | 
 | case CPU_SYSDESC_TYPE_INTR_32:          /* 386 interrupt gate */ | case CPU_SYSDESC_TYPE_INTR_32:          /* 386 interrupt gate */ | 
 | case CPU_SYSDESC_TYPE_TRAP_32:          /* 386 trap gate */ | case CPU_SYSDESC_TYPE_TRAP_32:          /* 386 trap gate */ | 
 | if ((h & 0x0000000e0) == 0) { | if ((h & 0x0000000e0) == 0) { | 
| descp->valid = 1; | sdp->valid = 1; | 
| descp->d = (h & CPU_GATEDESC_H_D) ? 1:0; | sdp->d = (h & CPU_GATEDESC_H_D) ? 1 : 0; | 
| descp->u.gate.selector = (UINT16)(l >> 16); | sdp->u.gate.selector = (UINT16)(l >> 16); | 
| descp->u.gate.offset  = h & 0xffff0000; | sdp->u.gate.offset  = h & 0xffff0000; | 
| descp->u.gate.offset |= l & 0xffff; | sdp->u.gate.offset |= l & 0xffff; | 
| descp->u.gate.count = (BYTE)(h & 0x1f); | sdp->u.gate.count = (UINT8)(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")); |  | 
 | } else { | } else { | 
| ia32_panic("load_descriptor: 386 gate is invalid"); | sdp->valid = 0; | 
|  | VERBOSE(("load_descriptor: gate is invalid")); | 
 | } | } | 
 | break; | break; | 
 |  |  | 
 | case 0: case 8: case 10: case 13: /* reserved */ | case 0: case 8: case 10: case 13: /* reserved */ | 
 | default: | default: | 
| descp->valid = 0; | sdp->valid = 0; | 
 | break; | break; | 
 | } | } | 
 | } | } | 
 |  | #if defined(DEBUG) | 
 |  | segdesc_dump(sdp); | 
 |  | #endif | 
 | } | } | 
 |  |  | 
 | int | int | 
| Line 342  parse_selector(selector_t *ssp, UINT16 s | Line 321  parse_selector(selector_t *ssp, UINT16 s | 
 | idx = selector & CPU_SEGMENT_SELECTOR_INDEX_MASK; | idx = selector & CPU_SEGMENT_SELECTOR_INDEX_MASK; | 
 | if (ssp->ldt) { | if (ssp->ldt) { | 
 | /* LDT */ | /* LDT */ | 
| if (!CPU_LDTR_DESC.valid) { | if (!SEG_IS_VALID(&CPU_LDTR_DESC)) { | 
 | VERBOSE(("parse_selector: LDT is invalid")); | VERBOSE(("parse_selector: LDT is invalid")); | 
 | return -1; | return -1; | 
 | } | } | 
| Line 358  parse_selector(selector_t *ssp, UINT16 s | Line 337  parse_selector(selector_t *ssp, UINT16 s | 
 | limit = CPU_GDTR_LIMIT; | limit = CPU_GDTR_LIMIT; | 
 | } | } | 
 | if (idx + 7 > limit) { | if (idx + 7 > limit) { | 
| VERBOSE(("parse_selector: segment limit check failed")); | VERBOSE(("parse_selector: segment limit check failed: 0x%08x > 0x%08x", idx + 7, limit)); | 
 | return -3; | return -3; | 
 | } | } | 
 |  |  | 
 | /* load descriptor */ | /* load descriptor */ | 
 | ssp->addr = base + idx; | ssp->addr = base + idx; | 
 | load_descriptor(&ssp->desc, ssp->addr); | load_descriptor(&ssp->desc, ssp->addr); | 
| if (!ssp->desc.valid) { | if (!SEG_IS_VALID(&ssp->desc)) { | 
 | VERBOSE(("parse_selector: segment descriptor is invalid")); | VERBOSE(("parse_selector: segment descriptor is invalid")); | 
 | return -4; | return -4; | 
 | } | } | 
| Line 379  selector_is_not_present(const selector_t | Line 358  selector_is_not_present(const selector_t | 
 | UINT32 h; | UINT32 h; | 
 |  |  | 
 | /* not present */ | /* not present */ | 
| if (!ssp->desc.p) { | if (!SEG_IS_PRESENT(&ssp->desc)) { | 
 | VERBOSE(("selector_is_not_present: not present")); | VERBOSE(("selector_is_not_present: not present")); | 
 | return -1; | return -1; | 
 | } | } | 
 |  |  | 
 | /* set access bit if code/data segment descriptor */ | /* set access bit if code/data segment descriptor */ | 
| if (ssp->desc.s) { | if (!SEG_IS_SYSTEM(&ssp->desc)) { | 
 | h = cpu_kmemoryread_d(ssp->addr + 4); | h = cpu_kmemoryread_d(ssp->addr + 4); | 
 | if (!(h & CPU_SEGDESC_H_A)) { | if (!(h & CPU_SEGDESC_H_A)) { | 
 | h |= CPU_SEGDESC_H_A; | h |= CPU_SEGDESC_H_A; | 
| Line 395  selector_is_not_present(const selector_t | Line 374  selector_is_not_present(const selector_t | 
 |  |  | 
 | return 0; | return 0; | 
 | } | } | 
 |  |  | 
 |  | void | 
 |  | segdesc_init(int idx, UINT16 sreg, descriptor_t *sdp) | 
 |  | { | 
 |  |  | 
 |  | __ASSERT(((unsigned int)idx < CPU_SEGREG_NUM)); | 
 |  | __ASSERT((sdp != NULL)); | 
 |  |  | 
 |  | CPU_REGS_SREG(idx) = sreg; | 
 |  | segdesc_clear(sdp); | 
 |  | sdp->u.seg.limit = 0xffff; | 
 |  | segdesc_set_default(idx, sreg, sdp); | 
 |  | } | 
 |  |  | 
 |  | void | 
 |  | segdesc_set_default(int idx, UINT16 selector, descriptor_t *sdp) | 
 |  | { | 
 |  |  | 
 |  | __ASSERT(((unsigned int)idx < CPU_SEGREG_NUM)); | 
 |  | __ASSERT((sdp != NULL)); | 
 |  |  | 
 |  | sdp->u.seg.segbase = (UINT32)selector << 4; | 
 |  | /* sdp->u.seg.limit */ | 
 |  | sdp->u.seg.c = (idx == CPU_CS_INDEX) ? 1 : 0;   /* code or data */ | 
 |  | sdp->u.seg.g = 0;       /* non 4k factor scale */ | 
 |  | sdp->u.seg.wr = 1;      /* execute/read(CS) or read/write(others) */ | 
 |  | sdp->u.seg.ec = 0;      /* nonconforming(CS) or expand-up(others) */ | 
 |  | sdp->valid = 1;         /* valid */ | 
 |  | sdp->p = 1;             /* present */ | 
 |  | sdp->type = (CPU_SEGDESC_TYPE_WR << CPU_DESC_H_TYPE_SHIFT) | 
 |  | | ((idx == CPU_CS_INDEX) ? CPU_SEGDESC_H_D_C : 0); | 
 |  | /* readable code/writable data segment */ | 
 |  | sdp->dpl = CPU_STAT_VM86 ? 3 : 0; /* descriptor privilege level */ | 
 |  | sdp->rpl = CPU_STAT_VM86 ? 3 : 0; /* request privilege level */ | 
 |  | sdp->s = 1;             /* code/data */ | 
 |  | sdp->d = 0;             /* 16bit */ | 
 |  | sdp->flag = CPU_DESC_FLAG_READABLE|CPU_DESC_FLAG_WRITABLE; | 
 |  | } |