| version 1.9, 2004/01/27 15:56:20 | version 1.24, 2005/03/12 12:32:54 | 
| Line 12 | Line 12 | 
 | * 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 28 | 
 | #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" | 
 | #if defined(IA32_REBOOT_ON_PANIC) | #if defined(IA32_REBOOT_ON_PANIC) | 
 | #include "pccore.h" | #include "pccore.h" | 
 | #endif | #endif | 
 |  |  | 
 |  |  | 
| 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_EM | CPU_CR0_NE; | CPU_CR0 |= CPU_CR0_EM | CPU_CR0_NE; | 
 | CPU_CR0 &= ~CPU_CR0_MP; | CPU_CR0 &= ~CPU_CR0_MP; | 
 |  | #else | 
 |  | CPU_CR0 |= CPU_CR0_ET; | 
 | #endif | #endif | 
 | CPU_MXCSR = 0x1f80; | CPU_MXCSR = 0x1f80; | 
 | CPU_GDTR_LIMIT = 0xffff; | CPU_GDTR_LIMIT = 0xffff; | 
| Line 57  static void ia32_initreg(void) { | Line 63  static void ia32_initreg(void) { | 
 |  |  | 
 | #if CPU_FAMILY == 4 | #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) | #elif CPU_FAMILY >= 5 | 
 | CPU_STATSAVE.cpu_regs.dr[6] = 0xffff0ff0; | CPU_STATSAVE.cpu_regs.dr[6] = 0xffff0ff0; | 
 | CPU_STATSAVE.cpu_regs.dr[7] = 0x00000400; | CPU_STATSAVE.cpu_regs.dr[7] = 0x00000400; | 
 | #endif | #endif | 
| Line 71  static void ia32_initreg(void) { | Line 77  static void ia32_initreg(void) { | 
 | CPU_SET_SEGREG(CPU_CS_INDEX, 0xf000); | 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; | #if (CPU_FAMILY == 3) | 
|  | CPU_ADRSMASK = (enable)?0x00ffffff:0x00ffffff; | 
| rv = sigsetjmp(exec_1step_jmpbuf, 1); | #else | 
| switch (rv) { | CPU_ADRSMASK = (enable)?0xffffffff:0x00ffffff; | 
| case 0: | #endif | 
| break; |  | 
|  |  | 
| case 1: |  | 
| VERBOSE(("ia32: return from exception")); |  | 
| break; |  | 
|  |  | 
| case 2: |  | 
| VERBOSE(("ia32: return from panic")); |  | 
| return; |  | 
|  |  | 
| 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 126  ia32withtrap(void) | Line 121  ia32withtrap(void) | 
 | break; | break; | 
 |  |  | 
 | case 1: | case 1: | 
| VERBOSE(("ia32withtrap: return from exception")); | VERBOSE(("ia32: return from exception")); | 
 | break; | break; | 
 |  |  | 
 | case 2: | case 2: | 
| VERBOSE(("ia32withtrap: return from panic")); | VERBOSE(("ia32: return from panic")); | 
 | return; | 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, TRUE, FALSE, 0); | 
| 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 { | 
| case 2: | do { | 
| VERBOSE(("ia32withdma: return from panic")); | exec_1step(); | 
| return; | } while (CPU_REMCLOCK > 0); | 
|  |  | 
| default: |  | 
| VERBOSE(("ia32withdma: return from unknown cause")); |  | 
| break; |  | 
 | } | } | 
|  | #endif | 
| do { |  | 
| exec_1step(); |  | 
| dmap_i286(); |  | 
| } while (CPU_REMCLOCK > 0); |  | 
 | } | } | 
 |  |  | 
 | void | void | 
| Line 200  ia32_step(void) | Line 188  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, TRUE, FALSE, 0); | 
|  | } | 
|  | #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, 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); | 
|  | } | 
 | } | } | 
 |  |  | 
 |  |  | 
| Line 235  ia32_panic(const char *str, ...) | Line 237  ia32_panic(const char *str, ...) | 
 |  |  | 
 | #if defined(IA32_REBOOT_ON_PANIC) | #if defined(IA32_REBOOT_ON_PANIC) | 
 | VERBOSE(("ia32_panic: reboot")); | VERBOSE(("ia32_panic: reboot")); | 
 | pccore_cfgupdate(); |  | 
 | pccore_reset(); | pccore_reset(); | 
 | siglongjmp(exec_1step_jmpbuf, 2); | siglongjmp(exec_1step_jmpbuf, 2); | 
 | #else | #else | 
| Line 277  ia32_printf(const char *str, ...) | Line 278  ia32_printf(const char *str, ...) | 
 | void | void | 
 | ia32_bioscall(void) | ia32_bioscall(void) | 
 | { | { | 
| DWORD adrs; | UINT32 adrs; | 
 |  |  | 
 | if (!CPU_STAT_PM || CPU_STAT_VM86) { | if (!CPU_STAT_PM || CPU_STAT_VM86) { | 
| adrs = (CPU_EIP - 1) + CPU_STAT_SREGBASE(CPU_CS_INDEX); | #if 1 | 
|  | adrs = (CPU_EIP - 1) + ((CPU_REGS_SREG(CPU_CS_INDEX)) << 4); | 
|  | #else | 
|  | adrs = (CPU_EIP - 1) + CPU_STAT_CS_BASE; | 
|  | #endif | 
 | if ((adrs >= 0xf8000) && (adrs < 0x100000)) { | if ((adrs >= 0xf8000) && (adrs < 0x100000)) { | 
| biosfunc(adrs); | if (biosfunc(adrs)) { | 
|  | CPU_PREFETCH_CLEAR(); | 
|  | } | 
 | if (!CPU_STAT_PM || CPU_STAT_VM86) { | if (!CPU_STAT_PM || CPU_STAT_VM86) { | 
 | CPU_SET_SEGREG(CPU_ES_INDEX, CPU_ES); | CPU_SET_SEGREG(CPU_ES_INDEX, CPU_ES); | 
 | CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS); | CPU_SET_SEGREG(CPU_CS_INDEX, CPU_CS); |