--- np2/i386c/ia32/ctrlxfer.c 2004/02/13 14:50:17 1.11 +++ np2/i386c/ia32/ctrlxfer.c 2008/01/25 17:49:46 1.19 @@ -1,4 +1,4 @@ -/* $Id: ctrlxfer.c,v 1.11 2004/02/13 14:50:17 monaka Exp $ */ +/* $Id: ctrlxfer.c,v 1.19 2008/01/25 17:49:46 monaka Exp $ */ /* * Copyright (c) 2003 NONAKA Kimihiro @@ -12,8 +12,6 @@ * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * 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 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES @@ -37,13 +35,13 @@ /*------------------------------------------------------------------------------ * JMPfar_pm */ -static void JMPfar_pm_code_segment(selector_t *jmp_sel, DWORD new_ip); -static void JMPfar_pm_call_gate(selector_t *jmp_sel); -static void JMPfar_pm_task_gate(selector_t *jmp_sel); -static void JMPfar_pm_tss(selector_t *jmp_sel); +static void JMPfar_pm_code_segment(const selector_t *cs_sel, UINT32 new_ip); +static void JMPfar_pm_call_gate(const selector_t *callgate_sel); +static void JMPfar_pm_task_gate(selector_t *taskgate_sel); +static void JMPfar_pm_tss(selector_t *tss_sel); void -JMPfar_pm(WORD selector, DWORD new_ip) +JMPfar_pm(UINT16 selector, UINT32 new_ip) { selector_t jmp_sel; int rv; @@ -106,7 +104,7 @@ JMPfar_pm(WORD selector, DWORD new_ip) * JMPfar: code segment */ static void -JMPfar_pm_code_segment(selector_t *cs_sel, DWORD new_ip) +JMPfar_pm_code_segment(const selector_t *cs_sel, UINT32 new_ip) { VERBOSE(("JMPfar_pm: CODE-SEGMENT")); @@ -152,7 +150,7 @@ JMPfar_pm_code_segment(selector_t *cs_se * JMPfar: call gate */ static void -JMPfar_pm_call_gate(selector_t *callgate_sel) +JMPfar_pm_call_gate(const selector_t *callgate_sel) { selector_t cs_sel; int rv; @@ -318,13 +316,13 @@ JMPfar_pm_tss(selector_t *tss_sel) /*------------------------------------------------------------------------------ * CALLfar_pm */ -static void CALLfar_pm_code_segment(selector_t *call_sel, DWORD new_ip); -static void CALLfar_pm_call_gate(selector_t *call_sel); -static void CALLfar_pm_task_gate(selector_t *call_sel); -static void CALLfar_pm_tss(selector_t *call_sel); +static void CALLfar_pm_code_segment(const selector_t *cs_sel, UINT32 new_ip); +static void CALLfar_pm_call_gate(const selector_t *callgate_sel); +static void CALLfar_pm_task_gate(selector_t *taskgate_sel); +static void CALLfar_pm_tss(selector_t *tss_sel); void -CALLfar_pm(WORD selector, DWORD new_ip) +CALLfar_pm(UINT16 selector, UINT32 new_ip) { selector_t call_sel; int rv; @@ -387,9 +385,9 @@ CALLfar_pm(WORD selector, DWORD new_ip) * CALLfar_pm: code segment */ static void -CALLfar_pm_code_segment(selector_t *cs_sel, DWORD new_ip) +CALLfar_pm_code_segment(const selector_t *cs_sel, UINT32 new_ip) { - DWORD sp; + UINT32 sp; VERBOSE(("CALLfar_pm: CODE-SEGMENT")); @@ -426,7 +424,7 @@ CALLfar_pm_code_segment(selector_t *cs_s sp = CPU_SP; } if (CPU_INST_OP32) { - CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 8); + STACK_PUSH_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 8); /* out of range */ if (new_ip > cs_sel->desc.u.seg.limit) { @@ -437,7 +435,7 @@ CALLfar_pm_code_segment(selector_t *cs_s PUSH0_32(CPU_CS); PUSH0_32(CPU_EIP); } else { - CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 4); + STACK_PUSH_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 4); /* out of range */ if (new_ip > cs_sel->desc.u.seg.limit) { @@ -456,11 +454,11 @@ CALLfar_pm_code_segment(selector_t *cs_s /*--- * CALLfar_pm: call gate */ -static void CALLfar_pm_call_gate_same_privilege(selector_t *call_sel, selector_t *cs_sel); -static void CALLfar_pm_call_gate_more_privilege(selector_t *call_sel, selector_t *cs_sel); +static void CALLfar_pm_call_gate_same_privilege(const selector_t *call_sel, selector_t *cs_sel); +static void CALLfar_pm_call_gate_more_privilege(const selector_t *call_sel, selector_t *cs_sel); static void -CALLfar_pm_call_gate(selector_t *callgate_sel) +CALLfar_pm_call_gate(const selector_t *callgate_sel) { selector_t cs_sel; int rv; @@ -529,9 +527,9 @@ CALLfar_pm_call_gate(selector_t *callgat * CALLfar_pm: call gate (SAME-PRIVILEGE) */ static void -CALLfar_pm_call_gate_same_privilege(selector_t *callgate_sel, selector_t *cs_sel) +CALLfar_pm_call_gate_same_privilege(const selector_t *callgate_sel, selector_t *cs_sel) { - DWORD sp; + UINT32 sp; VERBOSE(("CALLfar_pm: SAME-PRIVILEGE")); @@ -542,7 +540,7 @@ CALLfar_pm_call_gate_same_privilege(sele } if (callgate_sel->desc.type == CPU_SYSDESC_TYPE_CALL_32) { - CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 8); + STACK_PUSH_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 8); PUSH0_32(CPU_CS); PUSH0_32(CPU_EIP); @@ -550,7 +548,7 @@ CALLfar_pm_call_gate_same_privilege(sele load_cs(cs_sel->selector, &cs_sel->desc, CPU_STAT_CPL); SET_EIP(callgate_sel->desc.u.gate.offset); } else { - CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 4); + STACK_PUSH_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 4); PUSH0_16(CPU_CS); PUSH0_16(CPU_IP); @@ -564,14 +562,14 @@ CALLfar_pm_call_gate_same_privilege(sele * CALLfar_pm: call gate (MORE-PRIVILEGE) */ static void -CALLfar_pm_call_gate_more_privilege(selector_t *callgate_sel, selector_t *cs_sel) +CALLfar_pm_call_gate_more_privilege(const selector_t *callgate_sel, selector_t *cs_sel) { - DWORD param[32]; /* copy param */ + UINT32 param[32]; /* copy param */ selector_t ss_sel; - DWORD old_eip, old_esp; - DWORD new_esp; - WORD old_cs, old_ss; - WORD new_ss; + UINT32 old_eip, old_esp; + UINT32 new_esp; + UINT16 old_cs, old_ss; + UINT16 new_ss; int param_count; int i; int rv; @@ -631,7 +629,7 @@ CALLfar_pm_call_gate_more_privilege(sele VERBOSE(("CALLfar_pm: param_count = %d", param_count)); if (callgate_sel->desc.type == CPU_SYSDESC_TYPE_CALL_32) { - CHECK_STACK_PUSH(&ss_sel.desc, new_esp, 16 + param_count * 4); + STACK_PUSH_CHECK(ss_sel.idx, &ss_sel.desc, new_esp, 16 + param_count * 4); /* dump param */ for (i = 0; i < param_count; i++) { @@ -643,7 +641,7 @@ CALLfar_pm_call_gate_more_privilege(sele if (CPU_STAT_SS32) { CPU_ESP = new_esp; } else { - CPU_SP = new_esp; + CPU_SP = (UINT16)new_esp; } load_cs(cs_sel->selector, &cs_sel->desc, cs_sel->desc.dpl); @@ -661,7 +659,7 @@ CALLfar_pm_call_gate_more_privilege(sele PUSH0_32(old_cs); PUSH0_32(old_eip); } else { - CHECK_STACK_PUSH(&ss_sel.desc, new_esp, 8 + param_count * 2); + STACK_PUSH_CHECK(ss_sel.idx, &ss_sel.desc, new_esp, 8 + param_count * 2); /* dump param */ for (i = 0; i < param_count; i++) { @@ -673,7 +671,7 @@ CALLfar_pm_call_gate_more_privilege(sele if (CPU_STAT_SS32) { CPU_ESP = new_esp; } else { - CPU_SP = new_esp; + CPU_SP = (UINT16)new_esp; } load_cs(cs_sel->selector, &cs_sel->desc, cs_sel->desc.dpl); @@ -786,12 +784,12 @@ CALLfar_pm_tss(selector_t *tss_sel) */ void -RETfar_pm(DWORD nbytes) +RETfar_pm(UINT nbytes) { selector_t cs_sel, ss_sel, temp_sel; - DWORD sp; - DWORD new_ip, new_sp; - WORD new_cs, new_ss; + UINT32 sp; + UINT32 new_ip, new_sp; + UINT16 new_cs, new_ss; int rv; int i; @@ -803,11 +801,11 @@ RETfar_pm(DWORD nbytes) sp = CPU_SP; } if (CPU_INST_OP32) { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, nbytes + 8); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, nbytes + 8); new_ip = cpu_vmemoryread_d(CPU_SS_INDEX, sp); new_cs = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 4); } else { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, nbytes + 4); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, nbytes + 4); new_ip = cpu_vmemoryread_w(CPU_SS_INDEX, sp); new_cs = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 2); } @@ -863,7 +861,7 @@ RETfar_pm(DWORD nbytes) if (CPU_STAT_SS32) { CPU_ESP += nbytes; } else { - CPU_SP += nbytes; + CPU_SP += (UINT16)nbytes; } load_cs(cs_sel.selector, &cs_sel.desc, CPU_STAT_CPL); @@ -872,11 +870,11 @@ RETfar_pm(DWORD nbytes) VERBOSE(("RETfar_pm: RETURN-OUTER-PRIVILEGE-LEVEL")); if (CPU_INST_OP32) { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 8 + 8 + nbytes); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 8 + 8 + nbytes); new_sp = cpu_vmemoryread_d(CPU_SS_INDEX, sp + 8 + nbytes); new_ss = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 8 + nbytes + 4); } else { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 4 + 4 + nbytes); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 4 + 4 + nbytes); new_sp = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 4 + nbytes); new_ss = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 4 + nbytes + 2); } @@ -933,7 +931,7 @@ RETfar_pm(DWORD nbytes) if (CPU_STAT_SS32) { CPU_ESP = new_sp + nbytes; } else { - CPU_SP = new_sp + nbytes; + CPU_SP = (UINT16)(new_sp + nbytes); } /* check segment register */ @@ -989,19 +987,18 @@ RETfar_pm(DWORD nbytes) * IRET_pm */ static void IRET_pm_nested_task(void); -static void IRET_pm_protected_mode_return(DWORD new_cs, DWORD new_ip, DWORD new_flags); -static void IRET_pm_protected_mode_return_same_privilege(selector_t *cs_sel, DWORD new_ip, DWORD new_flags); -static void IRET_pm_protected_mode_return_outer_privilege(selector_t *cs_sel, DWORD new_ip, DWORD new_flags); -static void IRET_pm_return_to_vm86(DWORD new_cs, DWORD new_ip, DWORD new_flags); -static void IRET_pm_return_from_vm86(DWORD new_cs, DWORD new_ip, DWORD new_flags); +static void IRET_pm_protected_mode_return(UINT16 new_cs, UINT32 new_ip, UINT32 new_flags); +static void IRET_pm_protected_mode_return_same_privilege(const selector_t *cs_sel, UINT32 new_ip, UINT32 new_flags); +static void IRET_pm_protected_mode_return_outer_privilege(const selector_t *cs_sel, UINT32 new_ip, UINT32 new_flags); +static void IRET_pm_return_to_vm86(UINT16 new_cs, UINT32 new_ip, UINT32 new_flags); +static void IRET_pm_return_from_vm86(UINT16 new_cs, UINT32 new_ip, UINT32 new_flags); void IRET_pm(void) { - DWORD sp; - DWORD new_ip, new_flags; - WORD new_cs; - int rv; + UINT32 sp; + UINT32 new_ip, new_flags; + UINT16 new_cs; VERBOSE(("IRET_pm: old EIP = %04x:%08x, ESP = %04x:%08x", CPU_CS, CPU_PREV_EIP, CPU_SS, CPU_ESP)); @@ -1015,12 +1012,12 @@ IRET_pm(void) sp = CPU_SP; } if (CPU_INST_OP32) { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 12); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 12); new_ip = cpu_vmemoryread_d(CPU_SS_INDEX, sp); new_cs = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 4); new_flags = cpu_vmemoryread_d(CPU_SS_INDEX, sp + 8); } else { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 6); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 6); new_ip = cpu_vmemoryread_w(CPU_SS_INDEX, sp); new_cs = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 2); new_flags = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 4); @@ -1050,8 +1047,8 @@ static void IRET_pm_nested_task(void) { selector_t tss_sel; + UINT16 new_tss; int rv; - WORD new_tss; VERBOSE(("IRET_pm: TASK-RETURN: PE=1, VM=0, NT=1")); @@ -1065,7 +1062,7 @@ IRET_pm_nested_task(void) /* check system segment */ if (tss_sel.desc.s) { - VERBOSE(("IRET_pm: task segment is %d segment", tss_sel.desc.u.seg.c ? "code" : "data")); + VERBOSE(("IRET_pm: task segment is %s segment", tss_sel.desc.u.seg.c ? "code" : "data")); EXCEPTION(GP_EXCEPTION, tss_sel.idx); } @@ -1097,7 +1094,7 @@ IRET_pm_nested_task(void) * IRET_pm: PROTECTED-MODE-RETURN */ static void -IRET_pm_protected_mode_return(DWORD new_cs, DWORD new_ip, DWORD new_flags) +IRET_pm_protected_mode_return(UINT16 new_cs, UINT32 new_ip, UINT32 new_flags) { selector_t cs_sel; int rv; @@ -1148,10 +1145,10 @@ IRET_pm_protected_mode_return(DWORD new_ * IRET_pm: SAME-PRIVILEGE */ static void -IRET_pm_protected_mode_return_same_privilege(selector_t *cs_sel, DWORD new_ip, DWORD new_flags) +IRET_pm_protected_mode_return_same_privilege(const selector_t *cs_sel, UINT32 new_ip, UINT32 new_flags) { - DWORD mask; - DWORD stacksize; + UINT32 mask; + UINT stacksize; VERBOSE(("IRET_pm: RETURN-TO-SAME-PRIVILEGE-LEVEL")); @@ -1172,6 +1169,7 @@ IRET_pm_protected_mode_return_same_privi mask |= VM_FLAG|VIF_FLAG|VIP_FLAG; } } + if (CPU_INST_OP32) { stacksize = 12; } else { @@ -1187,7 +1185,7 @@ IRET_pm_protected_mode_return_same_privi if (CPU_STAT_SS32) { CPU_ESP += stacksize; } else { - CPU_SP += stacksize; + CPU_SP += (UINT16)stacksize; } } @@ -1195,14 +1193,14 @@ IRET_pm_protected_mode_return_same_privi * IRET_pm: OUTER-PRIVILEGE */ static void -IRET_pm_protected_mode_return_outer_privilege(selector_t *cs_sel, DWORD new_ip, DWORD new_flags) +IRET_pm_protected_mode_return_outer_privilege(const selector_t *cs_sel, UINT32 new_ip, UINT32 new_flags) { descriptor_t *dp; selector_t ss_sel; - DWORD mask; - DWORD sp; - DWORD new_sp; - WORD new_ss; + UINT32 mask; + UINT32 sp; + UINT32 new_sp; + UINT16 new_ss; int rv; int i; @@ -1214,11 +1212,11 @@ IRET_pm_protected_mode_return_outer_priv sp = CPU_SP; } if (CPU_INST_OP32) { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 20); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 20); new_sp = cpu_vmemoryread_d(CPU_SS_INDEX, sp + 12); new_ss = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 16); } else { - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 10); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 10); new_sp = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 6); new_ss = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 8); } @@ -1288,7 +1286,7 @@ IRET_pm_protected_mode_return_outer_priv if (CPU_STAT_SS32) { CPU_ESP = new_sp; } else { - CPU_SP = new_sp; + CPU_SP = (UINT16)new_sp; } /* check segment register */ @@ -1300,7 +1298,6 @@ IRET_pm_protected_mode_return_outer_priv /* segment register is invalid */ CPU_REGS_SREG(i) = 0; CPU_STAT_SREG_CLEAR(i); - continue; } } } @@ -1310,11 +1307,11 @@ IRET_pm_protected_mode_return_outer_priv * IRET_pm: new_flags & VM_FLAG */ static void -IRET_pm_return_to_vm86(DWORD new_cs, DWORD new_ip, DWORD new_flags) +IRET_pm_return_to_vm86(UINT16 new_cs, UINT32 new_ip, UINT32 new_flags) { - WORD segsel[CPU_SEGREG_NUM]; - DWORD sp; - DWORD new_sp; + UINT16 segsel[CPU_SEGREG_NUM]; + UINT32 sp; + UINT32 new_sp; int i; VERBOSE(("IRET_pm: Interrupt procedure was in virtual-8086 mode: PE=1, VM=1 in flags image")); @@ -1332,14 +1329,14 @@ IRET_pm_return_to_vm86(DWORD new_cs, DWO } else { sp = CPU_SP; } - CHECK_STACK_POP(&CPU_STAT_SREG(CPU_SS_INDEX), sp, 36); + STACK_POP_CHECK(CPU_REGS_SREG(CPU_SS_INDEX), &CPU_STAT_SREG(CPU_SS_INDEX), sp, 36); new_sp = cpu_vmemoryread_d(CPU_SS_INDEX, sp + 12); segsel[CPU_SS_INDEX] = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 16); segsel[CPU_ES_INDEX] = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 20); segsel[CPU_DS_INDEX] = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 24); segsel[CPU_FS_INDEX] = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 28); segsel[CPU_GS_INDEX] = cpu_vmemoryread_w(CPU_SS_INDEX, sp + 32); - segsel[CPU_CS_INDEX] = new_cs; + segsel[CPU_CS_INDEX] = (UINT16)new_cs; for (i = 0; i < CPU_SEGREG_NUM; i++) { CPU_REGS_SREG(i) = segsel[i]; @@ -1360,9 +1357,9 @@ IRET_pm_return_to_vm86(DWORD new_cs, DWO * IRET_pm: VM_FLAG */ static void -IRET_pm_return_from_vm86(DWORD new_cs, DWORD new_ip, DWORD new_flags) +IRET_pm_return_from_vm86(UINT16 new_cs, UINT32 new_ip, UINT32 new_flags) { - DWORD stacksize; + UINT stacksize; VERBOSE(("IRET_pm: virtual-8086 mode: VM=1")); @@ -1376,7 +1373,7 @@ IRET_pm_return_from_vm86(DWORD new_cs, D if (CPU_STAT_SS32) { CPU_ESP += stacksize; } else { - CPU_SP += stacksize; + CPU_SP += (UINT16)stacksize; } set_eflags(new_flags, I_FLAG|RF_FLAG);