X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=Pico%2FSek.c;h=d641e04546c6d09bd486516da28eac8e695e9c63;hb=8187ba84b7ed56e2535a8381ac66fb5b32414b39;hp=ac125808a85b06b6219e2406861fece01ef4ebc6;hpb=6cab49fd0732432ce87b5f7ce4437ad8d4068bd0;p=picodrive.git

diff --git a/Pico/Sek.c b/Pico/Sek.c
index ac12580..d641e04 100644
--- a/Pico/Sek.c
+++ b/Pico/Sek.c
@@ -96,7 +96,7 @@ static void SekIntAckF68K(unsigned level)
 #endif
 
 
-PICO_INTERNAL int SekInit()
+PICO_INTERNAL void SekInit(void)
 {
 #ifdef EMU_C68K
   CycloneInit();
@@ -129,13 +129,11 @@ PICO_INTERNAL int SekInit()
     g_m68kcontext = oldcontext;
   }
 #endif
-
-  return 0;
 }
 
 
 // Reset the 68000:
-PICO_INTERNAL int SekReset()
+PICO_INTERNAL int SekReset(void)
 {
   if (Pico.rom==NULL) return 1;
 
@@ -166,33 +164,134 @@ PICO_INTERNAL int SekReset()
 }
 
 
-// data must be word aligned
-PICO_INTERNAL void SekState(int *data)
+PICO_INTERNAL void SekSetRealTAS(int use_real)
 {
 #ifdef EMU_C68K
-  memcpy32(data,(int *)PicoCpuCM68k.d,0x44/4);
-  data[0x11] = PicoCpuCM68k.flags;
-#elif defined(EMU_M68K)
-  memcpy32(data, (int *)PicoCpuMM68k.dar, 0x40/4);
-  data[0x10] = PicoCpuMM68k.pc;
-  data[0x11] = m68k_get_reg(&PicoCpuMM68k, M68K_REG_SR);
-#elif defined(EMU_F68K)
-  memcpy32(data, (int *)PicoCpuFM68k.dreg, 0x40/4);
-  data[0x10] = PicoCpuFM68k.pc;
-  data[0x11] = PicoCpuFM68k.sr;
+  CycloneSetRealTAS(use_real);
+#endif
+#ifdef EMU_F68K
+  // TODO
 #endif
 }
 
-PICO_INTERNAL void SekSetRealTAS(int use_real)
+/* idle loop detection, not to be used in CD mode */
+#ifdef EMU_C68K
+#include "cpu/Cyclone/tools/idle.h"
+#endif
+
+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
-  CycloneSetRealTAS(use_real);
+  CycloneInitIdle();
 #endif
 #ifdef EMU_F68K
-  // TODO
+  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;
+}
+
+int SekRegisterIdlePatch(unsigned int pc, int oldop, int newop)
+{
+#ifdef EMU_C68K
+  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;
+}
+
+void SekFinishIdleDet(void)
+{
+#ifdef EMU_C68K
+  CycloneFinishIdle();
 #endif
+#ifdef EMU_F68K
+  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;