X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2FSek.c;h=73b7b7cb6b92fa55aff04e6c0e83005ad0a876e2;hb=5f9a0d16309e732ad09b4f5827422cf658bed8c2;hp=f3af53192ceca819b48a7801b5fa82f5e6b84eab;hpb=70357ce52578dee0dd3b3663902cf872c3d34258;p=picodrive.git

diff --git a/Pico/Sek.c b/Pico/Sek.c
index f3af531..73b7b7c 100644
--- a/Pico/Sek.c
+++ b/Pico/Sek.c
@@ -18,15 +18,15 @@ unsigned int SekCycleCntT=0;
 /* context */
 // Cyclone 68000
 #ifdef EMU_C68K
-struct Cyclone PicoCpu;
+struct Cyclone PicoCpuCM68k;
 #endif
 // MUSASHI 68000
 #ifdef EMU_M68K
-m68ki_cpu_core PicoM68kCPU;
+m68ki_cpu_core PicoCpuMM68k;
 #endif
 // FAME 68000
 #ifdef EMU_F68K
-M68K_CONTEXT PicoCpuM68k;
+M68K_CONTEXT PicoCpuFM68k;
 #endif
 
 
@@ -38,7 +38,7 @@ static int SekIntAck(int level)
   // try to emulate VDP's reaction to 68000 int ack
   if     (level == 4) { Pico.video.pending_ints  =  0;    elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }
   else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }
-  PicoCpu.irq = 0;
+  PicoCpuCM68k.irq = 0;
   return CYCLONE_INT_ACK_AUTOVECTOR;
 }
 
