final fixes for UIQ3
[picodrive.git] / Pico / Sek.c
index 001faea..f72da65 100644 (file)
@@ -96,7 +96,7 @@ static void SekIntAckF68K(unsigned level)
 #endif\r
 \r
 \r
-PICO_INTERNAL int SekInit()\r
+PICO_INTERNAL void SekInit(void)\r
 {\r
 #ifdef EMU_C68K\r
   CycloneInit();\r
@@ -129,13 +129,11 @@ PICO_INTERNAL int SekInit()
     g_m68kcontext = oldcontext;\r
   }\r
 #endif\r
-\r
-  return 0;\r
 }\r
 \r
 \r
 // Reset the 68000:\r
-PICO_INTERNAL int SekReset()\r
+PICO_INTERNAL int SekReset(void)\r
 {\r
   if (Pico.rom==NULL) return 1;\r
 \r
@@ -165,21 +163,19 @@ PICO_INTERNAL int SekReset()
   return 0;\r
 }\r
 \r
-\r
-// data must be word aligned\r
-PICO_INTERNAL void SekState(int *data)\r
+void SekStepM68k(void)\r
 {\r
-#ifdef EMU_C68K\r
-  memcpy32(data,(int *)PicoCpuCM68k.d,0x44/4);\r
-  data[0x11] = PicoCpuCM68k.flags;\r
+  SekCycleAim=SekCycleCnt+1;\r
+#if defined(EMU_CORE_DEBUG)\r
+  SekCycleCnt+=CM_compareRun(1, 0);\r
+#elif defined(EMU_C68K)\r
+  PicoCpuCM68k.cycles=1;\r
+  CycloneRun(&PicoCpuCM68k);\r
+  SekCycleCnt+=1-PicoCpuCM68k.cycles;\r
 #elif defined(EMU_M68K)\r
-  memcpy32(data, (int *)PicoCpuMM68k.dar, 0x40/4);\r
-  data[0x10] = PicoCpuMM68k.pc;\r
-  data[0x11] = m68k_get_reg(&PicoCpuMM68k, M68K_REG_SR);\r
+  SekCycleCnt+=m68k_execute(1);\r
 #elif defined(EMU_F68K)\r
-  memcpy32(data, (int *)PicoCpuFM68k.dreg, 0x40/4);\r
-  data[0x10] = PicoCpuFM68k.pc;\r
-  data[0x11] = PicoCpuFM68k.sr;\r
+  SekCycleCnt+=fm68k_emulate(1, 0, 0);\r
 #endif\r
 }\r
 \r
@@ -193,6 +189,7 @@ PICO_INTERNAL void SekSetRealTAS(int use_real)
 #endif\r
 }\r
 \r
+\r
 /* idle loop detection, not to be used in CD mode */\r
 #ifdef EMU_C68K\r
 #include "cpu/Cyclone/tools/idle.h"\r
@@ -202,9 +199,24 @@ static int *idledet_addrs = NULL;
 static int idledet_count = 0, idledet_bads = 0;\r
 int idledet_start_frame = 0;\r
 \r
