|
|
| version 1.1, 2003/12/08 00:55:31 | 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" |
| #include "dmap.h" | #if defined(USE_FPU) |
| #include "instructions/fpu/fp.h" | |
| #endif | |
| #include "pccore.h" | |
| #include "iocore.h" | |
| #include "dmax86.h" | |
| #include "bios.h" | #include "bios.h" |
| void | void |
| ia32reset(void) | ia32_initreg(void) |
| { | { |
| // cpu_init(); | int i; |
| #ifdef USE_FPU // ->ia32_init | |
| // fpu_init(); | CPU_STATSAVE.cpu_inst_default.seg_base = (UINT32)-1; |
| CPU_EDX = (CPU_FAMILY << 8) | (CPU_MODEL << 4) | CPU_STEPPING; | |
| CPU_EFLAG = 2; | |
| CPU_CR0 = CPU_CR0_CD | CPU_CR0_NW | CPU_CR0_ET; | |
| #if defined(USE_FPU) | |
| CPU_CR0 |= CPU_CR0_ET; | |
| #else | |
| CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE; | |
| CPU_CR0 &= ~(CPU_CR0_MP | CPU_CR0_ET); | |
| #endif | #endif |
| CPU_MXCSR = 0x1f80; | |
| CPU_GDTR_BASE = 0x0; | |
| CPU_GDTR_LIMIT = 0xffff; | |
| CPU_IDTR_BASE = 0x0; | |
| CPU_IDTR_LIMIT = 0xffff; | |
| CPU_LDTR_BASE = 0x0; | |
| CPU_LDTR_LIMIT = 0xffff; | |
| CPU_TR_BASE = 0x0; | |
| CPU_TR_LIMIT = 0xffff; | |
| CPU_SET_SEGREG(CPU_CS_INDEX, 0x1fc0); | CPU_STATSAVE.cpu_regs.dr[6] = 0xffff1ff0; |
| for (i = 0; i < CPU_SEGREG_NUM; ++i) { | |
| segdesc_init(i, 0, &CPU_STAT_SREG(i)); | |
| } | |
| LOAD_SEGREG(CPU_CS_INDEX, 0xf000); | |
| CPU_STAT_CS_BASE = 0xffff0000; | |
| CPU_EIP = 0xfff0; | |
| CPU_ADRSMASK = 0x000fffff; | |
| tlb_init(); | |
| #if defined(USE_FPU) | |
| fpu_init(); | |
| #endif | |
| } | } |
| void | void |
| ia32(void) | ia32reset(void) |
| { | { |
| int rv; | |
| rv = sigsetjmp(exec_1step_jmpbuf, 1); | |
| switch (rv) { | |
| case 0: | |
| break; | |
| default: | |
| CPU_EIP = CPU_PREV_EIP; | |
| break; | |
| } | |
| do { | memset(&i386core.s, 0, sizeof(i386core.s)); |
| exec_1step(); | ia32_initreg(); |
| } while (CPU_REMCLOCK > 0); | |
| } | } |
| void | void |
| ia32withtrap(void) | ia32shut(void) |
| { | { |
| int rv; | |
| rv = sigsetjmp(exec_1step_jmpbuf, 1); | memset(&i386core.s, 0, offsetof(I386STAT, cpu_type)); |
| switch (rv) { | ia32_initreg(); |
| case 0: | } |
| break; | |
| default: | |
| CPU_EIP = CPU_PREV_EIP; | |
| break; | |
| } | |
| void | |
| ia32a20enable(BOOL enable) | |
| { | |
| do { | CPU_ADRSMASK = (enable)?0xffffffff:0x00ffffff; |
| exec_1step(); | |
| if (CPU_TRAP) { | |
| ia32_interrupt(1); | |
| } | |
| } while (CPU_REMCLOCK > 0); | |
| } | } |
| void | void |
| ia32withdma(void) | ia32(void) |
| { | { |
| int rv; | int rv; |
| Line 98 ia32withdma(void) | Line 111 ia32withdma(void) |
| 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) { |
| dmax86(); | |
| } | |
| } 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, INTR_TYPE_EXCEPTION); | |
| } | |
| dmax86(); | |
| } while (CPU_REMCLOCK > 0); | |
| } else if (dmac.working) { | |
| do { | |
| exec_1step(); | |
| dmax86(); | |
| } while (CPU_REMCLOCK > 0); | |
| } else { | |
| do { | |
| exec_1step(); | |
| } while (CPU_REMCLOCK > 0); | |
| } | |
| #endif | |
| } | } |
| void | void |
| Line 120 ia32_step(void) | Line 164 ia32_step(void) |
| 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, 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); | |
| } | |
| } | } |
| /* | /* |
| * error function | * error function |
| */ | */ |
| void | void |
| ia32_panic(const char *str, ...) | ia32_panic(const char *str, ...) |
| { | { |
| char buf[1024]; | extern char *cpu_reg2str(void); |
| 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()); | |
| fprintf(stderr, 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 171 ia32_warning(const char *str, ...) | Line 247 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 182 ia32_printf(const char *str, ...) | Line 258 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_PREV_EIP + (CPU_CS << 4); |
| WORD sreg; | #else |
| adrs = CPU_PREV_EIP + 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); | if (biosfunc(adrs)) { |
| sreg = CPU_ES; | /* Nothing to do */ |
| CPU_SET_SEGREG(CPU_ES_INDEX, sreg); | } |
| sreg = CPU_CS; | LOAD_SEGREG(CPU_ES_INDEX, CPU_ES); |
| CPU_SET_SEGREG(CPU_CS_INDEX, sreg); | LOAD_SEGREG(CPU_CS_INDEX, CPU_CS); |
| sreg = CPU_SS; | LOAD_SEGREG(CPU_SS_INDEX, CPU_SS); |
| CPU_SET_SEGREG(CPU_SS_INDEX, sreg); | LOAD_SEGREG(CPU_DS_INDEX, CPU_DS); |
| sreg = CPU_DS; | |
| CPU_SET_SEGREG(CPU_DS_INDEX, sreg); | |
| } | } |
| } | } |
| } | } |