| version 1.6, 2004/01/13 16:34:19 | version 1.20, 2004/03/25 08:51:24 | 
| Line 30 | Line 30 | 
 | #include "compiler.h" | #include "compiler.h" | 
 | #include "cpu.h" | #include "cpu.h" | 
 | #include "ia32.mcr" | #include "ia32.mcr" | 
 |  |  | 
 |  | #include "pccore.h" | 
 |  | #include "iocore.h" | 
 | #include "dmap.h" | #include "dmap.h" | 
 | #include "bios.h" | #include "bios.h" | 
 |  | #if defined(IA32_REBOOT_ON_PANIC) | 
 |  | #include "pccore.h" | 
 |  | #endif | 
 |  |  | 
 |  |  | 
 | void | void | 
| ia32reset(void) | ia32_initreg(void) | 
 | { | { | 
 | int i; | int i; | 
 |  |  | 
| memset(&i386core.s, 0, sizeof(i386core.s));                     // yui | CPU_STATSAVE.cpu_inst_default.seg_base = (UINT32)-1; | 
| CPU_STATSAVE.cpu_inst_default.seg_base = (DWORD)-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 | 
 |  | CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE; | 
 |  | CPU_CR0 &= ~CPU_CR0_MP; | 
 |  | #endif | 
 | CPU_MXCSR = 0x1f80; | CPU_MXCSR = 0x1f80; | 
 | CPU_GDTR_LIMIT = 0xffff; | CPU_GDTR_LIMIT = 0xffff; | 
 | CPU_IDTR_LIMIT = 0xffff; | CPU_IDTR_LIMIT = 0xffff; | 
 |  |  | 
 |  | #if CPU_FAMILY == 4 | 
 |  | CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0; | 
 |  | #elif CPU_FAMILY >= 5 | 
 |  | 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); | CPU_STAT_SREG_INIT(i); | 
 | } | } | 
 | CPU_LDTR_LIMIT = 0xffff; | CPU_LDTR_LIMIT = 0xffff; | 
 | CPU_TR_LIMIT = 0xffff; | CPU_TR_LIMIT = 0xffff; | 
 |  |  | 
 | //      CPU_SET_SEGREG(CPU_ES_INDEX, 0x0000); |  | 
 | CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000); | CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000); | 
 | //      CPU_SET_SEGREG(CPU_SS_INDEX, 0x0000); |  | 
 | //      CPU_SET_SEGREG(CPU_DS_INDEX, 0x0000); |  | 
 | CPU_EIP = 0xfff0; | CPU_EIP = 0xfff0; | 
| CPU_ADRSMASK = 0xfffff; | CPU_ADRSMASK = 0x000fffff; | 
|  |  | 
|  | tlb_init(); | 
 | } | } | 
 |  |  | 
 | void | void | 
| ia32shut(void) | ia32reset(void) | 
 | { | { | 
| SINT32  remainclock;                                    // 結局ハマるのか漏れ… |  | 
| SINT32  baseclock; | memset(&i386core.s, 0, sizeof(i386core.s)); | 
| UINT32  clock; | ia32_initreg(); | 
|  |  | 
| remainclock = CPU_REMCLOCK; |  | 
| baseclock = CPU_BASECLOCK; |  | 
| clock = CPU_CLOCK; |  | 
|  |  | 
| ia32reset(); |  | 
|  |  | 
| CPU_REMCLOCK = remainclock; |  | 
| CPU_BASECLOCK = baseclock; |  | 
| CPU_CLOCK = clock; |  | 
 | } | } | 
 |  |  | 
 | void | void | 
| ia32(void) | ia32shut(void) | 
 | { | { | 
 | int rv; |  | 
 |  |  | 
 | #if defined(WIN32) |  | 
 | rv = setjmp(exec_1step_jmpbuf); |  | 
 | #else |  | 
 | rv = sigsetjmp(exec_1step_jmpbuf, 1); |  | 
 | #endif |  | 
 | switch (rv) { |  | 
 | case 0: |  | 
 | break; |  | 
 |  |  | 
 | default: |  | 
 | CPU_EIP = CPU_PREV_EIP; |  | 
 | break; |  | 
 | } |  | 
 |  |  | 
| do { | memset(&i386core.s, 0, offsetof(I386STAT, cpu_type)); | 
| exec_1step(); | ia32_initreg(); | 
| } while (CPU_REMCLOCK > 0); |  | 
 | } | } | 
 |  |  | 
 | void | void | 
