idle loop detection (Cyclone only, with debug stuff)

[picodrive.git] / Pico / Sek.c

diff --git a/Pico/Sek.c b/Pico/Sek.c
index ac12580..001faea 100644 (file)
--- a/Pico/Sek.c
+++ b/Pico/Sek.c
@@ -193,6 +193,131 @@ PICO_INTERNAL void SekSetRealTAS(int use_real)
 #endif\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
+#endif\r
+\r
+static int *idledet_addrs = NULL;\r
+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
+\r
+void SekInitIdleDet(void)\r
+{\r
+  void *tmp = realloc(idledet_addrs, 0x200*4);\r
+  if (tmp == NULL) {\r
+    free(idledet_addrs);\r
+    idledet_addrs = NULL;\r
+  }\r
+  else\r
+    idledet_addrs = tmp;\r
+  idledet_count = idledet_bads = 0;\r
+  idledet_start_frame = Pico.m.frame_count + 360;\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
+}\r
+\r
+int SekIsIdleCode(unsigned short *dst, int bytes)\r
+{\r
+  printf("SekIsIdleCode %04x %i\n", *dst, bytes);\r
+  switch (bytes)\r
+  {\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
+            (*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
+        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
+        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
+        return 1;\r
+      break;\r
+  }\r
+\r
+  return 0;\r
+}\r
+\r
+int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop)\r
+{\r
+#ifdef EMU_C68K\r
+  pc -= PicoCpuCM68k.membase;\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
+    if (++idledet_bads > 128) return 2; // remove detector\r
+    return 1; // don't patch\r
+  }\r
+\r
+  if (idledet_count >= 0x200 && (idledet_count & 0x1ff) == 0) {\r
+    void *tmp = realloc(idledet_addrs, (idledet_count+0x200)*4);\r
+    if (tmp == NULL) return 1;\r
+    idledet_addrs = tmp;\r
+  }\r
+\r
+  idledet_addrs[idledet_count++] = pc;\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
+  while (idledet_count > 0)\r
+  {\r
+    unsigned short *op = (unsigned short *)&Pico.rom[idledet_addrs[--idledet_count]];\r
+    if      ((*op & 0xfd00) == 0x7100)\r
+      *op &= 0xff, *op |= 0x6600;\r
+    else if ((*op & 0xfd00) == 0x7500)\r
+      *op &= 0xff, *op |= 0x6700;\r
+    else if ((*op & 0xfd00) == 0x7d00)\r
+      *op &= 0xff, *op |= 0x6000;\r
+    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
 #if defined(EMU_M68K) && M68K_INSTRUCTION_HOOK == OPT_SPECIFY_HANDLER\r
 static unsigned char op_flags[0x400000/2] = { 0, };\r
 static int atexit_set = 0;\r