|
|
| version 1.8, 2004/01/24 18:20:06 | version 1.30, 2011/12/20 02:00:32 |
|---|---|
| Line 1 | Line 1 |
| /* $Id$ */ | |
| /* | /* |
| * Copyright (c) 2002-2003 NONAKA Kimihiro | * Copyright (c) 2002-2003 NONAKA Kimihiro |
| * All rights reserved. | * All rights reserved. |
| Line 12 | Line 10 |
| * 2. Redistributions in binary form must reproduce the above copyright | * 2. Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the | * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. | * documentation and/or other materials provided with the distribution. |
| * 3. The name of the author may not be used to endorse or promote products | |
| * derived from this software without specific prior written permission. | |
| * | * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| Line 30 | Line 26 |
| #include "compiler.h" | #include "compiler.h" |
| #include "cpu.h" | #include "cpu.h" |
| #include "ia32.mcr" | #include "ia32.mcr" |
| #if defined(USE_FPU) | |
| #include "instructions/fpu/fp.h" | |
| #endif | |
| #include "dmap.h" | #include "pccore.h" |
| #include "iocore.h" | |
| #include "dmax86.h" | |
| #include "bios.h" | #include "bios.h" |
| static void ia32_initreg(void) { | void |
| ia32_initreg(void) | |
| { | |
| int i; | int i; |
| CPU_STATSAVE.cpu_inst_default.seg_base = (DWORD)-1; | CPU_STATSAVE.cpu_inst_default.seg_base = (UINT32)-1; |
| CPU_EDX = (CPU_FAMILY << 8) | (CPU_MODEL << 4) | CPU_STEPPING; | CPU_EDX = (CPU_FAMILY << 8) | (CPU_MODEL << 4) | CPU_STEPPING; |
| CPU_EFLAG = 2; | CPU_EFLAG = 2; |
| CPU_CR0 = CPU_CR0_CD | CPU_CR0_NW | CPU_CR0_ET; | CPU_CR0 = CPU_CR0_CD | CPU_CR0_NW | CPU_CR0_ET; |
| #ifndef USE_FPU | #if defined(USE_FPU) |
| CPU_CR0 |= CPU_CR0_ET; | |
| #else | |
| CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE; | CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE; |
| CPU_CR0 &= ~CPU_CR0_MP; | CPU_CR0 &= ~(CPU_CR0_MP | CPU_CR0_ET); |
| #endif | #endif |
| CPU_MXCSR = 0x1f80; | CPU_MXCSR = 0x1f80; |
| CPU_GDTR_BASE = 0x0; | |
| CPU_GDTR_LIMIT = 0xffff; | CPU_GDTR_LIMIT = 0xffff; |
| CPU_IDTR_BASE = 0x0; | |
| CPU_IDTR_LIMIT = 0xffff; | CPU_IDTR_LIMIT = 0xffff; |
| CPU_LDTR_BASE = 0x0; | |
| CPU_LDTR_LIMIT = 0xffff; | |
| CPU_TR_BASE = 0x0; | |
| CPU_TR_LIMIT = 0xffff; | |
| #if CPU_FAMILY == 4 | |
| CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0; | CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0; |
| #elif (CPU_FAMILY == 5) || (CPU_FAMILY == 6) | |
| CPU_STATSAVE.cpu_regs.dr[6] = 0xffff0ff0; | |
| CPU_STATSAVE.cpu_regs.dr[7] = 0x00000400; | |
| #endif | |
| for (i = 0; i < CPU_SEGREG_NUM; ++i) { | for (i = 0; i < CPU_SEGREG_NUM; ++i) { |
| CPU_STAT_SREG_INIT(i); | segdesc_init(i, 0, &CPU_STAT_SREG(i)); |
| } | } |
| CPU_LDTR_LIMIT = 0xffff; | LOAD_SEGREG(CPU_CS_INDEX, 0xf000); |
| CPU_TR_LIMIT = 0xffff; | CPU_STAT_CS_BASE = 0xffff0000; |
| CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000); | |
| CPU_EIP = 0xfff0; | CPU_EIP = 0xfff0; |
| CPU_ADRSMASK = 0x000fffff; | CPU_ADRSMASK = 0x000fffff; |
| tlb_init(); | |
| #if defined(USE_FPU) | |
| fpu_init(); | |
| #endif | |
| } | } |
| void | void |
| ia32reset(void) | ia32reset(void) |
| { | { |
| ZeroMemory(&i386core.s, sizeof(i386core.s)); | |
| memset(&i386core.s, 0, sizeof(i386core.s)); | |
| ia32_initreg(); | ia32_initreg(); |
| } | } |
| void | void |
| ia32shut(void) | ia32shut(void) |
| { | { |
| ZeroMemory(&i386core.s, offsetof(I386STAT, cpu_type)); | |
| memset(&i386core.s, 0, offsetof(I386STAT, cpu_type)); | |
| ia32_initreg(); | ia32_initreg(); |
| } | } |
| void | void |
| ia32(void) | ia32a20enable(BOOL enable) |
| { | { |
| int rv; | |
| rv = sigsetjmp(exec_1step_jmpbuf, 1); | CPU_ADRSMASK = (enable)?0xffffffff:0x00ffffff; |
| switch (rv) { | |
| case 0: | |
| break; | |
| case 1: | |
| VERBOSE(("ia32: return from exception")); | |
| break; | |
| default: | |
| VERBOSE(("ia32: return from unknown cause")); | |
| break; | |
| } | |
| do { | |
| exec_1step(); | |
| } while (CPU_REMCLOCK > 0); | |
| } | } |
| void | void |
| ia32withtrap(void) | ia32(void) |
| { | { |
| int rv; | int rv; |
| Line 119 ia32withtrap(void) | Line 113 ia32withtrap(void) |
| break; | break; |
| case 1: | case 1: |
| VERBOSE(("ia32withtrap: return from exception")); | VERBOSE(("ia32: return from exception")); |
| break; | break; |
| case 2: | |
| VERBOSE(("ia32: return from panic")); | |
| return; | |
| default: | default: |
| VERBOSE(("ia32withtrap: return from unknown cause")); | VERBOSE(("ia32: return from unknown cause")); |
| break; | break; |
| } | } |
| #if defined(IA32_SUPPORT_DEBUG_REGISTER) | |
| do { | do { |
| exec_1step(); | exec_1step(); |
| if (CPU_TRAP) { | if (dmac.working) { |
| ia32_interrupt(1); | dmax86(); |
| } | } |
| } while (CPU_REMCLOCK > 0); | } while (CPU_REMCLOCK > 0); |
| } | #else |
| if (CPU_TRAP) { | |
| void | do { |
| ia32withdma(void) | exec_1step(); |
| { | if (CPU_TRAP) { |
| int rv; | CPU_DR6 |= CPU_DR6_BS; |
| INTERRUPT(1, INTR_TYPE_EXCEPTION); | |
| rv = sigsetjmp(exec_1step_jmpbuf, 1); | } |
| switch (rv) { | dmax86(); |
| case 0: | } while (CPU_REMCLOCK > 0); |
| break; | } else if (dmac.working) { |
| do { | |
| case 1: | exec_1step(); |
| VERBOSE(("ia32withdma: return from exception")); | dmax86(); |
| break; | } while (CPU_REMCLOCK > 0); |
| } else { | |
| default: | do { |
| VERBOSE(("ia32withdma: return from unknown cause")); | exec_1step(); |
| break; | } while (CPU_REMCLOCK > 0); |
| } | } |
| #endif | |
| do { | |
| exec_1step(); | |
| dmap_i286(); | |
| } while (CPU_REMCLOCK > 0); | |
| } | } |
| void | void |
| Line 174 ia32_step(void) | Line 169 ia32_step(void) |
| VERBOSE(("ia32_step: return from exception")); | VERBOSE(("ia32_step: return from exception")); |
| break; | break; |
| case 2: | |
| VERBOSE(("ia32_step: return from panic")); | |
| return; | |
| default: | default: |
| VERBOSE(("ia32_step: return from unknown cause")); | VERBOSE(("ia32_step: return from unknown cause")); |
| break; | break; |
| Line 181 ia32_step(void) | Line 180 ia32_step(void) |
| do { | do { |
| exec_1step(); | exec_1step(); |
| #if !defined(IA32_SUPPORT_DEBUG_REGISTER) | |
| if (CPU_TRAP) { | if (CPU_TRAP) { |
| ia32_interrupt(1); | CPU_DR6 |= CPU_DR6_BS; |
| INTERRUPT(1, INTR_TYPE_EXCEPTION); | |
| } | |
| #endif | |
| if (dmac.working) { | |
| dmax86(); | |
| } | } |
| dmap_i286(); | |
| } while (CPU_REMCLOCK > 0); | } while (CPU_REMCLOCK > 0); |
| } | } |
| void CPUCALL | void CPUCALL |
| ia32_interrupt(BYTE vect) | ia32_interrupt(int vect, int soft) |
| { | { |
| INTERRUPT(vect, 0, 0, 0); | // TRACEOUT(("int (%x, %x) PE=%d VM=%d", vect, soft, CPU_STAT_PM, CPU_STAT_VM86)); |
| if (!soft) { | |
| INTERRUPT(vect, INTR_TYPE_EXTINTR); | |
| } else { | |
| if (CPU_STAT_PM && CPU_STAT_VM86 && CPU_STAT_IOPL < CPU_IOPL3) { | |
| VERBOSE(("ia32_interrupt: VM86 && IOPL < 3 && INTn")); | |
| EXCEPTION(GP_EXCEPTION, 0); | |
| } | |
| INTERRUPT(vect, INTR_TYPE_SOFTINTR); | |
| } | |
| } | } |
| Line 214 ia32_panic(const char *str, ...) | Line 227 ia32_panic(const char *str, ...) |
| msgbox("ia32_panic", buf); | msgbox("ia32_panic", buf); |
| #if defined(IA32_REBOOT_ON_PANIC) | |
| VERBOSE(("ia32_panic: reboot")); | |
| pccore_reset(); | |
| siglongjmp(exec_1step_jmpbuf, 2); | |
| #else | |
| __ASSERT(0); | __ASSERT(0); |
| exit(1); | exit(1); |
| #endif | |
| } | } |
| void | void |
| Line 251 ia32_printf(const char *str, ...) | Line 270 ia32_printf(const char *str, ...) |
| void | void |
| ia32_bioscall(void) | ia32_bioscall(void) |
| { | { |
| DWORD adrs; | UINT32 adrs; |
| if (!CPU_STAT_PM && !CPU_INST_OP32 && !CPU_INST_AS32) { | if (!CPU_STAT_PM || CPU_STAT_VM86) { |
| adrs = ((CPU_IP-1) & 0xffff) + CPU_STAT_SREGBASE(CPU_CS_INDEX); | #if 1 |
| adrs = CPU_PREV_EIP + (CPU_CS << 4); | |
| #else | |
| adrs = CPU_PREV_EIP + CPU_STAT_CS_BASE; | |
| #endif | |
| if ((adrs >= 0xf8000) && (adrs < 0x100000)) { | if ((adrs >= 0xf8000) && (adrs < 0x100000)) { |
| biosfunc(adrs); | if (biosfunc(adrs)) { |
| CPU_SET_SEGREG(CPU_ES_INDEX, CPU_ES); | /* Nothing to do */ |
| CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS); | } |
| CPU_SET_SEGREG(CPU_SS_INDEX, CPU_SS); | LOAD_SEGREG(CPU_ES_INDEX, CPU_ES); |
| CPU_SET_SEGREG(CPU_DS_INDEX, CPU_DS); | LOAD_SEGREG(CPU_CS_INDEX, CPU_CS); |
| LOAD_SEGREG(CPU_SS_INDEX, CPU_SS); | |
| LOAD_SEGREG(CPU_DS_INDEX, CPU_DS); | |
| } | } |
| } | } |
| } | } |