| version 1.26, 2011/12/17 02:08:04 | version 1.29, 2011/12/23 04:16:51 | 
| Line 201  task_switch(selector_t *task_sel, task_s | Line 201  task_switch(selector_t *task_sel, task_s | 
 | UINT16 ldtr; | UINT16 ldtr; | 
 | UINT16 iobase; | UINT16 iobase; | 
 | UINT16 t; | UINT16 t; | 
 |  | int new_cpl; | 
 |  |  | 
 | selector_t cs_sel, ss_sel; | selector_t cs_sel, ss_sel; | 
 | int rv; | int rv; | 
| Line 436  task_switch(selector_t *task_sel, task_s | Line 437  task_switch(selector_t *task_sel, task_s | 
 | CPU_CR0 |= CPU_CR0_TS; | CPU_CR0 |= CPU_CR0_TS; | 
 |  |  | 
 | /* | /* | 
| * load task state (CR3, EFLAG, EIP, GPR, segreg, LDTR) | * load task state (CR3, EIP, GPR, segregs, LDTR, EFLAGS) | 
 | */ | */ | 
 |  |  | 
 | /* set new CR3 */ | /* set new CR3 */ | 
| Line 444  task_switch(selector_t *task_sel, task_s | Line 445  task_switch(selector_t *task_sel, task_s | 
 | set_cr3(cr3); | set_cr3(cr3); | 
 | } | } | 
 |  |  | 
| /* set new EIP, GPR */ | /* set new EIP, GPR, segregs */ | 
 | CPU_EIP = 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]; | 
 | } | } | 
 | for (i = 0; i < CPU_SEGREG_NUM; i++) { | for (i = 0; i < CPU_SEGREG_NUM; i++) { | 
 | segdesc_init(i, sreg[i], &CPU_STAT_SREG(i)); | segdesc_init(i, sreg[i], &CPU_STAT_SREG(i)); | 
 |  | /* invalidate segreg descriptor */ | 
 |  | CPU_STAT_SREG(i).valid = 0; | 
 | } | } | 
 |  |  | 
 |  | CPU_CLEAR_PREV_ESP(); | 
 |  |  | 
 | /* load new LDTR */ | /* load new LDTR */ | 
 |  | CPU_LDTR_DESC.valid = 0; | 
 | load_ldtr(ldtr, TS_EXCEPTION); | load_ldtr(ldtr, TS_EXCEPTION); | 
 |  |  | 
 | /* I/O deny bitmap */ | /* I/O deny bitmap */ | 
| Line 485  task_switch(selector_t *task_sel, task_s | Line 491  task_switch(selector_t *task_sel, task_s | 
 |  |  | 
 | /* set new segment register */ | /* set new segment register */ | 
 | if (!CPU_STAT_VM86) { | if (!CPU_STAT_VM86) { | 
| /* clear segment descriptor cache */ | /* load SS */ | 
| for (i = 0; i < CPU_SEGREG_NUM; i++) { | rv = parse_selector(&ss_sel, sreg[CPU_SS_INDEX]); | 
| segdesc_clear(&CPU_STAT_SREG(i)); | if (rv < 0) { | 
|  | VERBOSE(("task_switch: load SS failure (sel = 0x%04x, rv = %d)", sreg[CPU_SS_INDEX], rv)); | 
|  | EXCEPTION(TS_EXCEPTION, ss_sel.idx); | 
|  | } | 
|  |  | 
|  | /* SS must be writable data segment */ | 
|  | if (SEG_IS_SYSTEM(&ss_sel.desc) | 
|  | || SEG_IS_CODE(&ss_sel.desc) | 
|  | || !SEG_IS_WRITABLE_DATA(&ss_sel.desc)) { | 
|  | EXCEPTION(TS_EXCEPTION, ss_sel.idx); | 
|  | } | 
|  |  | 
|  | /* check privilege level */ | 
|  | if ((ss_sel.desc.dpl != cs_sel.rpl) | 
|  | || (ss_sel.desc.dpl != ss_sel.rpl)) { | 
|  | EXCEPTION(TS_EXCEPTION, ss_sel.idx); | 
|  | } | 
|  |  | 
|  | /* stack segment is not present */ | 
|  | rv = selector_is_not_present(&ss_sel); | 
|  | if (rv < 0) { | 
|  | EXCEPTION(SS_EXCEPTION, ss_sel.idx); | 
 | } | } | 
 |  |  | 
 |  | /* Now loading SS register */ | 
 |  | load_ss(ss_sel.selector, &ss_sel.desc, cs_sel.rpl); | 
 |  |  | 
 |  | /* load ES, DS, FS, GS segment register */ | 
 |  | LOAD_SEGREG1(CPU_ES_INDEX, sreg[CPU_ES_INDEX], TS_EXCEPTION); | 
 |  | LOAD_SEGREG1(CPU_DS_INDEX, sreg[CPU_DS_INDEX], TS_EXCEPTION); | 
 |  | LOAD_SEGREG1(CPU_FS_INDEX, sreg[CPU_FS_INDEX], TS_EXCEPTION); | 
 |  | LOAD_SEGREG1(CPU_GS_INDEX, sreg[CPU_GS_INDEX], TS_EXCEPTION); | 
 |  |  | 
 | /* load CS */ | /* load CS */ | 
 | rv = parse_selector(&cs_sel, sreg[CPU_CS_INDEX]); | rv = parse_selector(&cs_sel, sreg[CPU_CS_INDEX]); | 
 | if (rv < 0) { | if (rv < 0) { | 
| Line 521  task_switch(selector_t *task_sel, task_s | Line 557  task_switch(selector_t *task_sel, task_s | 
 | EXCEPTION(NP_EXCEPTION, cs_sel.idx); | EXCEPTION(NP_EXCEPTION, cs_sel.idx); | 
 | } | } | 
 |  |  | 
| /* load SS */ | /* Now loading CS register */ | 
| rv = parse_selector(&ss_sel, sreg[CPU_SS_INDEX]); |  | 
| if (rv < 0) { |  | 
| VERBOSE(("task_switch: load SS failure (sel = 0x%04x, rv = %d)", sreg[CPU_SS_INDEX], rv)); |  | 
| EXCEPTION(TS_EXCEPTION, ss_sel.idx); |  | 
| } |  | 
|  |  | 
| /* SS must be writable data segment */ |  | 
| if (SEG_IS_SYSTEM(&ss_sel.desc) |  | 
| || SEG_IS_CODE(&ss_sel.desc) |  | 
| || !SEG_IS_WRITABLE_DATA(&ss_sel.desc)) { |  | 
| EXCEPTION(TS_EXCEPTION, ss_sel.idx); |  | 
| } |  | 
|  |  | 
| /* check privilege level */ |  | 
| if ((ss_sel.desc.dpl != cs_sel.rpl) |  | 
| || (ss_sel.desc.dpl != ss_sel.rpl)) { |  | 
| EXCEPTION(TS_EXCEPTION, ss_sel.idx); |  | 
| } |  | 
|  |  | 
| /* stack segment is not present */ |  | 
| rv = selector_is_not_present(&ss_sel); |  | 
| if (rv < 0) { |  | 
| EXCEPTION(SS_EXCEPTION, ss_sel.idx); |  | 
| } |  | 
|  |  | 
| /* Now loading CS/SS register */ |  | 
 | load_cs(cs_sel.selector, &cs_sel.desc, cs_sel.rpl); | load_cs(cs_sel.selector, &cs_sel.desc, cs_sel.rpl); | 
 | load_ss(ss_sel.selector, &ss_sel.desc, cs_sel.rpl); |  | 
 |  |  | 
 | /* load ES, DS, FS, GS segment register */ |  | 
 | for (i = 0; i < CPU_SEGREG_NUM; i++) { |  | 
 | if (i != CPU_CS_INDEX || i != CPU_SS_INDEX) { |  | 
 | LOAD_SEGREG1(i, sreg[i], TS_EXCEPTION); |  | 
 | } |  | 
 | } |  | 
 | } |  | 
 |  |  | 
 | /* 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.")); |