--- np2/i386c/ia32/segments.c	2004/01/23 14:33:26	1.7
+++ np2/i386c/ia32/segments.c	2004/03/23 22:39:40	1.16
@@ -1,4 +1,4 @@
-/*	$Id: segments.c,v 1.7 2004/01/23 14:33:26 monaka Exp $	*/
+/*	$Id: segments.c,v 1.16 2004/03/23 22:39:40 yui Exp $	*/
 
 /*
  * Copyright (c) 2003 NONAKA Kimihiro
@@ -33,7 +33,7 @@
 
 
 void
-load_segreg(int idx, WORD selector, int exc)
+load_segreg(int idx, UINT16 selector, int exc)
 {
 	selector_t sel;
 	int rv;
@@ -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;
 	}
 
@@ -82,9 +77,11 @@ load_segreg(int idx, WORD selector, int 
 
 	switch (idx) {
 	case CPU_SS_INDEX:
-		if ((CPU_STAT_CPL != sel.rpl) ||
-		    !sel.desc.s || sel.desc.u.seg.c || !sel.desc.u.seg.wr ||
-		    (CPU_STAT_CPL != sel.desc.dpl)) {
+		if ((CPU_STAT_CPL != sel.rpl)
+		 || (CPU_STAT_CPL != sel.desc.dpl)
+		 || !sel.desc.s
+		 || sel.desc.u.seg.c
+		 || !sel.desc.u.seg.wr) {
 			EXCEPTION(exc, sel.idx);
 		}
 
@@ -134,34 +131,34 @@ load_segreg(int idx, WORD selector, int 
  * load SS register
  */
 void
-load_ss(WORD selector, descriptor_t* sdp, BYTE cpl)
+load_ss(UINT16 selector, const descriptor_t *sd, UINT cpl)
 {
 
-	CPU_STAT_SS32 = sdp->d;
-	CPU_REGS_SREG(CPU_SS_INDEX) = (selector & ~3) | (cpl & 3);
-	CPU_STAT_SREG(CPU_SS_INDEX) = *sdp;
+	CPU_STAT_SS32 = sd->d;
+	CPU_REGS_SREG(CPU_SS_INDEX) = (UINT16)((selector & ~3) | (cpl & 3));
+	CPU_STAT_SREG(CPU_SS_INDEX) = *sd;
 }
 
 /*
  * load CS register
  */
 void
-load_cs(WORD selector, descriptor_t* sdp, BYTE cpl)
+load_cs(UINT16 selector, const descriptor_t *sd, UINT 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_STAT_SREG(CPU_CS_INDEX) = *sdp;
-	CPU_STAT_CPL = cpl & 3;
+	    CPU_STATSAVE.cpu_inst_default.as_32 = sd->d;
+	CPU_REGS_SREG(CPU_CS_INDEX) = (UINT16)((selector & ~3) | (cpl & 3));
+	CPU_STAT_SREG(CPU_CS_INDEX) = *sd;
+	CPU_SET_CPL(cpl & 3);
 }
 
 /*
  * load LDT register
  */
 void
-load_ldtr(WORD selector, int exc)
+load_ldtr(UINT16 selector, int exc)
 {
 	selector_t sel;
 	int rv;
@@ -193,7 +190,7 @@ load_ldtr(WORD selector, int exc)
 		EXCEPTION((exc == TS_EXCEPTION) ? TS_EXCEPTION : NP_EXCEPTION, sel.selector);
 	}
 
-#if defined(DEBUG)
+#if defined(MORE_DEBUG)
 	ldtr_dump(sel.desc.u.seg.segbase, sel.desc.u.seg.limit);
 #endif
 
@@ -202,39 +199,39 @@ load_ldtr(WORD selector, int exc)
 }
 
 void
-load_descriptor(descriptor_t *descp, DWORD addr)
+load_descriptor(descriptor_t *descp, UINT32 addr)
 {
+	UINT32 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 = (UINT8)((h & CPU_DESC_H_TYPE) >> 8);
+	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));
 
 	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 +247,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 +266,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 = (UINT16)(l >> 16);
 
 			VERBOSE(("load_descriptor: task descriptor: selector = 0x%04x", descp->u.gate.selector));
 			break;
@@ -279,21 +276,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 +301,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 = (UINT16)(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"));
@@ -322,28 +319,27 @@ load_descriptor(descriptor_t *descp, DWO
 		case 0: case 8: case 10: case 13: /* reserved */
 		default:
 			descp->valid = 0;
-			ia32_panic("load_descriptor: bad descriptor (type = %d)", descp->type);
 			break;
 		}
 	}
 }
 
 int
-parse_selector(selector_t* ssp, WORD selector)
+parse_selector(selector_t *ssp, UINT16 selector)
 {
-	DWORD base;
-	WORD limit;
-	WORD idx;
+	UINT32 base;
+	UINT limit;
+	UINT idx;
 
 	ssp->selector = selector;
 	ssp->idx = selector & ~3;
 	ssp->rpl = selector & 3;
-	ssp->ldt = selector & CPU_SEGMENT_TABLE_IND;
+	ssp->ldt = (UINT8)(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) {
@@ -365,23 +361,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(const selector_t *ssp)
 {
+	UINT32 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;
 }