| ia32withtrap(void) | ia32a20enable(BOOL enable) | 
 | { | { | 
| int rv; | #if (CPU_FAMILY == 3) | 
|  | CPU_ADRSMASK = (enable)?0x00ffffff:0x00ffffff; | 
| #if defined(WIN32) |  | 
| rv = setjmp(exec_1step_jmpbuf); |  | 
 | #else | #else | 
| rv = sigsetjmp(exec_1step_jmpbuf, 1); | CPU_ADRSMASK = (enable)?0xffffffff:0x00ffffff; | 
 | #endif | #endif | 
 | switch (rv) { |  | 
 | case 0: |  | 
 | break; |  | 
 |  |  | 
 | default: |  | 
 | CPU_EIP = CPU_PREV_EIP; |  | 
 | break; |  | 
 | } |  | 
 |  |  | 
 |  |  | 
 | do { |  | 
 | exec_1step(); |  | 
 | if (CPU_TRAP) { |  | 
 | ia32_interrupt(1); |  | 
 | } |  | 
 | } while (CPU_REMCLOCK > 0); |  | 
 | } | } | 
 |  |  | 
 | void | void | 
| ia32withdma(void) | ia32(void) | 
 | { | { | 
 | int rv; | int rv; | 
 |  |  | 
 | #if defined(WIN32) |  | 
 | rv = setjmp(exec_1step_jmpbuf); |  | 
 | #else |  | 
 | rv = sigsetjmp(exec_1step_jmpbuf, 1); | rv = sigsetjmp(exec_1step_jmpbuf, 1); | 
 | #endif |  | 
 | switch (rv) { | switch (rv) { | 
 | case 0: | case 0: | 
 | break; | break; | 
|  |  | 
|  | case 1: | 
|  | VERBOSE(("ia32: return from exception")); | 
|  | break; | 
|  |  | 
|  | case 2: | 
|  | VERBOSE(("ia32: return from panic")); | 
|  | return; | 
|  |  | 
 | default: | default: | 
| CPU_EIP = CPU_PREV_EIP; | VERBOSE(("ia32: return from unknown cause")); | 
 | break; | break; | 
 | } | } | 
 |  |  | 
|  | #if defined(IA32_SUPPORT_DEBUG_REGISTER) | 
 | do { | do { | 
 | exec_1step(); | exec_1step(); | 
| dmap_i286(); | if (dmac.working) { | 
|  | dmap(); | 
|  | } | 
 | } while (CPU_REMCLOCK > 0); | } while (CPU_REMCLOCK > 0); | 
 |  | #else | 
 |  | if (CPU_TRAP) { | 
 |  | do { | 
 |  | exec_1step(); | 
 |  | if (CPU_TRAP) { | 
 |  | CPU_DR6 |= CPU_DR6_BS; | 
 |  | INTERRUPT(1, TRUE, FALSE, 0); | 
 |  | } | 
 |  | dmap(); | 
 |  | } while (CPU_REMCLOCK > 0); | 
 |  | } else if (dmac.working) { | 
 |  | do { | 
 |  | exec_1step(); | 
 |  | dmap(); | 
 |  | } while (CPU_REMCLOCK > 0); | 
 |  | } else { | 
 |  | do { | 
 |  | exec_1step(); | 
 |  | } while (CPU_REMCLOCK > 0); | 
 |  | } | 
 |  | #endif | 
 | } | } | 
 |  |  | 
 | void | void | 
| Line 164  ia32_step(void) | Line 162  ia32_step(void) | 
 | { | { | 
 | int rv; | int rv; | 
 |  |  | 
 | #if defined(WIN32) |  | 
 | rv = setjmp(exec_1step_jmpbuf); |  | 
 | #else |  | 
 | rv = sigsetjmp(exec_1step_jmpbuf, 1); | rv = sigsetjmp(exec_1step_jmpbuf, 1); | 
 | #endif |  | 
 | switch (rv) { | switch (rv) { | 
 | case 0: | case 0: | 
 | break; | break; | 
|  |  | 
|  | case 1: | 
|  | VERBOSE(("ia32_step: return from exception")); | 
|  | break; | 
|  |  | 
|  | case 2: | 
|  | VERBOSE(("ia32_step: return from panic")); | 
|  | return; | 
|  |  | 
 | default: | default: | 
| CPU_EIP = CPU_PREV_EIP; | VERBOSE(("ia32_step: return from unknown cause")); | 
 | break; | break; | 
 | } | } | 
 |  |  | 
 |  |  | 
 | 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, TRUE, FALSE, 0); | 
|  | } | 
|  | #endif | 
|  | if (dmac.working) { | 
|  | dmap(); | 
 | } | } | 
 | 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, FALSE, FALSE, 0); | 
|  | } | 
|  | else { | 
|  | if (CPU_STAT_VM86 && (CPU_STAT_IOPL < CPU_IOPL3) && (soft == -1)) { | 
|  | TRACEOUT(("BIOS interrupt: VM86 && IOPL < 3 && INTn")); | 
|  | } | 
|  | INTERRUPT(vect, TRUE, FALSE, 0); | 
|  | } | 
 | } | } | 
 |  |  | 
 |  |  | 
 | /* | /* | 
 | * error function | * error function | 
 | */ | */ | 
