|
|
| version 1.4, 2004/01/15 15:49:52 | version 1.7, 2004/01/27 15:56:58 |
|---|---|
| Line 68 load_tr(WORD selector) | Line 68 load_tr(WORD selector) |
| EXCEPTION(NP_EXCEPTION, task_sel.idx); | EXCEPTION(NP_EXCEPTION, task_sel.idx); |
| } | } |
| #if defined(DEBUG) | #if defined(MORE_DEBUG) |
| { | tr_dump(task_sel.selector, task_sel.desc.u.seg.segbase, task_sel.desc.u.seg.limit); |
| DWORD v; | |
| DWORD i; | |
| VERBOSE(("load_tr: selector = %04x", task_sel.selector)); | |
| for (i = 0; i < task_sel.desc.u.seg.limit; i += 4) { | |
| v = cpu_lmemoryread_d(task_sel.desc.u.seg.segbase + i); | |
| VERBOSE(("load_tr: %08x: %08x", task_sel.desc.u.seg.segbase + i, v)); | |
| } | |
| } | |
| #endif | #endif |
| CPU_SET_TASK_BUSY(&task_sel.desc); | CPU_SET_TASK_BUSY(&task_sel.desc); |
| Line 87 load_tr(WORD selector) | Line 78 load_tr(WORD selector) |
| } | } |
| void | void |
| get_stack_from_tss(DWORD pl, WORD* new_ss, DWORD* new_esp) | get_stack_from_tss(DWORD pl, WORD *new_ss, DWORD *new_esp) |
| { | { |
| DWORD tss_stack_addr; | DWORD tss_stack_addr; |
| __ASSERT(pl < 3); | __ASSERT(pl < 3); |
| switch (CPU_TR_DESC.type) { | if (CPU_TR_DESC.type == CPU_SYSDESC_TYPE_TSS_BUSY_32) { |
| case CPU_SYSDESC_TYPE_TSS_BUSY_32: | |
| tss_stack_addr = pl * 8 + 4; | tss_stack_addr = pl * 8 + 4; |
| if (tss_stack_addr + 7 > CPU_TR_DESC.u.seg.limit) { | if (tss_stack_addr + 7 > CPU_TR_DESC.u.seg.limit) { |
| EXCEPTION(TS_EXCEPTION, CPU_TR & ~3); | EXCEPTION(TS_EXCEPTION, CPU_TR & ~3); |
| Line 102 get_stack_from_tss(DWORD pl, WORD* new_s | Line 92 get_stack_from_tss(DWORD pl, WORD* new_s |
| tss_stack_addr += CPU_TR_DESC.u.seg.segbase; | tss_stack_addr += CPU_TR_DESC.u.seg.segbase; |
| *new_esp = cpu_lmemoryread_d(tss_stack_addr); | *new_esp = cpu_lmemoryread_d(tss_stack_addr); |
| *new_ss = cpu_lmemoryread_w(tss_stack_addr + 4); | *new_ss = cpu_lmemoryread_w(tss_stack_addr + 4); |
| break; | } else if (CPU_TR_DESC.type == CPU_SYSDESC_TYPE_TSS_BUSY_16) { |
| case CPU_SYSDESC_TYPE_TSS_BUSY_16: | |
| tss_stack_addr = pl * 4 + 2; | tss_stack_addr = pl * 4 + 2; |
| if (tss_stack_addr + 3 > CPU_TR_DESC.u.seg.limit) { | if (tss_stack_addr + 3 > CPU_TR_DESC.u.seg.limit) { |
| EXCEPTION(TS_EXCEPTION, CPU_TR & ~3); | EXCEPTION(TS_EXCEPTION, CPU_TR & ~3); |
| Line 112 get_stack_from_tss(DWORD pl, WORD* new_s | Line 100 get_stack_from_tss(DWORD pl, WORD* new_s |
| tss_stack_addr += CPU_TR_DESC.u.seg.segbase; | tss_stack_addr += CPU_TR_DESC.u.seg.segbase; |
| *new_esp = cpu_lmemoryread_w(tss_stack_addr); | *new_esp = cpu_lmemoryread_w(tss_stack_addr); |
| *new_ss = cpu_lmemoryread_w(tss_stack_addr + 2); | *new_ss = cpu_lmemoryread_w(tss_stack_addr + 2); |
| break; | } else { |
| ia32_panic("get_stack_from_tss: task register is invalid (%d)\n", CPU_TR_DESC.type); | |
| default: | |
| ia32_panic("get_stack_from_tss: TR is invalid (%d)\n", | |
| CPU_TR_DESC.type); | |
| break; | |
| } | } |
| VERBOSE(("get_stack_from_tss: new_esp = 0x%08x, new_ss = 0x%04x", *new_esp, *new_ss)); | VERBOSE(("get_stack_from_tss: pl = %d, new_esp = 0x%08x, new_ss = 0x%04x", pl, *new_esp, *new_ss)); |
| } | } |
| WORD | WORD |
| Line 137 get_link_selector_from_tss() | Line 121 get_link_selector_from_tss() |
| EXCEPTION(TS_EXCEPTION, CPU_TR & ~3); | EXCEPTION(TS_EXCEPTION, CPU_TR & ~3); |
| } | } |
| } else { | } else { |
| ia32_panic("get_link_selector_from_tss: TR is invalid (%d)\n", | ia32_panic("get_link_selector_from_tss: task register is invalid (%d)\n", CPU_TR_DESC.type); |
| CPU_TR_DESC.type); | |
| return 0; /* compiler happy */ | |
| } | } |
| backlink = cpu_lmemoryread_w(CPU_TR_DESC.u.seg.segbase); | backlink = cpu_lmemoryread_w(CPU_TR_DESC.u.seg.segbase); |
| Line 165 task_switch(selector_t* task_sel, int ty | Line 147 task_switch(selector_t* task_sel, int ty |
| DWORD task_base; /* new task state */ | DWORD task_base; /* new task state */ |
| DWORD old_flags = REAL_EFLAGREG; | DWORD old_flags = REAL_EFLAGREG; |
| BOOL task16; | BOOL task16; |
| int nsreg; | DWORD nsreg; |
| int i; | DWORD i; |
| VERBOSE(("task_switch: start")); | VERBOSE(("task_switch: start")); |
| Line 202 task_switch(selector_t* task_sel, int ty | Line 184 task_switch(selector_t* task_sel, int ty |
| break; | break; |
| } | } |
| #if defined(DEBUG) | #if defined(MORE_DEBUG) |
| { | { |
| DWORD v; | DWORD v; |
| VERBOSE(("task_switch: new task")); | VERBOSE(("task_switch: new task")); |
| for (i = 0; i < task_sel->desc.u.seg.limit; i += 4) { | for (i = 0; i < task_sel->desc.u.seg.limit; i += 4) { |
| v = cpu_lmemoryread_d(task_base + i); | v = cpu_lmemoryread_d(task_base + i); |
| VERBOSE(("task_switch: 0x%08x: %08x", task_base + i, v)); | VERBOSE(("task_switch: 0x%08x: %08x", task_base + i,v)); |
| } | |
| } | } |
| } | |
| #endif | #endif |
| if (CPU_STAT_PAGING) { | if (CPU_STAT_PAGING) { |
| Line 223 task_switch(selector_t* task_sel, int ty | Line 205 task_switch(selector_t* task_sel, int ty |
| /* load task state */ | /* load task state */ |
| memset(sreg, 0, sizeof(sreg)); | memset(sreg, 0, sizeof(sreg)); |
| if (!task16) { | if (!task16) { |
| if (CPU_STAT_PAGING) { | cr3 = cpu_lmemoryread_d(task_base + 28); |
| cr3 = cpu_lmemoryread_d(task_base + 28); | |
| } | |
| eip = cpu_lmemoryread_d(task_base + 32); | eip = cpu_lmemoryread_d(task_base + 32); |
| new_flags = cpu_lmemoryread_d(task_base + 36); | new_flags = cpu_lmemoryread_d(task_base + 36); |
| for (i = 0; i < CPU_REG_NUM; i++) { | for (i = 0; i < CPU_REG_NUM; i++) { |
| Line 252 task_switch(selector_t* task_sel, int ty | Line 232 task_switch(selector_t* task_sel, int ty |
| iobase = 0; | iobase = 0; |
| } | } |
| #if defined(DEBUG) | #if defined(MORE_DEBUG) |
| VERBOSE(("task_switch: %dbit task", task16 ? 16 : 32)); | VERBOSE(("task_switch: %dbit task", task16 ? 16 : 32)); |
| VERBOSE(("task_switch: CR3 = 0x%08x", cr3)); | VERBOSE(("task_switch: CR3 = 0x%08x", cr3)); |
| VERBOSE(("task_switch: eip = 0x%08x", eip)); | VERBOSE(("task_switch: eip = 0x%08x", eip)); |
| Line 290 task_switch(selector_t* task_sel, int ty | Line 270 task_switch(selector_t* task_sel, int ty |
| break; | break; |
| } | } |
| /* save this task state in this task state segment ind */ | /* save this task state in this task state segment */ |
| if (!task16) { | if (!task16) { |
| cpu_lmemorywrite_d(cur_base + 28, CPU_CR3); | cpu_lmemorywrite_d(cur_base + 28, CPU_CR3); |
| cpu_lmemorywrite_d(cur_base + 32, CPU_EIP); | cpu_lmemorywrite_d(cur_base + 32, CPU_EIP); |
| Line 299 task_switch(selector_t* task_sel, int ty | Line 279 task_switch(selector_t* task_sel, int ty |
| cpu_lmemorywrite_d(cur_base + 40 + i * 4, CPU_REGS_DWORD(i)); | cpu_lmemorywrite_d(cur_base + 40 + i * 4, CPU_REGS_DWORD(i)); |
| } | } |
| for (i = 0; i < nsreg; i++) { | for (i = 0; i < nsreg; i++) { |
| cpu_lmemorywrite_d(cur_base + 72 + i * 4, CPU_REGS_SREG(i)); | cpu_lmemorywrite_w(cur_base + 72 + i * 4, CPU_REGS_SREG(i)); |
| } | } |
| cpu_lmemorywrite_d(cur_base + 96, CPU_LDTR); | cpu_lmemorywrite_w(cur_base + 96, CPU_LDTR); |
| } else { | } else { |
| cpu_lmemorywrite_w(cur_base + 14, CPU_IP); | cpu_lmemorywrite_w(cur_base + 14, CPU_IP); |
| cpu_lmemorywrite_w(cur_base + 16, (WORD)old_flags); | cpu_lmemorywrite_w(cur_base + 16, (WORD)old_flags); |
| Line 314 task_switch(selector_t* task_sel, int ty | Line 294 task_switch(selector_t* task_sel, int ty |
| cpu_lmemorywrite_w(cur_base + 42, CPU_LDTR); | cpu_lmemorywrite_w(cur_base + 42, CPU_LDTR); |
| } | } |
| #if defined(DEBUG) | #if defined(MORE_DEBUG) |
| { | { |
| DWORD v; | DWORD v; |
| VERBOSE(("task_switch: current task")); | VERBOSE(("task_switch: current task")); |
| for (i = 0; i < CPU_TR_DESC.u.seg.limit; i += 4) { | for (i = 0; i < CPU_TR_DESC.u.seg.limit; i += 4) { |
| v = cpu_lmemoryread_d(cur_base + i); | v = cpu_lmemoryread_d(cur_base + i); |
| VERBOSE(("task_switch: 0x%08x: %08x", cur_base + i, v)); | VERBOSE(("task_switch: 0x%08x: %08x", cur_base + i, v)); |
| } | |
| } | } |
| } | |
| #endif | #endif |
| /* set back link selector */ | /* set back link selector */ |
| switch (type) { | switch (type) { |
| case TASK_SWITCH_CALL: | case TASK_SWITCH_CALL: |
| case TASK_SWITCH_INTR: | case TASK_SWITCH_INTR: |
| /* set back link selector */ | /* set back link selector */ |
| cpu_lmemorywrite_d(task_base, CPU_TR); | cpu_lmemorywrite_w(task_base, CPU_TR); |
| break; | break; |
| case TASK_SWITCH_IRET: | case TASK_SWITCH_IRET: |
| Line 345 task_switch(selector_t* task_sel, int ty | Line 325 task_switch(selector_t* task_sel, int ty |
| /* Now task switching! */ | /* Now task switching! */ |
| /* if CALL, INTR, set EFLAG image NT_FLAG */ | /* if CALL, INTR, set EFLAGS image NT_FLAG */ |
| /* if CALL, INTR, JMP set busy flag */ | /* if CALL, INTR, JMP set busy flag */ |
| switch (type) { | switch (type) { |
| case TASK_SWITCH_CALL: | case TASK_SWITCH_CALL: |
| Line 358 task_switch(selector_t* task_sel, int ty | Line 338 task_switch(selector_t* task_sel, int ty |
| break; | break; |
| case TASK_SWITCH_IRET: | case TASK_SWITCH_IRET: |
| /* Nothing to do */ | #if defined(DEBUG) |
| /* XXX: if IRET, check busy flag is active? */ | /* check busy flag is active */ |
| if (task_sel->desc.valid) { | |
| DWORD h; | |
| h = cpu_lmemoryread_d(task_sel->desc.addr + 4); | |
| if ((h & CPU_TSS_H_BUSY) == 0) { | |
| VERBOSE(("task_switch: new task is not busy")); | |
| } | |
| } | |
| #endif | |
| break; | break; |
| default: | default: |
| Line 375 task_switch(selector_t* task_sel, int ty | Line 363 task_switch(selector_t* task_sel, int ty |
| CPU_TR_DESC = task_sel->desc; | CPU_TR_DESC = task_sel->desc; |
| /* load task state (CR3, EFLAG, EIP, GPR, segreg, LDTR) */ | /* load task state (CR3, EFLAG, EIP, GPR, segreg, LDTR) */ |
| if (CPU_STAT_PAGING) { | |
| /* set new CR3 */ | |
| if (!task16) { | |
| set_CR3(cr3); | set_CR3(cr3); |
| } | } |
| Line 398 task_switch(selector_t* task_sel, int ty | Line 388 task_switch(selector_t* task_sel, int ty |
| /* set new segment register */ | /* set new segment register */ |
| if (CPU_STAT_VM86) { | if (CPU_STAT_VM86) { |
| /* VM86 */ | /* VM86 */ |
| /* clear 32bit */ | |
| CPU_STATSAVE.cpu_inst_default.op_32 = | |
| CPU_STATSAVE.cpu_inst_default.as_32 = 0; | |
| CPU_STAT_SS32 = 0; | |
| CPU_STAT_CPL = task_sel->desc.dpl; | |
| for (i = 0; i < nsreg; i++) { | for (i = 0; i < nsreg; i++) { |
| CPU_STAT_SREG_INIT(i); | CPU_STAT_SREG_INIT(i); |
| load_segreg(i, sreg[i], TS_EXCEPTION); | load_segreg(i, sreg[i], TS_EXCEPTION); |
| Line 434 task_switch(selector_t* task_sel, int ty | Line 418 task_switch(selector_t* task_sel, int ty |
| } | } |
| } | } |
| /* CS segment is not present */ | /* code segment is not present */ |
| rv = selector_is_not_present(&cs_sel); | rv = selector_is_not_present(&cs_sel); |
| if (rv < 0) { | if (rv < 0) { |
| EXCEPTION(NP_EXCEPTION, cs_sel.idx); | EXCEPTION(NP_EXCEPTION, cs_sel.idx); |
| Line 464 task_switch(selector_t* task_sel, int ty | Line 448 task_switch(selector_t* task_sel, int ty |
| CPU_STAT_IOLIMIT = 0; | CPU_STAT_IOLIMIT = 0; |
| } | } |
| /* out of range */ | |
| if (CPU_EIP > CPU_STAT_CS_LIMIT) { | |
| VERBOSE(("task_switch: new_ip is out of range. new_ip = %08x, limit = %08x", CPU_EIP, CPU_STAT_CS_LIMIT)); | |
| EXCEPTION(GP_EXCEPTION, 0); | |
| } | |
| VERBOSE(("task_switch: done.")); | VERBOSE(("task_switch: done.")); |
| } | } |