|
|
| version 1.3, 2004/01/15 15:50:33 | version 1.10, 2004/02/09 16:12:07 |
|---|---|
| Line 31 | Line 31 |
| #include "cpu.h" | #include "cpu.h" |
| #include "ia32.mcr" | #include "ia32.mcr" |
| void | const char *exception_str[EXCEPTION_NUM] = { |
| memory_dump(int idx, DWORD madr) | |
| { | |
| DWORD addr; | |
| size_t size; | |
| unsigned char buf[16]; | |
| size_t s, i; | |
| BYTE p; | |
| if (madr < 0x80) { | |
| size = madr + 0x80; | |
| addr = 0; | |
| } else { | |
| size = 0x100; | |
| addr = madr - 0x80; | |
| } | |
| printf("memory dump\n-- \n"); | |
| for (s = 0; s < size; s++) { | |
| if ((s % 16) == 0) { | |
| printf("%08x: ", addr + s); | |
| memset(buf, '.', sizeof(buf)); | |
| } | |
| p = cpu_vmemoryread(idx, addr + s); | |
| printf("%02x ", p); | |
| if (p >= 0x20 && p <= 0x7e) | |
| buf[s % 16] = p; | |
| if ((s % 16) == 15) { | |
| printf("| "); | |
| for (i = 0; i < sizeof(buf); i++) | |
| printf("%c", buf[i]); | |
| printf("\n"); | |
| } | |
| } | |
| } | |
| static const char *exception_str[EXCEPTION_NUM] = { | |
| "DE_EXCEPTION", | "DE_EXCEPTION", |
| "DB_EXCEPTION", | "DB_EXCEPTION", |
| "NMI_EXCEPTION", | "NMI_EXCEPTION", |
| Line 109 exception(int num, int error_code) | Line 72 exception(int num, int error_code) |
| __ASSERT((unsigned int)num < EXCEPTION_NUM); | __ASSERT((unsigned int)num < EXCEPTION_NUM); |
| VERBOSE(("exception: %s, error_code = %x", exception_str[num], error_code)); | VERBOSE(("exception: -------------------------------------------------------------- start")); |
| VERBOSE(("exception: %s, error_code = %x at %04x:%08x", exception_str[num], error_code, CPU_CS, CPU_PREV_EIP)); | |
| CPU_STAT_NERROR++; | VERBOSE(("%s", cpu_reg2str())); |
| if ((CPU_STAT_NERROR >= 3) | |
| || (CPU_STAT_NERROR == 2 && CPU_STAT_PREV_EXCEPTION == DF_EXCEPTION)) { | CPU_STAT_EXCEPTION_COUNTER_INC(); |
| if ((CPU_STAT_EXCEPTION_COUNTER >= 3) | |
| || (CPU_STAT_EXCEPTION_COUNTER == 2 && CPU_STAT_PREV_EXCEPTION == DF_EXCEPTION)) { | |
| /* Triple fault */ | /* Triple fault */ |
| ia32_panic("exception: catch triple fault!"); | ia32_panic("exception: catch triple fault!"); |
| } | } |
| Line 137 exception(int num, int error_code) | Line 102 exception(int num, int error_code) |
| error_code = 0; | error_code = 0; |
| break; | break; |
| #if CPU_FAMILY >= 4 | |
| case AC_EXCEPTION: /* (F) アラインメントチェック (errcode: 0) */ | case AC_EXCEPTION: /* (F) アラインメントチェック (errcode: 0) */ |
| error_code = 0; | error_code = 0; |
| /*FALLTHROUGH*/ | /*FALLTHROUGH*/ |
| #endif | |
| case TS_EXCEPTION: /* (F) 無効 TSS (errcode) */ | case TS_EXCEPTION: /* (F) 無効 TSS (errcode) */ |
| case NP_EXCEPTION: /* (F) セグメント不在 (errcode) */ | case NP_EXCEPTION: /* (F) セグメント不在 (errcode) */ |
| case SS_EXCEPTION: /* (F) スタックセグメントフォルト (errcode) */ | case SS_EXCEPTION: /* (F) スタックセグメントフォルト (errcode) */ |
| Line 154 exception(int num, int error_code) | Line 121 exception(int num, int error_code) |
| errorp = 0; | errorp = 0; |
| break; | break; |
| #if CPU_FAMILY >= 5 | |
| case MC_EXCEPTION: /* (A) マシンチェック */ | case MC_EXCEPTION: /* (A) マシンチェック */ |
| CPU_EIP = CPU_PREV_EIP; | CPU_EIP = CPU_PREV_EIP; |
| errorp = 0; | errorp = 0; |
| break; | break; |
| #endif | |
| #if CPU_FAMILY >= 6 | |
| case XF_EXCEPTION: /* (F) ストリーミング SIMD 拡張命令 */ | case XF_EXCEPTION: /* (F) ストリーミング SIMD 拡張命令 */ |
| CPU_EIP = CPU_PREV_EIP; | CPU_EIP = CPU_PREV_EIP; |
| errorp = 0; | errorp = 0; |
| break; | break; |
| #endif | |
| default: | default: |
| ia32_panic("exception(): unknown exception (%d)", num); | ia32_panic("exception: unknown exception (%d)", num); |
| break; | break; |
| } | } |
| if (CPU_STAT_NERROR >= 2) { | if (CPU_STAT_EXCEPTION_COUNTER >= 2) { |
| if (dftable[exctype[CPU_STAT_PREV_EXCEPTION]][exctype[num]]) { | if (dftable[exctype[CPU_STAT_PREV_EXCEPTION]][exctype[num]]) { |
| num = DF_EXCEPTION; | num = DF_EXCEPTION; |
| } | } |
| } | } |
| CPU_STAT_PREV_EXCEPTION = num; | CPU_STAT_PREV_EXCEPTION = num; |
| INTERRUPT(num, FALSE, errorp, error_code); | VERBOSE(("exception: ---------------------------------------------------------------- end")); |
| CPU_STAT_NERROR = 0; | |
| #if defined(WIN32) | INTERRUPT(num, 0, errorp, error_code); |
| longjmp(exec_1step_jmpbuf, 1); | CPU_STAT_EXCEPTION_COUNTER_CLEAR(); |
| #else | |
| siglongjmp(exec_1step_jmpbuf, 1); | siglongjmp(exec_1step_jmpbuf, 1); |
| #endif | |
| } | } |
| /* | /* |
| Line 190 exception(int num, int error_code) | Line 159 exception(int num, int error_code) |
| * | * |
| * 31 16 15 14 13 12 8 7 5 4 0 | * 31 16 15 14 13 12 8 7 5 4 0 |
| * +------------------------------------+--+-----+----------+-----+---------+ | * +------------------------------------+--+-----+----------+-----+---------+ |
| * | オフセット 31..16 | P| DPL | 0 1 1 0 0|0 0 0|カウント | 4 | * | オフセット 31..16 | P| DPL | 0 D 1 0 0|0 0 0|カウント | 4 |
| * +------------------------------------+--+-----+----------+-----+---------+ | * +------------------------------------+--+-----+----------+-----+---------+ |
| * 31 16 15 0 | * 31 16 15 0 |
| * +------------------------------------+-----------------------------------+ | * +------------------------------------+-----------------------------------+ |
| Line 205 exception(int num, int error_code) | Line 174 exception(int num, int error_code) |
| * | * |
| * 31 16 15 14 13 12 8 7 0 | * 31 16 15 14 13 12 8 7 0 |
| * +------------------------------------+--+-----+----------+---------------+ | * +------------------------------------+--+-----+----------+---------------+ |
| * | Reserved | P| DPL | 0 D 1 0 1| Reserved | 4 | * | Reserved | P| DPL | 0 0 1 0 1| Reserved | 4 |
| * +------------------------------------+--+-----+----------+---------------+ | * +------------------------------------+--+-----+----------+---------------+ |
| * 31 16 15 0 | * 31 16 15 0 |
| * +------------------------------------+-----------------------------------+ | * +------------------------------------+-----------------------------------+ |
| Line 241 exception(int num, int error_code) | Line 210 exception(int num, int error_code) |
| * D : ゲートのサイズ.0 = 16 bit, 1 = 32 bit | * D : ゲートのサイズ.0 = 16 bit, 1 = 32 bit |
| */ | */ |
| static void interrupt_task_gate(descriptor_t *gdp, int softintp, int errorp, int error_code); | |
| static void interrupt_intr_or_trap(descriptor_t *gdp, int softintp, int errorp, int error_code); | |
| void | void |
| interrupt(int num, int softintp, int errorp, int error_code) | interrupt(int num, int softintp, int errorp, int error_code) |
| { | { |
| descriptor_t gd; | |
| DWORD idt_idx; | DWORD idt_idx; |
| DWORD new_ip; | |
| WORD new_cs; | |
| VERBOSE(("interrupt: num = 0x%02x, softintp = %s, errorp = %s, error_code = %02x", num, softintp ? "on" : "off", errorp ? "on" : "off", error_code)); | VERBOSE(("interrupt: num = 0x%02x, softintp = %s, errorp = %s, error_code = %08x", num, softintp ? "on" : "off", errorp ? "on" : "off", error_code)); |
| if (!CPU_STAT_PM) { | if (!CPU_STAT_PM) { |
| /* real mode */ | /* real mode */ |
| idt_idx = num * 4; | idt_idx = num * 4; |
| if (idt_idx + 3 > CPU_IDTR_LIMIT) { | if (idt_idx + 3 > CPU_IDTR_LIMIT) { |
| EXCEPTION(GP_EXCEPTION, num * 4 | 2); | VERBOSE(("interrupt: real-mode IDTR limit check failure (idx = 0x%04x, limit = 0x%08x", idt_idx, CPU_IDTR_LIMIT)); |
| EXCEPTION(GP_EXCEPTION, idt_idx + 2); | |
| } | } |
| if (!softintp) { | if (!softintp && CPU_STAT_HLT) { |
| BYTE op = cpu_codefetch(CPU_EIP); | CPU_EIP++; |
| if (op == 0xf4) { /* hlt */ | CPU_STAT_HLT = FALSE; |
| CPU_EIP++; | |
| } | |
| } | } |
| REGPUSH0(REAL_FLAGREG); | REGPUSH0(REAL_FLAGREG); |
| REGPUSH0(CPU_CS); | REGPUSH0(CPU_CS); |
| REGPUSH0(CPU_IP); | REGPUSH0(CPU_IP); |
| if (softintp) { | CPU_EFLAG &= ~(T_FLAG | I_FLAG | AC_FLAG | RF_FLAG); |
| CPU_EFLAG &= ~(T_FLAG | I_FLAG | AC_FLAG); | CPU_TRAP = 0; |
| CPU_TRAP = 0; | |
| } | |
| CPU_EIP = cpu_memoryread_w(CPU_IDTR_BASE + num * 4); | new_ip = cpu_memoryread_w(CPU_IDTR_BASE + idt_idx); |
| CPU_CS = cpu_memoryread_w(CPU_IDTR_BASE + num * 4 + 2); | new_cs = cpu_memoryread_w(CPU_IDTR_BASE + idt_idx + 2); |
| CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS); | CPU_SET_SEGREG(CPU_CS_INDEX, new_cs); |
| SET_EIP(new_ip); | |
| CPU_WORKCLOCK(20); | CPU_WORKCLOCK(20); |
| } else { | } else { |
| /* protected mode */ | /* protected mode */ |
| selector_t task_sel, intr_sel, ss_sel; | VERBOSE(("interrupt: -------------------------------------------------------------- start")); |
| descriptor_t gd; | |
| int rv; | VERBOSE(("interrupt: old EIP = %04x:%08x, ESP = %04x:%08x", CPU_CS, CPU_EIP, CPU_SS, CPU_ESP)); |
| DWORD flags = REAL_EFLAGREG; | |
| DWORD mask = 0; | #if defined(DEBUG) |
| DWORD new_ip, new_sp; | if (num == 0x80) { |
| DWORD old_ip, old_sp; | /* Linux, FreeBSD, NetBSD, OpenBSD system call */ |
| WORD new_ss; | VERBOSE(("interrupt: syscall no = %d\n%s", CPU_EAX, cpu_reg2str())); |
| WORD old_cs, old_ss; | } |
| #endif | |
| /* VM86 && IOPL < 3 && interrupt cause == INTn */ | /* VM86 && IOPL < 3 && interrupt cause == INTn */ |
| if (CPU_STAT_VM86 && (CPU_STAT_IOPL < CPU_IOPL3) && (softintp == -1)) { | if (CPU_STAT_VM86 && (CPU_STAT_IOPL < CPU_IOPL3) && (softintp == -1)) { |
| VERBOSE(("interrupt: VM86 && IOPL < 3 && INTn")); | |
| EXCEPTION(GP_EXCEPTION, 0); | EXCEPTION(GP_EXCEPTION, 0); |
| } | } |
| idt_idx = num * 8; | idt_idx = num * 8; |
| if (idt_idx + 7 > CPU_IDTR_LIMIT) { | if (idt_idx + 7 > CPU_IDTR_LIMIT) { |
| EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp); | VERBOSE(("interrupt: IDTR limit check failure (idx = 0x%04x, limit = 0x%08x", idt_idx, CPU_IDTR_LIMIT)); |
| EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp); | |
| } | } |
| CPU_SET_GATEDESC(&gd, CPU_IDTR_BASE + idt_idx); | memset(&gd, 0, sizeof(gd)); |
| load_descriptor(&gd, CPU_IDTR_BASE + idt_idx); | |
| if (!gd.valid || !gd.p) { | if (!gd.valid || !gd.p) { |
| EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp); | VERBOSE(("interrupt: gate descripter is invalid.")); |
| EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp); | |
| } | } |
| switch (gd.type) { | switch (gd.type) { |
| Line 311 interrupt(int num, int softintp, int err | Line 289 interrupt(int num, int softintp, int err |
| break; | break; |
| default: | default: |
| EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp); | VERBOSE(("interrupt: invalid gate type (%d)", gd.type)); |
| EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp); | |
| break; | break; |
| } | } |
| /* 5.10.1.1. 例外/割り込みハンドラ・プロシージャの保護 */ | /* 5.10.1.1. 例外/割り込みハンドラ・プロシージャの保護 */ |
| if (softintp && (gd.dpl < CPU_STAT_CPL)) { | if (softintp && (gd.dpl < CPU_STAT_CPL)) { |
| EXCEPTION(GP_EXCEPTION, num * 8 | 2); | VERBOSE(("interrupt: softintp && DPL(%d) < CPL(%d)", gd.dpl, CPU_STAT_CPL)); |
| EXCEPTION(GP_EXCEPTION, idt_idx + 2); | |
| } | |
| if (!softintp && CPU_STAT_HLT) { | |
| CPU_EIP++; | |
| CPU_STAT_HLT = FALSE; | |
| } | } |
| switch (gd.type) { | switch (gd.type) { |
| case CPU_SYSDESC_TYPE_TASK: | case CPU_SYSDESC_TYPE_TASK: |
| rv = parse_selector(&task_sel, gd.u.gate.selector); | interrupt_task_gate(&gd, softintp, errorp, error_code); |
| if (rv < 0 || task_sel.ldt) { | break; |
| EXCEPTION(TS_EXCEPTION, task_sel.idx); | |
| } | |
| /* check gate type */ | case CPU_SYSDESC_TYPE_INTR_16: |
| switch (task_sel.desc.type) { | case CPU_SYSDESC_TYPE_INTR_32: |
| case CPU_SYSDESC_TYPE_TSS_16: | case CPU_SYSDESC_TYPE_TRAP_16: |
| case CPU_SYSDESC_TYPE_TSS_32: | case CPU_SYSDESC_TYPE_TRAP_32: |
| break; | interrupt_intr_or_trap(&gd, softintp, errorp, error_code); |
| break; | |
| case CPU_SYSDESC_TYPE_TSS_BUSY_16: | |
| case CPU_SYSDESC_TYPE_TSS_BUSY_32: | |
| VERBOSE(("interrupt: task is busy.")); | |
| /*FALLTHROUGH*/ | |
| default: | |
| EXCEPTION(TS_EXCEPTION, task_sel.idx); | |
| break; | |
| } | |
| /* not present */ | default: |
| if (selector_is_not_present(&task_sel)) { | EXCEPTION(GP_EXCEPTION, idt_idx + 2 + !softintp); |
| EXCEPTION(NP_EXCEPTION, task_sel.idx); | break; |
| } | } |
| task_switch(&task_sel, TASK_SWITCH_INTR); | VERBOSE(("interrupt: ---------------------------------------------------------------- end")); |
| } | |
| } | |
| if (errorp) { | static void |
| if (task_sel.desc.type == CPU_SYSDESC_TYPE_TSS_32) { | interrupt_task_gate(descriptor_t *gdp, int softintp, int errorp, int error_code) |
| CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), CPU_ESP, 4); | { |
| PUSH0_32(error_code); | selector_t task_sel; |
| } else { | int rv; |
| CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), CPU_ESP, 2); | |
| PUSH0_16(error_code); | VERBOSE(("interrupt: TASK-GATE")); |
| } | |
| } | (void)softintp; |
| rv = parse_selector(&task_sel, gdp->u.gate.selector); | |
| if (rv < 0 || task_sel.ldt) { | |
| VERBOSE(("interrupt: parse_selector (selector = %04x, rv = %d, %cDT)", gdp->u.gate.selector, rv, task_sel.ldt ? 'L' : 'G')); | |
| EXCEPTION(TS_EXCEPTION, task_sel.idx); | |
| } | |
| /* check gate type */ | |
| switch (task_sel.desc.type) { | |
| case CPU_SYSDESC_TYPE_TSS_16: | |
| case CPU_SYSDESC_TYPE_TSS_32: | |
| break; | |
| case CPU_SYSDESC_TYPE_TSS_BUSY_16: | |
| case CPU_SYSDESC_TYPE_TSS_BUSY_32: | |
| VERBOSE(("interrupt: task is busy.")); | |
| /*FALLTHROUGH*/ | |
| default: | |
| VERBOSE(("interrupt: invalid gate type (%d)", task_sel.desc.type)); | |
| EXCEPTION(TS_EXCEPTION, task_sel.idx); | |
| break; | |
| } | |
| /* not present */ | |
| if (selector_is_not_present(&task_sel)) { | |
| VERBOSE(("interrupt: selector is not present")); | |
| EXCEPTION(NP_EXCEPTION, task_sel.idx); | |
| } | |
| task_switch(&task_sel, TASK_SWITCH_INTR); | |
| if (errorp) { | |
| XPUSH0(error_code); | |
| } | |
| } | |
| static void | |
| interrupt_intr_or_trap(descriptor_t *gdp, int softintp, int errorp, int error_code) | |
| { | |
| selector_t cs_sel, ss_sel; | |
| DWORD old_flags; | |
| DWORD new_flags; | |
| DWORD mask; | |
| DWORD stacksize; | |
| DWORD sp; | |
| DWORD new_ip, new_sp; | |
| DWORD old_ip, old_sp; | |
| WORD old_cs, old_ss, new_ss; | |
| int rv; | |
| new_ip = gdp->u.gate.offset; | |
| old_ss = CPU_SS; | |
| old_cs = CPU_CS; | |
| old_ip = CPU_EIP; | |
| old_sp = CPU_ESP; | |
| new_flags = old_flags = REAL_EFLAGREG; | |
| switch (gdp->type) { | |
| case CPU_SYSDESC_TYPE_INTR_16: | |
| case CPU_SYSDESC_TYPE_INTR_32: | |
| VERBOSE(("interrupt: INTERRUPT-GATE")); | |
| new_flags &= ~I_FLAG; | |
| mask = I_FLAG; | |
| break; | |
| /* out of range */ | case CPU_SYSDESC_TYPE_TRAP_16: |
| if (CPU_EIP > CPU_STAT_CS_LIMIT) { | case CPU_SYSDESC_TYPE_TRAP_32: |
| EXCEPTION(GP_EXCEPTION, 0); | VERBOSE(("interrupt: TRAP-GATE")); |
| mask = 0; | |
| break; | |
| } | |
| new_flags &= ~(T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG); | |
| mask |= T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG; | |
| rv = parse_selector(&cs_sel, gdp->u.gate.selector); | |
| if (rv < 0) { | |
| VERBOSE(("interrupt: parse_selector (selector = %04x, rv = %d)", gdp->u.gate.selector, rv)); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| /* check segment type */ | |
| if (!cs_sel.desc.s) { | |
| VERBOSE(("interrupt: code segment is system segment")); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| if (!cs_sel.desc.u.seg.c) { | |
| VERBOSE(("interrupt: code segment is data segment")); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| /* check privilege level */ | |
| if (cs_sel.desc.dpl > CPU_STAT_CPL) { | |
| VERBOSE(("interrupt: DPL(%d) > CPL(%d)", cs_sel.desc.dpl, CPU_STAT_CPL)); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| /* not present */ | |
| if (selector_is_not_present(&cs_sel)) { | |
| VERBOSE(("interrupt: selector is not present")); | |
| EXCEPTION(NP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| if (!cs_sel.desc.u.seg.ec | |
| && (cs_sel.desc.dpl < CPU_STAT_CPL)) { | |
| if (!CPU_STAT_VM86) { | |
| VERBOSE(("interrupt: INTER-PRIVILEGE-LEVEL-INTERRUPT")); | |
| stacksize = errorp ? 12 : 10; | |
| } else { | |
| /* VM86 */ | |
| if (cs_sel.desc.dpl != 0) { | |
| /* 16.3.1.1 */ | |
| VERBOSE(("interrupt: DPL[CS](%d) != 0", cs_sel.desc.dpl)); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx); | |
| } | } |
| VERBOSE(("interrupt: INTERRUPT-FROM-VIRTUAL-8086-MODE")); | |
| stacksize = errorp ? 20 : 18; | |
| } | |
| switch (gdp->type) { | |
| case CPU_SYSDESC_TYPE_INTR_32: | |
| case CPU_SYSDESC_TYPE_TRAP_32: | |
| stacksize *= 2; | |
| break; | break; |
| } | |
| case CPU_SYSDESC_TYPE_INTR_16: | get_stack_pointer_from_tss(cs_sel.desc.dpl, &new_ss, &new_sp); |
| rv = parse_selector(&ss_sel, new_ss); | |
| if (rv < 0) { | |
| VERBOSE(("interrupt: parse_selector (selector = %04x, rv = %d)", new_ss, rv)); | |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| /* check privilege level */ | |
| if (ss_sel.rpl != cs_sel.desc.dpl) { | |
| VERBOSE(("interrupt: RPL[SS](%d) != DPL[CS](%d)", ss_sel.rpl, cs_sel.desc.dpl)); | |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| if (ss_sel.desc.dpl != cs_sel.desc.dpl) { | |
| VERBOSE(("interrupt: DPL[SS](%d) != DPL[CS](%d)", ss_sel.desc.dpl, cs_sel.desc.dpl)); | |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| /* check segment type */ | |
| if (!ss_sel.desc.s) { | |
| VERBOSE(("interrupt: stack segment is system segment")); | |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| if (ss_sel.desc.u.seg.c) { | |
| VERBOSE(("interrupt: stack segment is code segment")); | |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| if (!ss_sel.desc.u.seg.wr) { | |
| VERBOSE(("interrupt: stack segment is read-only data segment")); | |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| /* not present */ | |
| if (selector_is_not_present(&ss_sel)) { | |
| VERBOSE(("interrupt: selector is not present")); | |
| EXCEPTION(SS_EXCEPTION, ss_sel.idx + !softintp); | |
| } | |
| /* check stack room size */ | |
| CHECK_STACK_PUSH(&ss_sel.desc, new_sp, stacksize); | |
| /* out of range */ | |
| if (new_ip > cs_sel.desc.u.seg.limit) { | |
| VERBOSE(("interrupt: new_ip is out of range. new_ip = %08x, limit = %08x", new_ip, cs_sel.desc.u.seg.limit)); | |
| EXCEPTION(GP_EXCEPTION, 0); | |
| } | |
| load_ss(ss_sel.selector, &ss_sel.desc, cs_sel.desc.dpl); | |
| CPU_ESP = new_sp; | |
| load_cs(cs_sel.selector, &cs_sel.desc, cs_sel.desc.dpl); | |
| SET_EIP(new_ip); | |
| switch (gdp->type) { | |
| case CPU_SYSDESC_TYPE_INTR_32: | case CPU_SYSDESC_TYPE_INTR_32: |
| flags &= I_FLAG; | |
| mask |= I_FLAG; | |
| /*FALLTHROUGH*/ | |
| case CPU_SYSDESC_TYPE_TRAP_16: | |
| case CPU_SYSDESC_TYPE_TRAP_32: | case CPU_SYSDESC_TYPE_TRAP_32: |
| flags &= ~(T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG); | if (CPU_STAT_VM86) { |
| mask |= T_FLAG|RF_FLAG|NT_FLAG|VM_FLAG; | PUSH0_32(CPU_GS); |
| PUSH0_32(CPU_FS); | |
| new_ip = intr_sel.desc.u.seg.segbase; | PUSH0_32(CPU_DS); |
| old_ss = CPU_SS; | PUSH0_32(CPU_ES); |
| old_cs = CPU_CS; | |
| old_ip = CPU_EIP; | CPU_SET_SEGREG(CPU_GS_INDEX, 0); |
| old_sp = CPU_ESP; | CPU_STAT_SREG(CPU_GS_INDEX).valid = 0; |
| CPU_SET_SEGREG(CPU_FS_INDEX, 0); | |
| VERBOSE(("TRAP-OR-INTERRUPT-GATE")); | CPU_STAT_SREG(CPU_FS_INDEX).valid = 0; |
| CPU_SET_SEGREG(CPU_DS_INDEX, 0); | |
| rv = parse_selector(&intr_sel, gd.u.gate.selector); | CPU_STAT_SREG(CPU_DS_INDEX).valid = 0; |
| if (rv < 0) { | CPU_SET_SEGREG(CPU_ES_INDEX, 0); |
| EXCEPTION(GP_EXCEPTION, intr_sel.idx | !softintp); | CPU_STAT_SREG(CPU_ES_INDEX).valid = 0; |
| } | } |
| PUSH0_32(old_ss); | |
| if (!intr_sel.desc.s | PUSH0_32(old_sp); |
| || !intr_sel.desc.u.seg.c | PUSH0_32(old_flags); |
| || (intr_sel.desc.dpl > CPU_STAT_CPL)) { | PUSH0_32(old_cs); |
| EXCEPTION(GP_EXCEPTION, intr_sel.idx | !softintp); | PUSH0_32(old_ip); |
| if (errorp) { | |
| PUSH0_32(error_code); | |
| } | } |
| break; | |
| /* not present */ | case CPU_SYSDESC_TYPE_INTR_16: |
| if (selector_is_not_present(&intr_sel)) { | case CPU_SYSDESC_TYPE_TRAP_16: |
| EXCEPTION(NP_EXCEPTION, intr_sel.idx | !softintp); | if (CPU_STAT_VM86) { |
| ia32_panic("interrupt: 16bit gate && VM86"); | |
| } | |
| PUSH0_16(old_ss); | |
| PUSH0_16(old_sp); | |
| PUSH0_16(old_flags); | |
| PUSH0_16(old_cs); | |
| PUSH0_16(old_ip); | |
| if (errorp) { | |
| PUSH0_16(error_code); | |
| } | } |
| break; | |
| } | |
| if (!intr_sel.desc.u.seg.ec && (intr_sel.desc.dpl < CPU_STAT_CPL)) { | set_eflags(new_flags, mask); |
| DWORD stacksize; | } else { |
| if (CPU_STAT_VM86) { | |
| VERBOSE(("interrupt: VM86")); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| if (!cs_sel.desc.u.seg.ec && (cs_sel.desc.dpl != CPU_STAT_CPL)) { | |
| VERBOSE(("interrupt: NON-CONFORMING-CODE-SEGMENT(%s) and DPL[CS](%d) != CPL", cs_sel.desc.u.seg.ec ? "false" : "true", cs_sel.desc.dpl, CPU_STAT_CPL)); | |
| EXCEPTION(GP_EXCEPTION, cs_sel.idx + !softintp); | |
| } | |
| VERBOSE(("interrupt: INTRA-PRIVILEGE-LEVEL-INTERRUPT")); | |
| if (CPU_STAT_VM86) { | stacksize = errorp ? 8 : 6; |
| VERBOSE(("INTER-PRIVILEGE-LEVEL-INTERRUPT")); | switch (gdp->type) { |
| stacksize = errorp ? 12 : 10; | case CPU_SYSDESC_TYPE_INTR_32: |
| } else { | case CPU_SYSDESC_TYPE_TRAP_32: |
| if (intr_sel.desc.dpl != 0) { | stacksize *= 2; |
| EXCEPTION(GP_EXCEPTION, intr_sel.idx); | break; |
| } | } |
| VERBOSE(("INTERRUPT-FROM-VIRTUAL-8086-MODE")); | |
| stacksize = errorp ? 20 : 18; | if (CPU_STAT_SS32) { |
| } | sp = CPU_ESP; |
| } else { | |
| get_stack_from_tss(intr_sel.desc.dpl, &new_ss, &new_sp); | sp = CPU_SP; |
| rv = parse_selector(&ss_sel, new_ss); | } |
| if (rv < 0) { | CHECK_STACK_PUSH(&CPU_STAT_SREG(CPU_SS_INDEX), sp, stacksize); |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx | !softintp); | |
| } | /* out of range */ |
| if (new_ip > cs_sel.desc.u.seg.limit) { | |
| if ((ss_sel.rpl != intr_sel.desc.dpl) | VERBOSE(("interrupt: new_ip is out of range. new_ip = %08x, limit = %08x", new_ip, cs_sel.desc.u.seg.limit)); |
| || (ss_sel.desc.dpl != intr_sel.desc.dpl) | EXCEPTION(GP_EXCEPTION, 0); |
| || !ss_sel.desc.s | } |
| || ss_sel.desc.u.seg.c | |
| || !ss_sel.desc.u.seg.wr) { | load_cs(cs_sel.selector, &cs_sel.desc, CPU_STAT_CPL); |
| EXCEPTION(TS_EXCEPTION, ss_sel.idx | !softintp); | SET_EIP(new_ip); |
| } | |
| switch (gdp->type) { | |
| /* not present */ | case CPU_SYSDESC_TYPE_INTR_32: |
| if (selector_is_not_present(&ss_sel)) { | case CPU_SYSDESC_TYPE_TRAP_32: |
| EXCEPTION(SS_EXCEPTION, ss_sel.idx | !softintp); | PUSH0_32(old_flags); |
| } | PUSH0_32(old_cs); |
| PUSH0_32(old_ip); | |
| switch (gd.type) { | if (errorp) { |
| case CPU_SYSDESC_TYPE_INTR_32: | PUSH0_32(error_code); |
| case CPU_SYSDESC_TYPE_TRAP_32: | |
| CHECK_STACK_PUSH(&ss_sel.desc, new_sp, stacksize * 2); | |
| break; | |
| case CPU_SYSDESC_TYPE_INTR_16: | |
| case CPU_SYSDESC_TYPE_TRAP_16: | |
| CHECK_STACK_PUSH(&ss_sel.desc, new_sp, stacksize); | |
| new_ip &= 0xffff; | |
| break; | |
| } | |
| /* out of range */ | |
| if (new_ip > intr_sel.desc.u.seg.limit) { | |
| EXCEPTION(GP_EXCEPTION, 0); | |
| } | |
| load_ss(new_ss, &ss_sel.desc, intr_sel.desc.dpl); | |
| CPU_ESP = new_sp; | |
| if (!CPU_STAT_VM86) { | |
| switch (gd.type) { | |
| case CPU_SYSDESC_TYPE_INTR_32: | |
| case CPU_SYSDESC_TYPE_TRAP_32: | |
| PUSH0_32(CPU_GS); | |
| PUSH0_32(CPU_FS); | |
| PUSH0_32(CPU_DS); | |
| PUSH0_32(CPU_ES); | |
| break; | |
| case CPU_SYSDESC_TYPE_INTR_16: | |
| case CPU_SYSDESC_TYPE_TRAP_16: | |
| PUSH0_16(CPU_GS); | |
| PUSH0_16(CPU_FS); | |
| PUSH0_16(CPU_DS); | |
| PUSH0_16(CPU_ES); | |
| break; | |
| } | |
| CPU_SET_SEGREG(CPU_GS_INDEX, 0); | |
| CPU_SET_SEGREG(CPU_FS_INDEX, 0); | |
| CPU_SET_SEGREG(CPU_DS_INDEX, 0); | |
| CPU_SET_SEGREG(CPU_ES_INDEX, 0); | |
| } | |
| switch (gd.type) { | |
| case CPU_SYSDESC_TYPE_INTR_32: | |
| case CPU_SYSDESC_TYPE_TRAP_32: | |
| PUSH0_32(old_ss); | |
| PUSH0_32(old_sp); | |
| PUSH0_32(REAL_EFLAGREG); | |
| PUSH0_32(old_cs); | |
| PUSH0_32(old_ip); | |
| if (errorp) { | |
| PUSH0_32(error_code); | |
| } | |
| break; | |
| case CPU_SYSDESC_TYPE_INTR_16: | |
| case CPU_SYSDESC_TYPE_TRAP_16: | |
| PUSH0_16(old_ss); | |
| PUSH0_16(old_sp); | |
| PUSH0_16(REAL_FLAGREG); | |
| PUSH0_16(old_cs); | |
| PUSH0_16(old_ip); | |
| if (errorp) { | |
| PUSH0_16(error_code); | |
| } | |
| break; | |
| } | |
| load_cs(intr_sel.selector, &intr_sel.desc, intr_sel.desc.dpl); | |
| SET_EIP(new_ip); | |
| set_eflags(flags, mask); | |
| } else { | |
| if (CPU_STAT_VM86 | |
| || (!intr_sel.desc.u.seg.ec && (intr_sel.desc.dpl != CPU_STAT_CPL))) { | |
| EXCEPTION(GP_EXCEPTION, intr_sel.idx); | |
| } | |
| VERBOSE(("INTRA-PRIVILEGE-LEVEL-INTERRUPT")); | |
| switch (gd.type) { | |
| case CPU_SYSDESC_TYPE_INTR_32: | |
| case CPU_SYSDESC_TYPE_TRAP_32: | |
| CHECK_STACK_PUSH(&ss_sel.desc, new_sp, errorp ? 16 : 12); | |
| break; | |
| case CPU_SYSDESC_TYPE_INTR_16: | |
| case CPU_SYSDESC_TYPE_TRAP_16: | |
| CHECK_STACK_PUSH(&ss_sel.desc, new_sp, errorp ? 8 : 6); | |
| new_ip &= 0xffff; | |
| break; | |
| } | |
| /* out of range */ | |
| if (new_ip > intr_sel.desc.u.seg.limit) { | |
| EXCEPTION(GP_EXCEPTION, 0); | |
| } | |
| switch (gd.type) { | |
| case CPU_SYSDESC_TYPE_INTR_32: | |
| case CPU_SYSDESC_TYPE_TRAP_32: | |
| PUSH0_32(REAL_EFLAGREG); | |
| PUSH0_32(CPU_CS); | |
| PUSH0_32(CPU_EIP); | |
| if (errorp) { | |
| PUSH0_32(error_code); | |
| } | |
| break; | |
| case CPU_SYSDESC_TYPE_INTR_16: | |
| case CPU_SYSDESC_TYPE_TRAP_16: | |
| PUSH0_16(REAL_FLAGREG); | |
| PUSH0_16(CPU_CS); | |
| PUSH0_16(CPU_IP); | |
| if (errorp) { | |
| PUSH0_16(error_code); | |
| } | |
| break; | |
| } | |
| load_cs(intr_sel.selector, &intr_sel.desc, CPU_STAT_CPL); | |
| SET_EIP(new_ip); | |
| set_eflags(flags, mask); | |
| } | } |
| break; | break; |
| default: | case CPU_SYSDESC_TYPE_INTR_16: |
| EXCEPTION(GP_EXCEPTION, num * 8 | 2 | !softintp); | case CPU_SYSDESC_TYPE_TRAP_16: |
| PUSH0_16(old_flags); | |
| PUSH0_16(old_cs); | |
| PUSH0_16(old_ip); | |
| if (errorp) { | |
| PUSH0_16(error_code); | |
| } | |
| break; | break; |
| } | } |
| set_eflags(new_flags, mask); | |
| } | } |
| VERBOSE(("interrupt: new EIP = %04x:%08x, new ESP = %04x:%08x", CPU_CS, CPU_EIP, CPU_SS, CPU_ESP)); | |
| } | } |