| Line 202  void | Line 218  void | 
 | ia32_panic(const char *str, ...) | ia32_panic(const char *str, ...) | 
 | { | { | 
 | extern char *cpu_reg2str(void); | extern char *cpu_reg2str(void); | 
| char buf[1024]; | char buf[2048]; | 
 | va_list ap; | va_list ap; | 
 |  |  | 
 | va_start(ap, str); | va_start(ap, str); | 
 | vsnprintf(buf, sizeof(buf), str, ap); | vsnprintf(buf, sizeof(buf), str, ap); | 
 | va_end(ap); | va_end(ap); | 
 | strcat(buf, "\n"); | strcat(buf, "\n"); | 
 |  | strcat(buf, cpu_reg2str()); | 
 |  |  | 
| #if defined(_WIN32) | msgbox("ia32_panic", buf); | 
| MessageBox(NULL, buf, "ia32_panic", MB_OK); |  | 
| #endif |  | 
 |  |  | 
| fprintf(stderr, buf); | #if defined(IA32_REBOOT_ON_PANIC) | 
| fprintf(stderr, cpu_reg2str()); | VERBOSE(("ia32_panic: reboot")); | 
|  | pccore_reset(); | 
|  | siglongjmp(exec_1step_jmpbuf, 2); | 
|  | #else | 
 | __ASSERT(0); | __ASSERT(0); | 
 | exit(1); | exit(1); | 
 |  | #endif | 
 | } | } | 
 |  |  | 
 | void | void | 
| Line 230  ia32_warning(const char *str, ...) | Line 249  ia32_warning(const char *str, ...) | 
 | va_end(ap); | va_end(ap); | 
 | strcat(buf, "\n"); | strcat(buf, "\n"); | 
 |  |  | 
| fprintf(stderr, buf); | msgbox("ia32_warning", buf); | 
 | } | } | 
 |  |  | 
 | void | void | 
| Line 241  ia32_printf(const char *str, ...) | Line 260  ia32_printf(const char *str, ...) | 
 | va_start(ap, str); | va_start(ap, str); | 
 | vsnprintf(buf, sizeof(buf), str, ap); | vsnprintf(buf, sizeof(buf), str, ap); | 
 | va_end(ap); | va_end(ap); | 
 |  | strcat(buf, "\n"); | 
 |  |  | 
| fprintf(stderr, buf); | msgbox("ia32_printf", buf); | 
 | } | } | 
 |  |  | 
 |  |  | 
 | /* | /* | 
 | * bios call interface | * bios call interface | 
 | */ | */ | 
 | void | void | 
 | ia32_bioscall(void) | ia32_bioscall(void) | 
 | { | { | 
 |  | UINT32 adrs; | 
 |  |  | 
| /* XXX */ | if (!CPU_STAT_PM || CPU_STAT_VM86) { | 
| if (!CPU_STAT_PM && !CPU_INST_OP32 && !CPU_INST_AS32) { | #if 1 | 
| DWORD adrs; | adrs = (CPU_EIP - 1) + ((CPU_REGS_SREG(CPU_CS_INDEX)) << 4); | 
| WORD sreg; | #else | 
|  | adrs = (CPU_EIP - 1) + CPU_STAT_CS_BASE; | 
| adrs = ((CPU_IP-1) & 0xffff) + CPU_STAT_SREGBASE(CPU_CS_INDEX); | #endif | 
 | if ((adrs >= 0xf8000) && (adrs < 0x100000)) { | if ((adrs >= 0xf8000) && (adrs < 0x100000)) { | 
 | biosfunc(adrs); | biosfunc(adrs); | 
| sreg = CPU_ES; | if (!CPU_STAT_PM || CPU_STAT_VM86) { | 
| CPU_SET_SEGREG(CPU_ES_INDEX, sreg); | CPU_SET_SEGREG(CPU_ES_INDEX, CPU_ES); | 
| sreg = CPU_CS; | CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS); | 
| CPU_SET_SEGREG(CPU_CS_INDEX, sreg); | CPU_SET_SEGREG(CPU_SS_INDEX, CPU_SS); | 
| sreg = CPU_SS; | CPU_SET_SEGREG(CPU_DS_INDEX, CPU_DS); | 
| CPU_SET_SEGREG(CPU_SS_INDEX, sreg); | } | 
| sreg = CPU_DS; |  | 
| CPU_SET_SEGREG(CPU_DS_INDEX, sreg); |  | 
 | } | } | 
 | } | } | 
 | } | } |