@@ -51,12 +51,12 @@ static int SekUnrecognizedOpcode()
 {
   unsigned int pc, op;
   pc = SekPc;
-  op = PicoCpu.read16(pc);
+  op = PicoCpuCM68k.read16(pc);
   elprintf(EL_ANOMALY, "Unrecognized Opcode %04x @ %06x", op, pc);
   // see if we are not executing trash
   if (pc < 0x200 || (pc > Pico.romsize+4 && (pc&0xe00000)!=0xe00000)) {
-    PicoCpu.cycles = 0;
-    PicoCpu.state_flags |= 1;
+    PicoCpuCM68k.cycles = 0;
+    PicoCpuCM68k.state_flags |= 1;
     return 1;
   }
 #ifdef EMU_M68K // debugging cyclone
@@ -87,153 +87,251 @@ static int SekTasCallback(void)
 
 
 #ifdef EMU_F68K
-static void setup_fame_fetchmap(void)
-{
-  int i;
-
-  // be default, point everything to fitst 64k of ROM
-  for (i = 0; i < M68K_FETCHBANK1; i++)
-    PicoCpuM68k.Fetch[i] = (unsigned int)Pico.rom - (i<<(24-FAMEC_FETCHBITS));
-  // now real ROM
-  for (i = 0; i < M68K_FETCHBANK1 && (i<<(24-FAMEC_FETCHBITS)) < Pico.romsize; i++)
-    PicoCpuM68k.Fetch[i] = (unsigned int)Pico.rom;
-  elprintf(EL_ANOMALY, "ROM end @ #%i %06x", i, (i<<(24-FAMEC_FETCHBITS)));
-  // .. and RAM (TODO)
-  for (i = M68K_FETCHBANK1*14/16; i < M68K_FETCHBANK1; i++)
-    PicoCpuM68k.Fetch[i] = (unsigned int)Pico.ram - (i<<(24-FAMEC_FETCHBITS));
-
-  elprintf(EL_ANOMALY, "rom = %p, ram = %p", Pico.rom, Pico.ram);
-  for (i = 0; i < M68K_FETCHBANK1; i++)
-    elprintf(EL_ANOMALY, "Fetch[%i] = %p", i, PicoCpuM68k.Fetch[i]);
-}
-
-void SekIntAckF68K(unsigned level)
+static void SekIntAckF68K(unsigned level)
 {
   if     (level == 4) { Pico.video.pending_ints  =  0;    elprintf(EL_INTS, "hack: @ %06x [%i]", SekPc, SekCycleCnt); }
   else if(level == 6) { Pico.video.pending_ints &= ~0x20; elprintf(EL_INTS, "vack: @ %06x [%i]", SekPc, SekCycleCnt); }
-  PicoCpuM68k.interrupts[0] = 0;
+  PicoCpuFM68k.interrupts[0] = 0;
 }
 #endif
 
 
-PICO_INTERNAL int SekInit()
+PICO_INTERNAL void SekInit(void)
 {
 #ifdef EMU_C68K
   CycloneInit();
-  memset(&PicoCpu,0,sizeof(PicoCpu));
-  PicoCpu.IrqCallback=SekIntAck;
-  PicoCpu.ResetCallback=SekResetAck;
-  PicoCpu.UnrecognizedCallback=SekUnrecognizedOpcode;
+  memset(&PicoCpuCM68k,0,sizeof(PicoCpuCM68k));
+  PicoCpuCM68k.IrqCallback=SekIntAck;
+  PicoCpuCM68k.ResetCallback=SekResetAck;
+  PicoCpuCM68k.UnrecognizedCallback=SekUnrecognizedOpcode;
+  PicoCpuCM68k.flags=4;   // Z set
 #endif
 #ifdef EMU_M68K
   {
     void *oldcontext = m68ki_cpu_p;
-    m68k_set_context(&PicoM68kCPU);
+    m68k_set_context(&PicoCpuMM68k);
     m68k_set_cpu_type(M68K_CPU_TYPE_68000);
     m68k_init();
     m68k_set_int_ack_callback(SekIntAckM68K);
     m68k_set_tas_instr_callback(SekTasCallback);
-    m68k_pulse_reset(); // Init cpu emulator
+    //m68k_pulse_reset();
     m68k_set_context(oldcontext);
   }
 #endif
 #ifdef EMU_F68K
   {
     void *oldcontext = g_m68kcontext;
-    g_m68kcontext = &PicoCpuM68k;
-    memset(&PicoCpuM68k, 0, sizeof(PicoCpuM68k));
-    m68k_init();
-    PicoCpuM68k.iack_handler = SekIntAckF68K;
+    g_m68kcontext = &PicoCpuFM68k;
+    memset(&PicoCpuFM68k, 0, sizeof(PicoCpuFM68k));
+    fm68k_init();
+    PicoCpuFM68k.iack_handler = SekIntAckF68K;
+    PicoCpuFM68k.sr = 0x2704; // Z flag
     g_m68kcontext = oldcontext;
   }
 #endif
-
-  return 0;
 }
 
 
 // Reset the 68000:
-PICO_INTERNAL int SekReset()
+PICO_INTERNAL int SekReset(void)
 {
   if (Pico.rom==NULL) return 1;
 
 #ifdef EMU_C68K
-  PicoCpu.state_flags=0;
-  PicoCpu.osp=0;
-  PicoCpu.srh =0x27; // Supervisor mode
-  PicoCpu.flags=4;   // Z set
-  PicoCpu.irq=0;
-  PicoCpu.a[7]=PicoCpu.read32(0); // Stack Pointer
-  PicoCpu.membase=0;
-  PicoCpu.pc=PicoCpu.checkpc(PicoCpu.read32(4)); // Program Counter
+  PicoCpuCM68k.state_flags=0;
+  PicoCpuCM68k.osp=0;
+  PicoCpuCM68k.srh =0x27; // Supervisor mode
+  PicoCpuCM68k.irq=0;
+  PicoCpuCM68k.a[7]=PicoCpuCM68k.read32(0); // Stack Pointer
+  PicoCpuCM68k.membase=0;
+  PicoCpuCM68k.pc=PicoCpuCM68k.checkpc(PicoCpuCM68k.read32(4)); // Program Counter
 #endif
 #ifdef EMU_M68K
-  m68k_set_context(&PicoM68kCPU); // if we ever reset m68k, we always need it's context to be set
+  m68k_set_context(&PicoCpuMM68k); // if we ever reset m68k, we always need it's context to be set
   m68ki_cpu.sp[0]=0;
   m68k_set_irq(0);
   m68k_pulse_reset();
+  REG_USP = 0; // ?
 #endif
 #ifdef EMU_F68K
   {
-    unsigned ret;
-    g_m68kcontext = &PicoCpuM68k;
-    setup_fame_fetchmap();
-    ret = m68k_reset();
-    /*if (ret)*/ elprintf(EL_ANOMALY, "m68k_reset returned %u", ret);
+    g_m68kcontext = &PicoCpuFM68k;
+    fm68k_reset();
   }
 #endif
 
   return 0;
 }
 
+void SekStepM68k(void)
+{
+  SekCycleAim=SekCycleCnt+1;
+#if defined(EMU_CORE_DEBUG)
+  SekCycleCnt+=CM_compareRun(1, 0);
+#elif defined(EMU_C68K)
+  PicoCpuCM68k.cycles=1;
+  CycloneRun(&PicoCpuCM68k);
+  SekCycleCnt+=1-PicoCpuCM68k.cycles;
+#elif defined(EMU_M68K)
+  SekCycleCnt+=m68k_execute(1);
+#elif defined(EMU_F68K)
+  SekCycleCnt+=fm68k_emulate(1, 0);
+#endif
+}
 
-PICO_INTERNAL int SekInterrupt(int irq)
+PICO_INTERNAL void SekSetRealTAS(int use_real)
 {
-#if defined(EMU_C68K) && defined(EMU_M68K)
-  {
-    extern unsigned int dbg_irq_level;
-    dbg_irq_level=irq;
-    return 0;
-  }
+#ifdef EMU_C68K
+  CycloneSetRealTAS(use_real);
+#endif
+#ifdef EMU_F68K
+  // TODO
 #endif
+}
+
+
+/* idle loop detection, not to be used in CD mode */
 #ifdef EMU_C68K
-  PicoCpu.irq=irq;
+#include "cpu/Cyclone/tools/idle.h"
 #endif
-#ifdef EMU_M68K
-  {
-    void *oldcontext = m68ki_cpu_p;
-    m68k_set_context(&PicoM68kCPU);
-    m68k_set_irq(irq); // raise irq (gets lowered after taken or must be done in ack)
-    m68k_set_context(oldcontext);
+
+static int *idledet_addrs = NULL;
+static int idledet_count = 0, idledet_bads = 0;
+int idledet_start_frame = 0;
+
+void SekInitIdleDet(void)
+{
+  void *tmp = realloc(idledet_addrs, 0x200*4);
+  if (tmp == NULL) {
+    free(idledet_addrs);
+    idledet_addrs = NULL;
   }
+  else
+    idledet_addrs = tmp;
+  idledet_count = idledet_bads = 0;
+  idledet_start_frame = Pico.m.frame_count + 360;
+
+#ifdef EMU_C68K
+  CycloneInitIdle();
 #endif
 #ifdef EMU_F68K
-  PicoCpuM68k.interrupts[0]=irq;
+  fm68k_emulate(0, 0, 1);
 #endif
+}
+
+int SekIsIdleCode(unsigned short *dst, int bytes)
+{
+  // printf("SekIsIdleCode %04x %i\n", *dst, bytes);
+  switch (bytes)
+  {
+    case 4:
+      if (  (*dst & 0xfff8) == 0x4a10 || // tst.b ($aX)      // there should be no need to wait
+            (*dst & 0xfff8) == 0x4a28 || // tst.b ($xxxx,a0) // for byte change anywhere
+            (*dst & 0xff3f) == 0x4a38 || // tst.x ($xxxx.w); tas ($xxxx.w)
+            (*dst & 0xc1ff) == 0x0038 || // move.x ($xxxx.w), dX
+            (*dst & 0xf13f) == 0xb038)   // cmp.x ($xxxx.w), dX
+        return 1;
+      break;
+    case 6:
+      if ( ((dst[1] & 0xe0) == 0xe0 && ( // RAM and
+            *dst == 0x4a39 ||            //   tst.b ($xxxxxxxx)
+            *dst == 0x4a79 ||            //   tst.w ($xxxxxxxx)
+            *dst == 0x4ab9 ||            //   tst.l ($xxxxxxxx)
+            (*dst & 0xc1ff) == 0x0039 || //   move.x ($xxxxxxxx), dX
+            (*dst & 0xf13f) == 0xb039))||//   cmp.x ($xxxxxxxx), dX
+            *dst == 0x0838 ||            // btst $X, ($xxxx.w) [6 byte op]
+            (*dst & 0xffbf) == 0x0c38)   // cmpi.{b,w} $X, ($xxxx.w)
+        return 1;
+      break;
+    case 8:
+      if ( ((dst[2] & 0xe0) == 0xe0 && ( // RAM and
+            *dst == 0x0839 ||            //   btst $X, ($xxxxxxxx.w) [8 byte op]
+            (*dst & 0xffbf) == 0x0c39))||//   cmpi.{b,w} $X, ($xxxxxxxx)
+            *dst == 0x0cb8)              // cmpi.l $X, ($xxxx.w)
+        return 1;
+      break;
+    case 12:
+       if ((*dst & 0xf1f8) == 0x3010 && // move.w (aX), dX
+            (dst[1]&0xf100) == 0x0000 && // arithmetic
+            (dst[3]&0xf100) == 0x0000)   // arithmetic
+        return 1;
+      break;
+  }
 
   return 0;
 }
 
-PICO_INTERNAL void SekState(unsigned char *data)
+int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop)
 {
 #ifdef EMU_C68K
-  memcpy(data,PicoCpu.d,0x44);
-#elif defined(EMU_M68K)
-  memcpy(data, PicoM68kCPU.dar, 0x40);
-  *(int *)(data+0x40) = PicoM68kCPU.pc;
-#elif defined(EMU_F68K)
-  memcpy(data, PicoCpuM68k.dreg, 0x40);
-  *(int *)(data+0x40) = PicoCpuM68k.pc;
+  pc -= PicoCpuCM68k.membase;
 #endif
+  pc &= ~0xff000000;
+  elprintf(EL_IDLE, "idle: patch %06x %04x %04x #%i", pc, oldop, newop, idledet_count);
+  if (pc > Pico.romsize && !(PicoAHW & PAHW_SVP)) {
+    if (++idledet_bads > 128) return 2; // remove detector
+    return 1; // don't patch
+  }
+
+  if (idledet_count >= 0x200 && (idledet_count & 0x1ff) == 0) {
+    void *tmp = realloc(idledet_addrs, (idledet_count+0x200)*4);
+    if (tmp == NULL) return 1;
+    idledet_addrs = tmp;
+  }
+
+  if (pc < Pico.romsize)
+    idledet_addrs[idledet_count++] = pc;
+
+  return 0;
 }
 
-PICO_INTERNAL void SekSetRealTAS(int use_real)
+void SekFinishIdleDet(void)
 {
 #ifdef EMU_C68K
-  CycloneSetRealTAS(use_real);
+  CycloneFinishIdle();
 #endif
 #ifdef EMU_F68K
-  // TODO
+  fm68k_emulate(0, 0, 2);
 #endif
+  while (idledet_count > 0)
+  {
+    unsigned short *op = (unsigned short *)&Pico.rom[idledet_addrs[--idledet_count]];
+    if      ((*op & 0xfd00) == 0x7100)
+      *op &= 0xff, *op |= 0x6600;
+    else if ((*op & 0xfd00) == 0x7500)
+      *op &= 0xff, *op |= 0x6700;
+    else if ((*op & 0xfd00) == 0x7d00)
+      *op &= 0xff, *op |= 0x6000;
+    else
+      elprintf(EL_STATUS|EL_IDLE, "idle: don't know how to restore %04x", *op);
+  }
 }
 
+
+#if defined(EMU_M68K) && M68K_INSTRUCTION_HOOK == OPT_SPECIFY_HANDLER
+static unsigned char op_flags[0x400000/2] = { 0, };
+static int atexit_set = 0;
+
+static void make_idc(void)
+{
+  FILE *f = fopen("idc.idc", "w");
+  int i;
+  if (!f) return;
+  fprintf(f, "#include <idc.idc>\nstatic main() {\n");
+  for (i = 0; i < 0x400000/2; i++)
+    if (op_flags[i] != 0)
+      fprintf(f, "  MakeCode(0x%06x);\n", i*2);
+  fprintf(f, "}\n");
+  fclose(f);
+}
+
+void instruction_hook(void)
+{
+  if (!atexit_set) {
+    atexit(make_idc);
+    atexit_set = 1;
+  }
+  if (REG_PC < 0x400000)
+    op_flags[REG_PC/2] = 1;
+}
+#endif