| version 1.2, 2004/01/13 16:37:42 | version 1.4, 2004/01/15 15:49:52 | 
| 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) | 
 |  | { | 
 |  | 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 | 
 |  |  | 
 | CPU_SET_TASK_BUSY(&task_sel.desc); | CPU_SET_TASK_BUSY(&task_sel.desc); | 
 | CPU_TR = task_sel.selector; | CPU_TR = task_sel.selector; | 
 | CPU_TR_DESC = task_sel.desc; | CPU_TR_DESC = task_sel.desc; | 
| Line 78  get_stack_from_tss(DWORD pl, WORD* new_s | Line 91  get_stack_from_tss(DWORD pl, WORD* new_s | 
 | { | { | 
 | DWORD tss_stack_addr; | DWORD tss_stack_addr; | 
 |  |  | 
 |  | __ASSERT(pl < 3); | 
 |  |  | 
 | switch (CPU_TR_DESC.type) { | switch (CPU_TR_DESC.type) { | 
 | case 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; | 
| Line 104  get_stack_from_tss(DWORD pl, WORD* new_s | Line 119  get_stack_from_tss(DWORD pl, WORD* new_s | 
 | CPU_TR_DESC.type); | CPU_TR_DESC.type); | 
 | break; | break; | 
 | } | } | 
 |  |  | 
 |  | VERBOSE(("get_stack_from_tss: new_esp = 0x%08x, new_ss = 0x%04x", *new_esp, *new_ss)); | 
 | } | } | 
 |  |  | 
 | WORD | WORD | 
 | get_link_selector_from_tss() | get_link_selector_from_tss() | 
 | { | { | 
 |  | WORD backlink; | 
 |  |  | 
 | if (CPU_TR_DESC.type == CPU_SYSDESC_TYPE_TSS_BUSY_32) { | if (CPU_TR_DESC.type == CPU_SYSDESC_TYPE_TSS_BUSY_32) { | 
 | if (4 > CPU_TR_DESC.u.seg.limit) { | if (4 > CPU_TR_DESC.u.seg.limit) { | 
| Line 124  get_link_selector_from_tss() | Line 142  get_link_selector_from_tss() | 
 | return 0;       /* compiler happy */ | return 0;       /* compiler happy */ | 
 | } | } | 
 |  |  | 
| return cpu_lmemoryread_w(CPU_TR_DESC.u.seg.segbase); | backlink = cpu_lmemoryread_w(CPU_TR_DESC.u.seg.segbase); | 
|  | VERBOSE(("get_link_selector_from_tss: backlink selector = 0x%04x", backlink)); | 
|  | return backlink; | 
 | } | } | 
 |  |  | 
 | void | void | 
| Line 148  task_switch(selector_t* task_sel, int ty | Line 168  task_switch(selector_t* task_sel, int ty | 
 | int nsreg; | int nsreg; | 
 | int i; | int i; | 
 |  |  | 
 |  | VERBOSE(("task_switch: start")); | 
 |  |  | 
 | cur_base = CPU_TR_DESC.u.seg.segbase; | cur_base = CPU_TR_DESC.u.seg.segbase; | 
 | task_base = task_sel->desc.u.seg.segbase; | task_base = task_sel->desc.u.seg.segbase; | 
 | VERBOSE(("task_switch: current task base address = 0x%08x", cur_base)); | VERBOSE(("task_switch: current task base address = 0x%08x", cur_base)); | 
| VERBOSE(("task_switch: new task base address = 0x%08x", task_base)); | VERBOSE(("task_switch: new task base address     = 0x%08x", task_base)); | 
 |  |  | 
 | /* limit check */ | /* limit check */ | 
 | switch (task_sel->desc.type) { | switch (task_sel->desc.type) { | 
| Line 180  task_switch(selector_t* task_sel, int ty | Line 202  task_switch(selector_t* task_sel, int ty | 
 | break; | break; | 
 | } | } | 
 |  |  | 
 |  | #if defined(DEBUG) | 
 |  | { | 
 |  | DWORD v; | 
 |  |  | 
 |  | VERBOSE(("task_switch: new task")); | 
 |  | for (i = 0; i < task_sel->desc.u.seg.limit; i += 4) { | 
 |  | v = cpu_lmemoryread_d(task_base + i); | 
 |  | VERBOSE(("task_switch: 0x%08x: %08x", task_base + i, v)); | 
 |  | } | 
 |  | } | 
 |  | #endif | 
 |  |  | 
 | if (CPU_STAT_PAGING) { | if (CPU_STAT_PAGING) { | 
 | /* task state paging check */ | /* task state paging check */ | 
 | paging_check(cur_base, CPU_TR_DESC.u.seg.limit, CPU_PAGING_PAGE_WRITE); | paging_check(cur_base, CPU_TR_DESC.u.seg.limit, CPU_PAGING_PAGE_WRITE); | 
| Line 217  task_switch(selector_t* task_sel, int ty | Line 251  task_switch(selector_t* task_sel, int ty | 
 | t = 0; | t = 0; | 
 | iobase = 0; | iobase = 0; | 
 | } | } | 
| #ifdef VERBOSE |  | 
|  | #if defined(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)); | 
| 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: regs[%d] = 0x%08x", i, regs[i])); | 
 | } | } | 
 | VERBOSE(("task_switch: nsreg = %d", nsreg)); |  | 
 | for (i = 0; i < nsreg; i++) { | for (i = 0; i < nsreg; i++) { | 
 | VERBOSE(("task_switch: sreg[%d] = 0x%04x", i, sreg[i])); | VERBOSE(("task_switch: sreg[%d] = 0x%04x", i, sreg[i])); | 
 | } | } | 
| VERBOSE(("task_switch: ldtr = 0x%04x", ldtr)); | VERBOSE(("task_switch: ldtr    = 0x%04x", ldtr)); | 
| VERBOSE(("task_switch: t = 0x%04x", t)); | VERBOSE(("task_switch: t       = 0x%04x", t)); | 
| VERBOSE(("task_switch: iobase = 0x%04x", iobase)); | VERBOSE(("task_switch: iobase  = 0x%04x", iobase)); | 
 | #endif | #endif | 
 |  |  | 
 | /* if IRET or JMP, clear busy flag in this task: need */ | /* if IRET or JMP, clear busy flag in this task: need */ | 
| Line 280  task_switch(selector_t* task_sel, int ty | Line 314  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) | 
 |  | { | 
 |  | DWORD v; | 
 |  |  | 
 |  | VERBOSE(("task_switch: current task")); | 
 |  | for (i = 0; i < CPU_TR_DESC.u.seg.limit; i += 4) { | 
 |  | v = cpu_lmemoryread_d(cur_base + i); | 
 |  | VERBOSE(("task_switch: 0x%08x: %08x", cur_base + i, v)); | 
 |  | } | 
 |  | } | 
 |  | #endif | 
 | /* set back link selector */ | /* set back link selector */ | 
 | switch (type) { | switch (type) { | 
 | case TASK_SWITCH_CALL: | case TASK_SWITCH_CALL: | 
| Line 331  task_switch(selector_t* task_sel, int ty | Line 376  task_switch(selector_t* task_sel, int ty | 
 |  |  | 
 | /* load task state (CR3, EFLAG, EIP, GPR, segreg, LDTR) */ | /* load task state (CR3, EFLAG, EIP, GPR, segreg, LDTR) */ | 
 | if (CPU_STAT_PAGING) { | if (CPU_STAT_PAGING) { | 
| /* XXX setCR3()? */ | set_CR3(cr3); | 
| CPU_CR3 = cr3 & 0xfffff018; |  | 
| tlb_flush(FALSE); |  | 
 | } | } | 
 |  |  | 
| /* set new EFLAGS, EIP, GPR, segment register, LDTR */ | /* 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); | 
 |  |  | 
 |  | /* set new EIP, GPR */ | 
 | CPU_PREV_EIP = CPU_EIP = eip; | CPU_PREV_EIP = CPU_EIP = eip; | 
 | for (i = 0; i < CPU_REG_NUM; i++) { | for (i = 0; i < CPU_REG_NUM; i++) { | 
 | CPU_REGS_DWORD(i) = regs[i]; | CPU_REGS_DWORD(i) = regs[i]; | 
| Line 347  task_switch(selector_t* task_sel, int ty | Line 392  task_switch(selector_t* task_sel, int ty | 
 | CPU_STAT_SREG_CLEAR(i); | CPU_STAT_SREG_CLEAR(i); | 
 | } | } | 
 |  |  | 
| /* load LDTR */ | /* load new LDTR */ | 
 | load_ldtr(ldtr, TS_EXCEPTION); | load_ldtr(ldtr, TS_EXCEPTION); | 
 |  |  | 
| /* load CS */ | /* set new segment register */ | 
| rv = parse_selector(&cs_sel, sreg[CPU_CS_INDEX]); | if (CPU_STAT_VM86) { | 
| if (rv < 0) { | /* VM86 */ | 
| VERBOSE(("task_switch: load CS failure (sel = 0x%04x, rv = %d)", sreg[CPU_CS_INDEX], rv)); | /* clear 32bit */ | 
| EXCEPTION(TS_EXCEPTION, cs_sel.idx); | CPU_STATSAVE.cpu_inst_default.op_32 = | 
| } | CPU_STATSAVE.cpu_inst_default.as_32 = 0; | 
|  | CPU_STAT_SS32 = 0; | 
| /* CS register must be code segment */ | CPU_STAT_CPL = task_sel->desc.dpl; | 
| if (!cs_sel.desc.s || !cs_sel.desc.u.seg.c) { |  | 
| EXCEPTION(TS_EXCEPTION, cs_sel.idx); | for (i = 0; i < nsreg; i++) { | 
| } | CPU_STAT_SREG_INIT(i); | 
|  | load_segreg(i, sreg[i], TS_EXCEPTION); | 
| /* check privilege level */ |  | 
| if (!cs_sel.desc.u.seg.ec) { |  | 
| /* non-confirming code segment */ |  | 
| if (cs_sel.desc.dpl != cs_sel.rpl) { |  | 
| EXCEPTION(TS_EXCEPTION, cs_sel.idx); |  | 
 | } | } | 
 | } else { | } else { | 
| /* confirming code segment */ | /* load CS */ | 
| if (cs_sel.desc.dpl < cs_sel.rpl) { | rv = parse_selector(&cs_sel, sreg[CPU_CS_INDEX]); | 
|  | if (rv < 0) { | 
|  | VERBOSE(("task_switch: load CS failure (sel = 0x%04x, rv = %d)", sreg[CPU_CS_INDEX], rv)); | 
 | EXCEPTION(TS_EXCEPTION, cs_sel.idx); | EXCEPTION(TS_EXCEPTION, cs_sel.idx); | 
 | } | } | 
 | } |  | 
 |  |  | 
| /* CS segment is not present */ | /* CS register must be code segment */ | 
| rv = selector_is_not_present(&cs_sel); | if (!cs_sel.desc.s || !cs_sel.desc.u.seg.c) { | 
| if (rv < 0) { | EXCEPTION(TS_EXCEPTION, cs_sel.idx); | 
| EXCEPTION(NP_EXCEPTION, cs_sel.idx); | } | 
| } |  | 
 |  |  | 
| /* Now loading CS register */ | /* check privilege level */ | 
| load_cs(cs_sel.selector, &cs_sel.desc, cs_sel.desc.dpl); | if (!cs_sel.desc.u.seg.ec) { | 
|  | /* non-confirming code segment */ | 
|  | if (cs_sel.desc.dpl != cs_sel.rpl) { | 
|  | EXCEPTION(TS_EXCEPTION, cs_sel.idx); | 
|  | } | 
|  | } else { | 
|  | /* confirming code segment */ | 
|  | if (cs_sel.desc.dpl < cs_sel.rpl) { | 
|  | EXCEPTION(TS_EXCEPTION, cs_sel.idx); | 
|  | } | 
|  | } | 
 |  |  | 
| /* load ES, SS, DS, FS, GS segment register */ | /* CS segment is not present */ | 
| for (i = 0; i < nsreg; i++) { | rv = selector_is_not_present(&cs_sel); | 
| if (i != CPU_CS_INDEX) { | if (rv < 0) { | 
| load_segreg(i, sreg[i], TS_EXCEPTION); | EXCEPTION(NP_EXCEPTION, cs_sel.idx); | 
|  | } | 
|  |  | 
|  | /* Now loading CS register */ | 
|  | load_cs(cs_sel.selector, &cs_sel.desc, cs_sel.desc.dpl); | 
|  |  | 
|  | /* load ES, SS, DS, FS, GS segment register */ | 
|  | for (i = 0; i < nsreg; i++) { | 
|  | if (i != CPU_CS_INDEX) { | 
|  | load_segreg(i, sreg[i], TS_EXCEPTION); | 
|  | } | 
 | } | } | 
 | } | } | 
 |  |  | 
| Line 404  task_switch(selector_t* task_sel, int ty | Line 464  task_switch(selector_t* task_sel, int ty | 
 | CPU_STAT_IOLIMIT = 0; | CPU_STAT_IOLIMIT = 0; | 
 | } | } | 
 |  |  | 
| /* running new task */ | VERBOSE(("task_switch: done.")); | 
| SET_EIP(eip); |  | 
 | } | } |