-static int jump_verify[0x10000];\r
-extern int CycloneJumpTab[];\r
-static unsigned char *rom_verify = NULL;\r
+#if 0\r
+#define IDLE_STATS 1\r
+unsigned int idlehit_addrs[128], idlehit_counts[128];\r
+\r
+void SekRegisterIdleHit(unsigned int pc)\r
+{\r
+  int i;\r
+  for (i = 0; i < 127 && idlehit_addrs[i]; i++) {\r
+    if (idlehit_addrs[i] == pc) {\r
+      idlehit_counts[i]++;\r
+      return;\r
+    }\r
+  }\r
+  idlehit_addrs[i] = pc;\r
+  idlehit_counts[i] = 1;\r
+  idlehit_addrs[i+1] = 0;\r
+}\r
+#endif\r
 \r
 void SekInitIdleDet(void)\r
 {\r
@@ -217,46 +229,57 @@ void SekInitIdleDet(void)
     idledet_addrs = tmp;\r
   idledet_count = idledet_bads = 0;\r
   idledet_start_frame = Pico.m.frame_count + 360;\r
+#ifdef IDLE_STATS\r
+  idlehit_addrs[0] = 0;\r
+#endif\r
 \r
-  memcpy(jump_verify, CycloneJumpTab, 0x10000*4);\r
-  rom_verify = realloc(rom_verify, Pico.romsize);\r
-  memcpy(rom_verify, Pico.rom, Pico.romsize);\r
 #ifdef EMU_C68K\r
   CycloneInitIdle();\r
 #endif\r
+#ifdef EMU_F68K\r
+  fm68k_emulate(0, 0, 1);\r
+#endif\r
 }\r
 \r
 int SekIsIdleCode(unsigned short *dst, int bytes)\r
 {\r
-  printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
+  // printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
   switch (bytes)\r
   {\r
+    case 2:\r
+      if ((*dst & 0xf000) != 0x6000)     // not another branch\r
+        return 1;\r
+      break;\r
     case 4:\r
-      if (  (*dst & 0xfff8) == 0x4a10 || // tst.b ($aX)      // where should be no need to wait\r
-           (*dst & 0xfff8) == 0x4a28 || // tst.b ($xxxx,a0) // for byte change anywhere\r
-            (*dst & 0xff3f) == 0x4a38 || // tst.x ($xxxx.w), tas ($xxxx.w)\r
+      if (  (*dst & 0xfff8) == 0x4a10 || // tst.b ($aX)      // there should be no need to wait\r
+            (*dst & 0xfff8) == 0x4a28 || // tst.b ($xxxx,a0) // for byte change anywhere\r
+            (*dst & 0xff3f) == 0x4a38 || // tst.x ($xxxx.w); tas ($xxxx.w)\r
             (*dst & 0xc1ff) == 0x0038 || // move.x ($xxxx.w), dX\r
             (*dst & 0xf13f) == 0xb038)   // cmp.x ($xxxx.w), dX\r
         return 1;\r
       break;\r
     case 6:\r
-      if ( ((dst[1] & 0xe0) == 0xe0 && ( // RAM\r
-            *dst == 0x4a39 ||            // tst.b ($xxxxxxxx)\r
-            *dst == 0x4a79 ||            // tst.w ($xxxxxxxx)\r
-            *dst == 0x4ab9)) ||          // tst.l ($xxxxxxxx)\r
-           *dst == 0x0838)              // btst $X, ($xxxx.w) [6 byte op]\r
+      if ( ((dst[1] & 0xe0) == 0xe0 && ( // RAM and\r
+            *dst == 0x4a39 ||            //   tst.b ($xxxxxxxx)\r
+            *dst == 0x4a79 ||            //   tst.w ($xxxxxxxx)\r
+            *dst == 0x4ab9 ||            //   tst.l ($xxxxxxxx)\r
+            (*dst & 0xc1ff) == 0x0039 || //   move.x ($xxxxxxxx), dX\r
+            (*dst & 0xf13f) == 0xb039))||//   cmp.x ($xxxxxxxx), dX\r
+            *dst == 0x0838 ||            // btst $X, ($xxxx.w) [6 byte op]\r
+            (*dst & 0xffbf) == 0x0c38)   // cmpi.{b,w} $X, ($xxxx.w)\r
         return 1;\r
       break;\r
     case 8:\r
-      if ( (dst[2] & 0xe0) == 0xe0 && (  // RAM\r
-           *dst == 0x0839 ||            // btst $X, ($xxxxxxxx.w) [8 byte op]\r
-            (*dst & 0xffbf) == 0x0c39))  // cmpi.{b,w} $X, ($xxxxxxxx)\r
+      if ( ((dst[2] & 0xe0) == 0xe0 && ( // RAM and\r
+            *dst == 0x0839 ||            //   btst $X, ($xxxxxxxx.w) [8 byte op]\r
+            (*dst & 0xffbf) == 0x0c39))||//   cmpi.{b,w} $X, ($xxxxxxxx)\r
+            *dst == 0x0cb8)              // cmpi.l $X, ($xxxx.w)\r
         return 1;\r
       break;\r
     case 12:\r
        if ((*dst & 0xf1f8) == 0x3010 && // move.w (aX), dX\r
-           (dst[1]&0xf100) == 0x0000 && // arithmetic\r
-           (dst[3]&0xf100) == 0x0000)   // arithmetic\r
+            (dst[1]&0xf100) == 0x0000 && // arithmetic\r
+            (dst[3]&0xf100) == 0x0000)   // arithmetic\r
         return 1;\r
       break;\r
   }\r
@@ -264,14 +287,21 @@ int SekIsIdleCode(unsigned short *dst, int bytes)
   return 0;\r
 }\r
 \r
-int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop)\r
+int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop, void *ctx)\r
 {\r
-#ifdef EMU_C68K\r
-  pc -= PicoCpuCM68k.membase;\r
+  int is_main68k = 1;\r
+#if   defined(EMU_C68K)\r
+  struct Cyclone *cyc = ctx;\r
+  is_main68k = cyc == &PicoCpuCM68k;\r
+  pc -= cyc->membase;\r
+#elif defined(EMU_F68K)\r
+  is_main68k = ctx == &PicoCpuFM68k;\r
 #endif\r
   pc &= ~0xff000000;\r
-  elprintf(EL_IDLE, "idle: patch %06x %04x %04x #%i", pc, oldop, newop, idledet_count);\r
-  if (pc > Pico.romsize) {\r
+  elprintf(EL_IDLE, "idle: patch %06x %04x %04x %c %c #%i", pc, oldop, newop,\r
+    (newop&0x200)?'n':'y', is_main68k?'m':'s', idledet_count);\r
+\r
+  if (pc > Pico.romsize && !(PicoAHW & PAHW_SVP)) {\r
     if (++idledet_bads > 128) return 2; // remove detector\r
     return 1; // don't patch\r
   }\r
@@ -282,15 +312,19 @@ int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop)
     idledet_addrs = tmp;\r
   }\r
 \r
-  idledet_addrs[idledet_count++] = pc;\r
+  if (pc < Pico.romsize)\r
+    idledet_addrs[idledet_count++] = pc;\r
+\r
   return 0;\r
 }\r
 \r
 void SekFinishIdleDet(void)\r
 {\r
-       int done_something = idledet_count > 0;\r
 #ifdef EMU_C68K\r
   CycloneFinishIdle();\r
+#endif\r
+#ifdef EMU_F68K\r
+  fm68k_emulate(0, 0, 2);\r
 #endif\r
   while (idledet_count > 0)\r
   {\r
@@ -304,17 +338,6 @@ void SekFinishIdleDet(void)
     else\r
       elprintf(EL_STATUS|EL_IDLE, "idle: don't know how to restore %04x", *op);\r
   }\r
-\r
-  if (done_something)\r
-  {\r
-    int i;\r
-    for (i = 0; i < 0x10000; i++)\r
-      if (jump_verify[i] != CycloneJumpTab[i])\r
-        printf("jumptab corruption @ %04x!\n", i), exit(1);\r
-    for (i = 0; i < Pico.romsize; i++)\r
-      if (rom_verify[i] != Pico.rom[i])\r
-        printf("ROM corruption @ %06x!\n", i), exit(1);\r
-  }\r
 }\r
 \r
 \r