|
|
| version 1.31, 2011/12/29 14:30:31 | version 1.38, 2012/02/07 09:11:11 |
|---|---|
| Line 44 set_task_busy(UINT16 selector) | Line 44 set_task_busy(UINT16 selector) |
| h |= CPU_TSS_H_BUSY; | h |= CPU_TSS_H_BUSY; |
| cpu_kmemorywrite_d(addr + 4, h); | cpu_kmemorywrite_d(addr + 4, h); |
| } else { | } else { |
| ia32_panic("set_task_busy: already busy(%04x:%08x)",selector,h); | ia32_panic("set_task_busy: already busy(%04x:%08x)", |
| selector, h); | |
| } | } |
| } | } |
| Line 60 set_task_free(UINT16 selector) | Line 61 set_task_free(UINT16 selector) |
| h &= ~CPU_TSS_H_BUSY; | h &= ~CPU_TSS_H_BUSY; |
| cpu_kmemorywrite_d(addr + 4, h); | cpu_kmemorywrite_d(addr + 4, h); |
| } else { | } else { |
| ia32_panic("set_task_free: already free(%04x:%08x)",selector,h); | ia32_panic("set_task_free: already free(%04x:%08x)", |
| selector, h); | |
| } | } |
| } | } |
| Line 69 load_tr(UINT16 selector) | Line 71 load_tr(UINT16 selector) |
| { | { |
| selector_t task_sel; | selector_t task_sel; |
| int rv; | int rv; |
| #if defined(IA32_SUPPORT_DEBUG_REGISTER) | |
| int i; | |
| #endif | |
| UINT16 iobase; | UINT16 iobase; |
| rv = parse_selector(&task_sel, selector); | rv = parse_selector(&task_sel, selector); |
| Line 118 load_tr(UINT16 selector) | Line 117 load_tr(UINT16 selector) |
| /* I/O deny bitmap */ | /* I/O deny bitmap */ |
| CPU_STAT_IOLIMIT = 0; | CPU_STAT_IOLIMIT = 0; |
| if (CPU_TR_DESC.type == CPU_SYSDESC_TYPE_TSS_BUSY_32) { | if (CPU_TR_DESC.type == CPU_SYSDESC_TYPE_TSS_BUSY_32) { |
| if (iobase != 0 && iobase < CPU_TR_DESC.u.seg.limit) { | if (iobase < CPU_TR_LIMIT) { |
| CPU_STAT_IOLIMIT = (UINT16)(CPU_TR_DESC.u.seg.limit - iobase); | CPU_STAT_IOLIMIT = (UINT16)(CPU_TR_LIMIT - iobase); |
| CPU_STAT_IOADDR = CPU_TR_DESC.u.seg.segbase + iobase; | CPU_STAT_IOADDR = CPU_TR_BASE + iobase; |
| VERBOSE(("load_tr: enable ioport control: iobase=0x%04x, base=0x%08x, limit=0x%08x", iobase, CPU_STAT_IOADDR, CPU_STAT_IOLIMIT)); | |
| } | } |
| } | } |
| if (CPU_STAT_IOLIMIT == 0) { | |
| #if defined(IA32_SUPPORT_DEBUG_REGISTER) | VERBOSE(("load_tr: disable ioport control.")); |
| /* clear local break point flags */ | |
| CPU_DR7 &= ~(CPU_DR7_L(0)|CPU_DR7_L(1)|CPU_DR7_L(2)|CPU_DR7_L(3)|CPU_DR7_LE); | |
| CPU_STAT_BP = 0; | |
| for (i = 0; i < CPU_DEBUG_REG_INDEX_NUM; i++) { | |
| if (CPU_DR7 & CPU_DR7_G(i)) { | |
| CPU_STAT_BP |= (1 << i); | |
| } | |
| } | } |
| #endif | |
| } | } |
| void CPUCALL | void CPUCALL |
| Line 142 get_stack_pointer_from_tss(UINT pl, UINT | Line 134 get_stack_pointer_from_tss(UINT pl, UINT |
| UINT32 tss_stack_addr; | UINT32 tss_stack_addr; |
| VERBOSE(("get_stack_pointer_from_tss: pl = %d", pl)); | VERBOSE(("get_stack_pointer_from_tss: pl = %d", pl)); |
| VERBOSE(("CPU_TR type = %d, base = 0x%08x, limit = 0x%08x", CPU_TR_DESC.type, CPU_TR_BASE, CPU_TR_LIMIT)); | VERBOSE(("get_stack_pointer_from_tss: CPU_TR type = %d, base = 0x%08x, limit = 0x%08x", CPU_TR_DESC.type, CPU_TR_BASE, CPU_TR_LIMIT)); |
| __ASSERT(pl < 3); | __ASSERT(pl < 3); |
| Line 165 get_stack_pointer_from_tss(UINT pl, UINT | Line 157 get_stack_pointer_from_tss(UINT pl, UINT |
| } else { | } else { |
| ia32_panic("get_stack_pointer_from_tss: task register is invalid (%d)\n", CPU_TR_DESC.type); | ia32_panic("get_stack_pointer_from_tss: task register is invalid (%d)\n", CPU_TR_DESC.type); |
| } | } |
| VERBOSE(("new stack pointer = %04x:%08x", *new_ss, *new_esp)); | VERBOSE(("get_stack_pointer_from_tss: new stack pointer = %04x:%08x", |
| *new_ss, *new_esp)); | |
| } | } |
| UINT16 | UINT16 |
| Line 186 get_backlink_selector_from_tss(void) | Line 179 get_backlink_selector_from_tss(void) |
| } | } |
| backlink = cpu_kmemoryread_w(CPU_TR_BASE); | backlink = cpu_kmemoryread_w(CPU_TR_BASE); |
| VERBOSE(("get_backlink_selector_from_tss: backlink selector = 0x%04x", backlink)); | VERBOSE(("get_backlink_selector_from_tss: backlink selector = 0x%04x", |
| backlink)); | |
| return backlink; | return backlink; |
| } | } |
| Line 240 task_switch(selector_t *task_sel, task_s | Line 234 task_switch(selector_t *task_sel, task_s |
| cur_paddr = laddr_to_paddr(cur_base, CPU_PAGE_WRITE_DATA|CPU_MODE_SUPERVISER); | cur_paddr = laddr_to_paddr(cur_base, CPU_PAGE_WRITE_DATA|CPU_MODE_SUPERVISER); |
| task_base = task_sel->desc.u.seg.segbase; | task_base = task_sel->desc.u.seg.segbase; |
| task_paddr = laddr_to_paddr(task_base, CPU_PAGE_WRITE_DATA|CPU_MODE_SUPERVISER); | task_paddr = laddr_to_paddr(task_base, CPU_PAGE_WRITE_DATA|CPU_MODE_SUPERVISER); |
| VERBOSE(("task_switch: current task (%04x) = 0x%08x:%08x", CPU_TR, cur_base, CPU_TR_LIMIT)); | VERBOSE(("task_switch: current task (%04x) = 0x%08x:%08x (p0x%08x)", |
| VERBOSE(("task_switch: new task (%04x) = 0x%08x:%08x", task_sel->selector, task_base, task_sel->desc.u.seg.limit)); | CPU_TR, cur_base, CPU_TR_LIMIT, cur_paddr)); |
| VERBOSE(("task_switch: new task (%04x) = 0x%08x:%08x (p0x%08x)", | |
| task_sel->selector, task_base, task_sel->desc.u.seg.limit, | |
| task_paddr)); | |
| VERBOSE(("task_switch: %dbit task switch", task16 ? 16 : 32)); | VERBOSE(("task_switch: %dbit task switch", task16 ? 16 : 32)); |
| #if defined(MORE_DEBUG) | #if defined(MORE_DEBUG) |
| { | VERBOSE(("task_switch: new task")); |
| UINT32 v; | for (i = 0; i < task_sel->desc.u.seg.limit; i += 4) { |
| VERBOSE(("task_switch: 0x%08x: %08x", task_base + i, | |
| VERBOSE(("task_switch: new task")); | cpu_memoryread_d(task_paddr + i))); |
| for (i = 0; i < task_sel->desc.u.seg.limit; i += 4) { | |
| v = cpu_memoryread_d(task_paddr + i); | |
| VERBOSE(("task_switch: 0x%08x: %08x", task_base + i,v)); | |
| } | |
| } | } |
| #endif | #endif |
| /* load task state */ | /* load task state */ |
| memset(sreg, 0, sizeof(sreg)); | |
| if (!task16) { | if (!task16) { |
| if (CPU_STAT_PAGING) { | if (CPU_STAT_PAGING) { |
| cr3 = cpu_memoryread_d(task_paddr + 28); | cr3 = cpu_memoryread_d(task_paddr + 28); |
| Line 285 task_switch(selector_t *task_sel, task_s | Line 277 task_switch(selector_t *task_sel, task_s |
| for (i = 0; i < CPU_SEGREG286_NUM; i++) { | for (i = 0; i < CPU_SEGREG286_NUM; i++) { |
| sreg[i] = cpu_memoryread_w(task_paddr + 34 + i * 2); | sreg[i] = cpu_memoryread_w(task_paddr + 34 + i * 2); |
| } | } |
| for (; i < CPU_SEGREG_NUM; i++) { | |
| sreg[i] = 0; | |
| } | |
| ldtr = cpu_memoryread_w(task_paddr + 42); | ldtr = cpu_memoryread_w(task_paddr + 42); |
| iobase = 0; | iobase = 0; |
| t = 0; | t = 0; |
| Line 298 task_switch(selector_t *task_sel, task_s | Line 293 task_switch(selector_t *task_sel, task_s |
| VERBOSE(("task_switch: eip = 0x%08x", CPU_EIP)); | VERBOSE(("task_switch: eip = 0x%08x", CPU_EIP)); |
| VERBOSE(("task_switch: eflags = 0x%08x", old_flags)); | VERBOSE(("task_switch: eflags = 0x%08x", old_flags)); |
| for (i = 0; i < CPU_REG_NUM; i++) { | for (i = 0; i < CPU_REG_NUM; i++) { |
| VERBOSE(("task_switch: regs[%d] = 0x%08x", i, CPU_REGS_DWORD(i))); | VERBOSE(("task_switch: %s = 0x%08x", reg32_str[i], |
| CPU_REGS_DWORD(i))); | |
| } | } |
| for (i = 0; i < CPU_SEGREG_NUM; i++) { | for (i = 0; i < CPU_SEGREG_NUM; i++) { |
| VERBOSE(("task_switch: sreg[%d] = 0x%04x", i, CPU_REGS_SREG(i))); | VERBOSE(("task_switch: %s = 0x%04x", sreg_str[i], |
| CPU_REGS_SREG(i))); | |
| } | } |
| VERBOSE(("task_switch: ldtr = 0x%04x", CPU_LDTR)); | VERBOSE(("task_switch: ldtr = 0x%04x", CPU_LDTR)); |
| Line 312 task_switch(selector_t *task_sel, task_s | Line 309 task_switch(selector_t *task_sel, task_s |
| VERBOSE(("task_switch: eip = 0x%08x", eip)); | VERBOSE(("task_switch: eip = 0x%08x", eip)); |
| VERBOSE(("task_switch: eflags = 0x%08x", new_flags)); | VERBOSE(("task_switch: eflags = 0x%08x", new_flags)); |
| for (i = 0; i < CPU_REG_NUM; i++) { | for (i = 0; i < CPU_REG_NUM; i++) { |
| VERBOSE(("task_switch: regs[%d] = 0x%08x", i, regs[i])); | VERBOSE(("task_switch: %s = 0x%08x", reg32_str[i], regs[i])); |
| } | } |
| for (i = 0; i < CPU_SEGREG_NUM; i++) { | for (i = 0; i < CPU_SEGREG_NUM; i++) { |
| VERBOSE(("task_switch: sreg[%d] = 0x%04x", i, sreg[i])); | VERBOSE(("task_switch: %s = 0x%04x", sreg_str[i], sreg[i])); |
| } | } |
| VERBOSE(("task_switch: ldtr = 0x%04x", ldtr)); | VERBOSE(("task_switch: ldtr = 0x%04x", ldtr)); |
| if (!task16) { | if (!task16) { |
| Line 342 task_switch(selector_t *task_sel, task_s | Line 339 task_switch(selector_t *task_sel, task_s |
| break; | break; |
| default: | default: |
| ia32_panic("task_switch(): task switch type is invalid"); | ia32_panic("task_switch: task switch type is invalid"); |
| break; | break; |
| } | } |
| Line 351 task_switch(selector_t *task_sel, task_s | Line 348 task_switch(selector_t *task_sel, task_s |
| cpu_memorywrite_d(cur_paddr + 32, CPU_EIP); | cpu_memorywrite_d(cur_paddr + 32, CPU_EIP); |
| cpu_memorywrite_d(cur_paddr + 36, old_flags); | cpu_memorywrite_d(cur_paddr + 36, old_flags); |
| for (i = 0; i < CPU_REG_NUM; i++) { | for (i = 0; i < CPU_REG_NUM; i++) { |
| cpu_memorywrite_d(cur_paddr + 40 + i * 4, CPU_REGS_DWORD(i)); | cpu_memorywrite_d(cur_paddr + 40 + i * 4, |
| CPU_REGS_DWORD(i)); | |
| } | } |
| for (i = 0; i < CPU_SEGREG_NUM; i++) { | for (i = 0; i < CPU_SEGREG_NUM; i++) { |
| cpu_memorywrite_w(cur_paddr + 72 + i * 4, CPU_REGS_SREG(i)); | cpu_memorywrite_w(cur_paddr + 72 + i * 4, |
| CPU_REGS_SREG(i)); | |
| } | } |
| } else { | } else { |
| cpu_memorywrite_w(cur_paddr + 14, CPU_IP); | cpu_memorywrite_w(cur_paddr + 14, CPU_IP); |
| cpu_memorywrite_w(cur_paddr + 16, (UINT16)old_flags); | cpu_memorywrite_w(cur_paddr + 16, (UINT16)old_flags); |
| for (i = 0; i < CPU_REG_NUM; i++) { | for (i = 0; i < CPU_REG_NUM; i++) { |
| cpu_memorywrite_w(cur_paddr + 18 + i * 2, CPU_REGS_WORD(i)); | cpu_memorywrite_w(cur_paddr + 18 + i * 2, |
| CPU_REGS_WORD(i)); | |
| } | } |
| for (i = 0; i < CPU_SEGREG286_NUM; i++) { | for (i = 0; i < CPU_SEGREG286_NUM; i++) { |
| cpu_memorywrite_w(cur_paddr + 34 + i * 2, CPU_REGS_SREG(i)); | cpu_memorywrite_w(cur_paddr + 34 + i * 2, |
| CPU_REGS_SREG(i)); | |
| } | } |
| } | } |
| Line 374 task_switch(selector_t *task_sel, task_s | Line 375 task_switch(selector_t *task_sel, task_s |
| /* set back link selector */ | /* set back link selector */ |
| cpu_memorywrite_w(task_paddr, CPU_TR); | cpu_memorywrite_w(task_paddr, CPU_TR); |
| break; | break; |
| case TASK_SWITCH_IRET: | case TASK_SWITCH_IRET: |
| case TASK_SWITCH_JMP: | case TASK_SWITCH_JMP: |
| /* Nothing to do */ | /* Nothing to do */ |
| break; | break; |
| default: | default: |
| ia32_panic("task_switch(): task switch type is invalid"); | ia32_panic("task_switch: task switch type is invalid"); |
| break; | break; |
| } | } |
| #if defined(MORE_DEBUG) | #if defined(MORE_DEBUG) |
| { | VERBOSE(("task_switch: current task")); |
| UINT32 v; | for (i = 0; i < CPU_TR_LIMIT; i += 4) { |
| VERBOSE(("task_switch: 0x%08x: %08x", cur_base + i, | |
| VERBOSE(("task_switch: current task")); | cpu_memoryread_d(cur_paddr + i))); |
| for (i = 0; i < CPU_TR_LIMIT; i += 4) { | |
| v = cpu_memoryread_d(cur_paddr + i); | |
| VERBOSE(("task_switch: 0x%08x: %08x", cur_base + i, v)); | |
| } | |
| } | } |
| #endif | #endif |
| Line 423 task_switch(selector_t *task_sel, task_s | Line 420 task_switch(selector_t *task_sel, task_s |
| break; | break; |
| default: | default: |
| ia32_panic("task_switch(): task switch type is invalid"); | ia32_panic("task_switch: task switch type is invalid"); |
| break; | break; |
| } | } |
| Line 467 task_switch(selector_t *task_sel, task_s | Line 464 task_switch(selector_t *task_sel, task_s |
| CPU_STAT_IOLIMIT = (UINT16)(CPU_TR_DESC.u.seg.limit - iobase); | CPU_STAT_IOLIMIT = (UINT16)(CPU_TR_DESC.u.seg.limit - iobase); |
| CPU_STAT_IOADDR = task_base + iobase; | CPU_STAT_IOADDR = task_base + iobase; |
| } | } |
| VERBOSE(("task_switch: ioaddr = %08x, limit = %08x", CPU_STAT_IOADDR, CPU_STAT_IOLIMIT)); | VERBOSE(("task_switch: ioaddr = %08x, limit = %08x", CPU_STAT_IOADDR, |
| CPU_STAT_IOLIMIT)); | |
| #if defined(IA32_SUPPORT_DEBUG_REGISTER) | |
| /* check resume flag */ | |
| if (CPU_EFLAG & RF_FLAG) { | |
| CPU_STAT_BP_EVENT |= CPU_STAT_BP_EVENT_RF; | |
| } | |
| /* clear local break point flags */ | |
| CPU_DR7 &= ~(CPU_DR7_L(0)|CPU_DR7_L(1)|CPU_DR7_L(2)|CPU_DR7_L(3)|CPU_DR7_LE); | |
| CPU_STAT_BP = 0; | |
| for (i = 0; i < CPU_DEBUG_REG_INDEX_NUM; i++) { | |
| if (CPU_DR7 & CPU_DR7_G(i)) { | |
| CPU_STAT_BP |= (1 << i); | |
| } | |
| } | |
| #endif | |
| /* set new EFLAGS */ | /* set new EFLAGS */ |
| set_eflags(new_flags, I_FLAG|IOPL_FLAG|RF_FLAG|VM_FLAG|VIF_FLAG|VIP_FLAG); | set_eflags(new_flags, I_FLAG|IOPL_FLAG|RF_FLAG|VM_FLAG|VIF_FLAG|VIP_FLAG); |