--- hatari/src/uae-cpu/newcpu.c 2019/04/01 07:10:42 1.1.1.6 +++ hatari/src/uae-cpu/newcpu.c 2019/04/01 07:11:55 1.1.1.9 @@ -10,26 +10,26 @@ * This file is distributed under the GNU Public License, version 2 or at * your option any later version. Read the file gpl.txt for details. */ -static char rcsid[] = "Hatari $Id: newcpu.c,v 1.1.1.6 2019/04/01 07:10:42 root Exp $"; +char NewCpu_rcsid[] = "Hatari $Id: newcpu.c,v 1.1.1.9 2019/04/01 07:11:55 root Exp $"; #include "sysdeps.h" #include "hatari-glue.h" #include "maccess.h" #include "memory.h" #include "newcpu.h" -#include "compiler.h" -#include "events.h" #include "../includes/main.h" +#include "../includes/m68000.h" +#include "../includes/mfp.h" #include "../includes/tos.h" #include "../includes/vdi.h" #include "../includes/cart.h" #include "../includes/debugui.h" +#include "../includes/bios.h" +#include "../includes/xbios.h" struct flag_struct regflags; -int lastInstructionCycles; /* how many cycles last instruction took to execute */ - /* Opcode of faulting instruction */ uae_u16 last_op_for_exception_3; /* PC at fault time */ @@ -50,8 +50,6 @@ int fpp_movem_next[256]; cpuop_func *cpufunctbl[65536]; -static uae_u32 busAddressErrPC = 0; /* Needed to store the right PC when bus-/address error occurs */ - #define COUNT_INSTRS 0 @@ -105,7 +103,6 @@ void dump_counts (void) } #endif -int broken_in; static unsigned long op_illg_1 (uae_u32 opcode) REGPARAM; @@ -156,9 +153,7 @@ void build_cpufunctbl(void) /* Hatari's illegal opcodes: */ cpufunctbl[GEMDOS_OPCODE] = OpCode_GemDos; - cpufunctbl[RUNOLDGEMDOS_OPCODE] = OpCode_OldGemDos; - cpufunctbl[CONDRV_OPCODE] = OpCode_ConnectedDrive; - cpufunctbl[TIMERD_OPCODE] = OpCode_TimerD; + cpufunctbl[SYSINIT_OPCODE] = OpCode_SysInit; cpufunctbl[VDI_OPCODE] = OpCode_VDI; } @@ -226,7 +221,7 @@ void init_m68k (void) if (cpu_compatible) write_log (" (compatible mode)"); write_log ("\n"); - + read_table68k (); do_merges (); @@ -237,8 +232,10 @@ void init_m68k (void) struct regstruct regs, lastint_regs; +/* not used ATM: static struct regstruct regs_backup[16]; static int backup_pointer = 0; +*/ static long int m68kpc_offset; int lastint_no; @@ -418,9 +415,11 @@ uae_s32 ShowEA (FILE *f, int reg, amodes return offset; } + /* The plan is that this will take over the job of exception 3 handling - * the CPU emulation functions will just do a longjmp to m68k_go whenever * they hit an odd address. */ +#if 0 static int verify_ea (int reg, amodes mode, wordsizes size, uae_u32 *val) { uae_u16 dp; @@ -541,6 +540,8 @@ static int verify_ea (int reg, amodes mo last_fault_for_exception_3 = addr; return 0; } +#endif + uae_u32 get_disp_ea_020 (uae_u32 base, uae_u32 dp) { @@ -594,6 +595,8 @@ uae_u32 get_disp_ea_000 (uae_u32 base, u #endif } + +/* Create the Status Register from the flags */ void MakeSR (void) { #if 0 @@ -613,6 +616,8 @@ void MakeSR (void) | GET_CFLG); } + +/* Set up the flags from Status Register */ void MakeFromSR (void) { int oldm = regs.m; @@ -661,7 +666,8 @@ void MakeFromSR (void) } } - set_special (SPCFLAG_INT); + /* Pending interrupts can occur again after a write to the SR: */ + set_special (SPCFLAG_DOINT); if (regs.t1 || regs.t0) set_special (SPCFLAG_TRACE); else @@ -677,8 +683,8 @@ void Exception(int nr, uaecptr oldpc) /*if( nr>=2 && nr<10 ) fprintf(stderr,"Exception (-> %i bombs)!\n",nr);*/ - /* Intercept exceptions... - FIXME: Find a better way to do this! */ - if(bUseVDIRes && nr == 0x22) /* Trap 2 - intercept VDI call */ + /* Intercept VDI exception (Trap #2 with D0 = 0x73) */ + if(bUseVDIRes && nr == 0x22 && regs.regs[0] == 0x73) { if(!VDI()) { @@ -690,9 +696,23 @@ void Exception(int nr, uaecptr oldpc) } } - compiler_flush_jsr_stack(); +#if 0 + /* Intercept BIOS or XBIOS trap (Trap #13 or #14) */ + if (nr == 0x2d) + { + /* Intercept BIOS calls */ + if (Bios()) return; + } + else if (nr == 0x2e) + { + /* Intercept XBIOS calls */ + if (XBios()) return; + } +#endif + MakeSR(); + /* Change to supervisor mode if necessary */ if (!regs.s) { regs.usp = m68k_areg(regs, 7); if (cpu_level >= 2) @@ -701,6 +721,8 @@ void Exception(int nr, uaecptr oldpc) m68k_areg(regs, 7) = regs.isp; regs.s = 1; } + + /* Build additional exception stack frame for 68010 and higher */ if (cpu_level > 0) { if (nr == 2 || nr == 3) { int i; @@ -743,39 +765,86 @@ void Exception(int nr, uaecptr oldpc) /* 68000 bus/address errors: */ if (cpu_level==0 && (nr==2 || nr==3)) { + uae_u16 specialstatus = 0x2001; + /* Special status word emulation isn't perfect yet... :-( */ + if (regs.sr & 0x2000) + specialstatus |= 0x4; m68k_areg(regs, 7) -= 8; if (nr == 3) { /* Address error */ - put_word (m68k_areg(regs, 7), regs.sr); /*?*/ + put_word (m68k_areg(regs, 7), specialstatus); put_long (m68k_areg(regs, 7)+2, last_fault_for_exception_3); put_word (m68k_areg(regs, 7)+6, last_op_for_exception_3); put_long (m68k_areg(regs, 7)+10, last_addr_for_exception_3); - if( bEnableDebug ) { - fprintf(stderr,"Address Error at address $%x, PC=$%x\n",last_fault_for_exception_3,currpc); - DebugUI(); - } + if (bEnableDebug) { + fprintf(stderr,"Address Error at address $%x, PC=$%x\n",last_fault_for_exception_3,currpc); + DebugUI(); + } } - else { /* Bus error */ - put_word (m68k_areg(regs, 7), regs.sr); /*?*/ + else { /* Bus error */ + if (bBusErrorReadWrite) + specialstatus |= 0x10; + put_word (m68k_areg(regs, 7), specialstatus); put_long (m68k_areg(regs, 7)+2, BusAddressLocation); - put_word (m68k_areg(regs, 7)+6, get_word(currpc)); - if( bEnableDebug && BusAddressLocation!=0xff8a00) { - fprintf(stderr,"Bus Error at address $%lx, PC=$%lx\n",BusAddressLocation,(long)currpc); - DebugUI(); - } - } + put_word (m68k_areg(regs, 7)+6, get_word(BusErrorPC)); /* Opcode */ + /* Check for double bus errors: */ + if (regs.spcflags & SPCFLAG_BUSERROR) { + fprintf(stderr, "Detected double bus error at address $%x, PC=$%lx => CPU halted!\n", + BusAddressLocation, (long)currpc); + unset_special(SPCFLAG_BUSERROR); + if (bEnableDebug) + DebugUI(); + regs.intmask = 7; + m68k_setstopped(TRUE); + return; + } + if (bEnableDebug && BusAddressLocation!=0xff8a00) { + fprintf(stderr,"Bus Error at address $%x, PC=$%lx\n",BusAddressLocation,(long)currpc); + DebugUI(); + } + } } + /* Set PC and flags */ + if (bEnableDebug && get_long (regs.vbr + 4*nr) == 0) { + write_log("Uninitialized exception handler #%i!\n", nr); + } m68k_setpc (get_long (regs.vbr + 4*nr)); fill_prefetch_0 (); regs.t1 = regs.t0 = regs.m = 0; unset_special (SPCFLAG_TRACE | SPCFLAG_DOTRACE); - /* Store a backup of the PC after bus-/address error: */ - if(nr==2 || nr==3) { - busAddressErrPC = regs.pc; + /* Handle exception cycles: */ + if(nr >= 24 && nr <= 31) + { + M68000_AddCycles(44+4); /* Interrupt */ + } + else if(nr >= 32 && nr <= 47) + { + M68000_AddCycles(34); /* Trap */ + } + else switch(nr) + { + case 2: M68000_AddCycles(50); break; /* Bus error */ + case 3: M68000_AddCycles(50); break; /* Address error */ + case 4: M68000_AddCycles(34); break; /* Illegal instruction */ + case 5: M68000_AddCycles(38); break; /* Div by zero */ + case 6: M68000_AddCycles(40); break; /* CHK */ + case 7: M68000_AddCycles(34); break; /* TRAPV */ + case 8: M68000_AddCycles(34); break; /* Privilege violation */ + case 9: M68000_AddCycles(34); break; /* Trace */ + case 10: M68000_AddCycles(34); break; /* Line-A - probably wrong */ + case 11: M68000_AddCycles(34); break; /* Line-F - probably wrong */ + default: + /* FIXME: Add right cycles value for MFP interrupts and copro exceptions ... */ + if(nr < 64) + M68000_AddCycles(4); /* Coprocessor and unassigned exceptions (???) */ + else + M68000_AddCycles(24); /* Must be a MFP interrupt */ + break; } } + static void Interrupt(int nr) { assert(nr < 8 && nr >= 0); @@ -787,7 +856,10 @@ static void Interrupt(int nr) set_special (SPCFLAG_INT); } -static uae_u32 caar, cacr, itt0, itt1, dtt0, dtt1, tc, mmusr, urp, srp; + +uae_u32 reg_caar, reg_cacr; +static uae_u32 itt0, itt1, dtt0, dtt1, tc, mmusr, urp, srp; + int m68k_move2c (int regno, uae_u32 *regp) { @@ -801,17 +873,17 @@ int m68k_move2c (int regno, uae_u32 *reg switch (regno) { case 0: regs.sfc = *regp & 7; break; case 1: regs.dfc = *regp & 7; break; - case 2: cacr = *regp & (cpu_level < 4 ? 0x3 : 0x80008000); break; + case 2: reg_cacr = *regp & (cpu_level < 4 ? 0x3 : 0x80008000); break; case 3: tc = *regp & 0xc000; break; /* Mask out fields that should be zero. */ case 4: itt0 = *regp & 0xffffe364; break; case 5: itt1 = *regp & 0xffffe364; break; case 6: dtt0 = *regp & 0xffffe364; break; case 7: dtt1 = *regp & 0xffffe364; break; - + case 0x800: regs.usp = *regp; break; case 0x801: regs.vbr = *regp; break; - case 0x802: caar = *regp & 0xfc; break; + case 0x802: reg_caar = *regp & 0xfc; break; case 0x803: regs.msp = *regp; if (regs.m == 1) m68k_areg(regs, 7) = regs.msp; break; case 0x804: regs.isp = *regp; if (regs.m == 0) m68k_areg(regs, 7) = regs.isp; break; case 0x805: mmusr = *regp; break; @@ -837,7 +909,7 @@ int m68k_movec2 (int regno, uae_u32 *reg switch (regno) { case 0: *regp = regs.sfc; break; case 1: *regp = regs.dfc; break; - case 2: *regp = cacr; break; + case 2: *regp = reg_cacr; break; case 3: *regp = tc; break; case 4: *regp = itt0; break; case 5: *regp = itt1; break; @@ -845,7 +917,7 @@ int m68k_movec2 (int regno, uae_u32 *reg case 7: *regp = dtt1; break; case 0x800: *regp = regs.usp; break; case 0x801: *regp = regs.vbr; break; - case 0x802: *regp = caar; break; + case 0x802: *regp = reg_caar; break; case 0x803: *regp = regs.m == 1 ? m68k_areg(regs, 7) : regs.msp; break; case 0x804: *regp = regs.m == 0 ? m68k_areg(regs, 7) : regs.isp; break; case 0x805: *regp = mmusr; break; @@ -1111,15 +1183,9 @@ void m68k_mull (uae_u32 opcode, uae_u32 #endif } -static char* ccnames[] = -{ "T ","F ","HI","LS","CC","CS","NE","EQ", - "VC","VS","PL","MI","GE","LT","GT","LE" }; void m68k_reset (void) { - m68k_areg(regs, 7) = get_long(0); - m68k_setpc(get_long(4)); - refill_prefetch (m68k_getpc (), 0); regs.s = 1; regs.m = 0; regs.stopped = 0; @@ -1130,24 +1196,22 @@ void m68k_reset (void) SET_CFLG (0); SET_VFLG (0); SET_NFLG (0); - regs.spcflags = 0; + regs.spcflags &= SPCFLAG_MODE_CHANGE; /* Clear specialflags except mode-change */ regs.intmask = 7; regs.vbr = regs.sfc = regs.dfc = 0; regs.fpcr = regs.fpsr = regs.fpiar = 0; + + m68k_areg(regs, 7) = get_long(0); + m68k_setpc(get_long(4)); + refill_prefetch (m68k_getpc(), 0); } + unsigned long REGPARAM2 op_illg (uae_u32 opcode) { +#if 0 uaecptr pc = m68k_getpc (); - - compiler_flush_jsr_stack (); - if (opcode == 0x4E7B && get_long (0x10) == 0 ) { - write_log ("This program requires a 68020 CPU!\n"); - broken_in = 1; - set_special (SPCFLAG_BRK); - bQuitProgram = 1; - } - +#endif if ((opcode & 0xF000) == 0xF000) { Exception(0xB,0); return 4; @@ -1156,7 +1220,6 @@ unsigned long REGPARAM2 op_illg (uae_u32 Exception(0xA,0); return 4; } - #if 0 write_log ("Illegal instruction: %04x at %08lx\n", opcode, (long)pc); #endif @@ -1164,6 +1227,7 @@ unsigned long REGPARAM2 op_illg (uae_u32 return 4; } + void mmu_op(uae_u32 opcode, uae_u16 extra) { if ((opcode & 0xFE0) == 0x0500) { @@ -1216,19 +1280,42 @@ static void do_trace (void) } +/* + * Handle special flags + */ static int do_specialties (void) { - run_compiled_code(); + if(regs.spcflags & SPCFLAG_BUSERROR) { + /* We can not execute bus errors directly in the memory handler + * functions since the PC should point to the address of the next + * instruction, so we're executing the bus errors here: */ + unset_special(SPCFLAG_BUSERROR); + Exception(2,0); + } + + if(regs.spcflags & SPCFLAG_EXTRA_CYCLES) { + /* Add some extra cycles to simulate a wait state */ + unset_special(SPCFLAG_EXTRA_CYCLES); + M68000_AddCycles(4); + } + if (regs.spcflags & SPCFLAG_DOTRACE) { Exception (9,last_trace_ad); } + while (regs.spcflags & SPCFLAG_STOP) { - do_cycles (8); - if (regs.intmask>5) { - /* We still have to care about events when IPL==7 ! */ - Main_EventHandler(); - if(bQuitProgram) unset_special(SPCFLAG_STOP); - } + if (regs.intmask > 5) { + /* We still have to care about events when IPL==7 ! */ + Main_EventHandler(); + if (regs.spcflags & SPCFLAG_BRK) return 1; + } + M68000_AddCycles(4); + if (PendingInterruptCount<=0 && PendingInterruptFunction) { + CALL_VAR(PendingInterruptFunction); + } + if (regs.spcflags & SPCFLAG_MFP) { + MFP_CheckPendingInterrupts(); + } if (regs.spcflags & (SPCFLAG_INT | SPCFLAG_DOINT)) { int intr = intlev (); unset_special (SPCFLAG_INT | SPCFLAG_DOINT); @@ -1239,11 +1326,13 @@ static int do_specialties (void) } } } + if (regs.spcflags & SPCFLAG_TRACE) do_trace (); if (regs.spcflags & SPCFLAG_DOINT) { int intr = intlev (); + /* SPCFLAG_DOINT will be enabled again in MakeFromSR to handle pending interrupts! */ unset_special (SPCFLAG_DOINT); if (intr != -1 && intr > regs.intmask) { Interrupt (intr); @@ -1254,10 +1343,16 @@ static int do_specialties (void) unset_special (SPCFLAG_INT); set_special (SPCFLAG_DOINT); } + + if (regs.spcflags & SPCFLAG_MFP) { /* Check for MFP interrupts */ + MFP_CheckPendingInterrupts(); + } + if (regs.spcflags & (SPCFLAG_BRK | SPCFLAG_MODE_CHANGE)) { - unset_special (SPCFLAG_BRK | SPCFLAG_MODE_CHANGE); + unset_special(SPCFLAG_MODE_CHANGE); return 1; } + return 0; } @@ -1270,9 +1365,11 @@ static void m68k_run_1 (void) uae_u8 saved_bytes[20]; uae_u16 *oldpcp; #endif - while(!bQuitProgram) { + + for (;;) { int cycles; uae_u32 opcode = get_iword_prefetch (0); + #ifdef DEBUG_PREFETCH if (get_ilong (0) != do_get_mem_long (®s.prefetch)) { fprintf (stderr, "Prefetch differs from memory.\n"); @@ -1297,15 +1394,6 @@ static void m68k_run_1 (void) cycles = (*cpufunctbl[opcode])(opcode); - /* Unfortunately needed at the moment: */ - /* Check if we had an bus/address error and correct the PC then... */ - if(busAddressErrPC) { - /*write_log("Fixed PC to $%x instead of $%x after bus-/address error!\n", - busAddressErrPC, m68k_getpc());*/ - m68k_setpc(busAddressErrPC); - busAddressErrPC = 0; - } - #ifdef DEBUG_PREFETCH if (memcmp (saved_bytes, oldpcp, 20) != 0) { fprintf (stderr, "Self-modifying code detected.\n"); @@ -1314,7 +1402,10 @@ static void m68k_run_1 (void) } #endif - do_cycles (cycles); + M68000_AddCycles(cycles); + if (PendingInterruptCount<=0 && PendingInterruptFunction) + CALL_VAR(PendingInterruptFunction); + if (regs.spcflags) { if (do_specialties ()) return; @@ -1326,7 +1417,7 @@ static void m68k_run_1 (void) /* Same thing, but don't use prefetch to get opcode. */ static void m68k_run_2 (void) { - while(!bQuitProgram) { + for (;;) { int cycles; uae_u32 opcode = get_iword (0); @@ -1344,16 +1435,10 @@ static void m68k_run_2 (void) cycles = (*cpufunctbl[opcode])(opcode); - /* Unfortunately needed at the moment: */ - /* Check if we had an bus/address error and correct the PC then... */ - if(busAddressErrPC) { - /*write_log("Fixed PC to $%x instead of $%x after bus-/address error!\n", - busAddressErrPC, m68k_getpc());*/ - m68k_setpc(busAddressErrPC); - busAddressErrPC = 0; - } + M68000_AddCycles(cycles); + if (PendingInterruptCount<=0 && PendingInterruptFunction) + CALL_VAR(PendingInterruptFunction); - do_cycles (cycles); if (regs.spcflags) { if (do_specialties ()) return; @@ -1362,25 +1447,28 @@ static void m68k_run_2 (void) } -int in_m68k_go = 0; - void m68k_go (int may_quit) { + static int in_m68k_go = 0; + if (in_m68k_go || !may_quit) { write_log ("Bug! m68k_go is not reentrant.\n"); abort (); } in_m68k_go++; - while(!bQuitProgram) { + while (!(regs.spcflags & SPCFLAG_BRK)) { if(cpu_compatible) m68k_run_1(); else m68k_run_2(); } + unset_special(SPCFLAG_BRK); in_m68k_go--; } + +/* static void m68k_verify (uaecptr addr, uaecptr *nextpc) { uae_u32 opcode, val; @@ -1408,9 +1496,15 @@ static void m68k_verify (uaecptr addr, u } } } +*/ + void m68k_disasm (FILE *f, uaecptr addr, uaecptr *nextpc, int cnt) { + static const char* ccnames[] = + { "T ","F ","HI","LS","CC","CS","NE","EQ", + "VC","VS","PL","MI","GE","LT","GT","LE" }; + uaecptr newpc = 0; m68kpc_offset = addr - m68k_getpc (); while (cnt-- > 0) {