Cyclone poll detection problem fixed

[picodrive.git] / Pico / cd / Memory.c

diff --git a/Pico/cd/Memory.c b/Pico/cd/Memory.c
index 0be0a42..b919ee8 100644 (file)
--- a/Pico/cd/Memory.c
+++ b/Pico/cd/Memory.c
@@ -3,8 +3,6 @@
 // (c) Copyright 2007, Grazvydas "notaz" Ignotas\r
 \r
 \r
-//#define __debug_io\r
-\r
 #include "../PicoInt.h"\r
 \r
 #include "../sound/ym2612.h"\r
@@ -20,15 +18,10 @@ typedef unsigned int   u32;
 #define UTYPES_DEFINED\r
 #endif\r
 \r
-//#define __debug_io\r
-//#define __debug_io2\r
-\r
 //#define rdprintf dprintf\r
 #define rdprintf(...)\r
 //#define wrdprintf dprintf\r
 #define wrdprintf(...)\r
-#define plprintf dprintf\r
-//#define plprintf(...)\r
 \r
 #ifdef EMU_CORE_DEBUG\r
 extern u32 lastread_a, lastread_d[16], lastwrite_cyc_d[16];\r
@@ -71,7 +64,7 @@ static u32 m68k_reg_read16(u32 a)
       d = Read_CDC_Host(0);\r
       goto end;\r
     case 0xA:\r
-      dprintf("m68k FIXME: reserved read");\r
+      elprintf(EL_UIO, "m68k FIXME: reserved read");\r
       goto end;\r
     case 0xC:\r
       d = Pico_mcd->m.timer_stopwatch >> 16;\r
@@ -85,11 +78,10 @@ static u32 m68k_reg_read16(u32 a)
     goto end;\r
   }\r
 \r
-  dprintf("m68k_regs FIXME invalid read @ %02x", a);\r
+  elprintf(EL_UIO, "m68k_regs FIXME invalid read @ %02x", a);\r
 \r
 end:\r
 \r
-  // dprintf("ret = %04x", d);\r
   return d;\r
 }\r
 #endif\r
@@ -105,7 +97,7 @@ void m68k_reg_write8(u32 a, u32 d)
   switch (a) {\r
     case 0:\r
       d &= 1;\r
-      if ((d&1) && (Pico_mcd->s68k_regs[0x33]&(1<<2))) { dprintf("m68k: s68k irq 2"); SekInterruptS68k(2); }\r
+      if ((d&1) && (Pico_mcd->s68k_regs[0x33]&(1<<2))) { elprintf(EL_INTS, "m68k: s68k irq 2"); SekInterruptS68k(2); }\r
       return;\r
     case 1:\r
       d &= 3;\r
@@ -149,7 +141,7 @@ void m68k_reg_write8(u32 a, u32 d)
 #ifdef USE_POLL_DETECT\r
       if ((s68k_poll_adclk&0xfe) == 2 && s68k_poll_cnt > POLL_LIMIT) {\r
         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
-        plprintf("s68k poll release, a=%02x\n", a);\r
+        elprintf(EL_CDPOLL, "s68k poll release, a=%02x\n", a);\r
       }\r
 #endif\r
       return;\r
@@ -169,7 +161,7 @@ void m68k_reg_write8(u32 a, u32 d)
 #ifdef USE_POLL_DETECT\r
       if ((s68k_poll_adclk&0xfe) == 0xe && s68k_poll_cnt > POLL_LIMIT) {\r
         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
-        plprintf("s68k poll release, a=%02x\n", a);\r
+        elprintf(EL_CDPOLL, "s68k poll release, a=%02x\n", a);\r
       }\r
 #endif\r
       return;\r
@@ -180,13 +172,13 @@ void m68k_reg_write8(u32 a, u32 d)
 #ifdef USE_POLL_DETECT\r
       if ((a&0xfe) == (s68k_poll_adclk&0xfe) && s68k_poll_cnt > POLL_LIMIT) {\r
         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
-        plprintf("s68k poll release, a=%02x\n", a);\r
+        elprintf(EL_CDPOLL, "s68k poll release, a=%02x\n", a);\r
       }\r
 #endif\r
       return;\r
   }\r
 \r
-  dprintf("m68k FIXME: invalid write? [%02x] %02x", a, d);\r
+  elprintf(EL_UIO, "m68k FIXME: invalid write? [%02x] %02x", a, d);\r
 }\r
 \r
 #ifndef _ASM_CD_MEMORY_C\r
@@ -195,6 +187,8 @@ static
 u32 s68k_poll_detect(u32 a, u32 d)\r
 {\r
 #ifdef USE_POLL_DETECT\r
+  // needed mostly for Cyclone, which doesn't always check it's cycle counter\r
+  if (SekIsStoppedS68k()) return d;\r
   // polling detection\r
   if (a == (s68k_poll_adclk&0xff)) {\r
     unsigned int clkdiff = SekCyclesDoneS68k() - (s68k_poll_adclk>>8);\r
@@ -203,7 +197,7 @@ u32 s68k_poll_detect(u32 a, u32 d)
       //printf("-- diff: %u, cnt = %i\n", clkdiff, s68k_poll_cnt);\r
       if (s68k_poll_cnt > POLL_LIMIT) {\r
         SekSetStopS68k(1);\r
-        plprintf("s68k poll detected @ %06x, a=%02x\n", SekPcS68k, a);\r
+        elprintf(EL_CDPOLL, "s68k poll detected @ %06x, a=%02x\n", SekPcS68k, a);\r
       }\r
       s68k_poll_adclk = (SekCyclesDoneS68k() << 8) | a;\r
       return d;\r
@@ -374,7 +368,7 @@ void s68k_reg_write8(u32 a, u32 d)
 \r
   if ((a&0x1f0) == 0x10 || (a >= 0x38 && a < 0x42))\r
   {\r
-    dprintf("s68k FIXME: invalid write @ %02x?", a);\r
+    elprintf(EL_UIO, "s68k FIXME: invalid write @ %02x?", a);\r
     return;\r
   }\r
 \r
@@ -410,7 +404,7 @@ static u32 OtherRead16End(u32 a, int realsize)
     goto end;\r
   }\r
 \r
-  dprintf("m68k FIXME: unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r
+  elprintf(EL_UIO, "m68k FIXME: unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r
 \r
 end:\r
   return d;\r
@@ -434,7 +428,7 @@ static void OtherWrite8End(u32 a, u32 d, int realsize)
     return;\r
   }\r
 \r
-  dprintf("m68k FIXME: strange w%i: [%06x], %08x @%06x", realsize, a&0xffffff, d, SekPc);\r
+  elprintf(EL_UIO, "m68k FIXME: strange w%i: [%06x], %08x @%06x", realsize, a&0xffffff, d, SekPc);\r
 }\r
 \r
 #define _CD_MEMORY_C\r
@@ -521,9 +515,7 @@ u32 PicoReadM68k8(u32 a)
   }\r
 \r
 \r
-#ifdef __debug_io\r
-  dprintf("r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPc);\r
-#endif\r
+  elprintf(EL_IO, "r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPc);\r
 #ifdef EMU_CORE_DEBUG\r
   if (a>=Pico.romsize) {\r
     lastread_a = a;\r
@@ -608,9 +600,7 @@ static u32 PicoReadM68k16(u32 a)
   }\r
 \r
 \r
-#ifdef __debug_io\r
-  dprintf("r16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\r
-#endif\r
+  elprintf(EL_IO, "r16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\r
 #ifdef EMU_CORE_DEBUG\r
   if (a>=Pico.romsize) {\r
     lastread_a = a;\r
@@ -704,9 +694,7 @@ static u32 PicoReadM68k32(u32 a)
   }\r
 \r
 \r
-#ifdef __debug_io\r
-  dprintf("r32: %06x, %08x @%06x", a&0xffffff, d, SekPc);\r
-#endif\r
+  elprintf(EL_IO, "r32: %06x, %08x @%06x", a&0xffffff, d, SekPc);\r
 #ifdef EMU_CORE_DEBUG\r
   if (a>=Pico.romsize) {\r
     lastread_a = a;\r
@@ -725,9 +713,7 @@ void PicoWriteM68k8(u32 a,u8 d);
 #else\r
 void PicoWriteM68k8(u32 a,u8 d)\r
 {\r
-#ifdef __debug_io\r
-  dprintf("w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\r
-#endif\r
+  elprintf(EL_IO, "w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\r
 #ifdef EMU_CORE_DEBUG\r
   lastwrite_cyc_d[lwp_cyc++&15] = d;\r
 #endif\r
@@ -778,9 +764,7 @@ void PicoWriteM68k16(u32 a,u16 d);
 #else\r
 static void PicoWriteM68k16(u32 a,u16 d)\r
 {\r
-#ifdef __debug_io\r
-  dprintf("w16: %06x, %04x", a&0xffffff, d);\r
-#endif\r
+  elprintf(EL_IO, "w16: %06x, %04x", a&0xffffff, d);\r
 #ifdef EMU_CORE_DEBUG\r
   lastwrite_cyc_d[lwp_cyc++&15] = d;\r
 #endif\r
@@ -824,7 +808,7 @@ static void PicoWriteM68k16(u32 a,u16 d)
 #ifdef USE_POLL_DETECT\r
       if ((s68k_poll_adclk&0xfe) == 0xe && s68k_poll_cnt > POLL_LIMIT) {\r
         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
-        plprintf("s68k poll release, a=%02x\n", a);\r
+        elprintf(EL_CDPOLL, "s68k poll release, a=%02x\n", a);\r
       }\r
 #endif\r
       return;\r
@@ -850,9 +834,7 @@ void PicoWriteM68k32(u32 a,u32 d);
 #else\r
 static void PicoWriteM68k32(u32 a,u32 d)\r
 {\r
-#ifdef __debug_io\r
-  dprintf("w32: %06x, %08x", a&0xffffff, d);\r
-#endif\r
+  elprintf(EL_IO, "w32: %06x, %08x", a&0xffffff, d);\r
 #ifdef EMU_CORE_DEBUG\r
   lastwrite_cyc_d[lwp_cyc++&15] = d;\r
 #endif\r
@@ -968,7 +950,6 @@ static u32 PicoReadS68k8(u32 a)
       d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
       if (a&1) d &= 0x0f;\r
       else d >>= 4;\r
-      dprintf("FIXME: decode");\r
     } else {\r
       // allow access in any mode, like Gens does\r
       d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
@@ -991,7 +972,7 @@ static u32 PicoReadS68k8(u32 a)
 \r
   // PCM\r
   if ((a&0xff8000)==0xff0000) {\r
-    dprintf("s68k_pcm r8: [%06x] @%06x", a, SekPcS68k);\r
+    elprintf(EL_IO, "s68k_pcm r8: [%06x] @%06x", a, SekPcS68k);\r
     a &= 0x7fff;\r
     if (a >= 0x2000)\r
       d = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff];\r
@@ -1000,7 +981,7 @@ static u32 PicoReadS68k8(u32 a)
       d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
       if (a & 2) d >>= 8;\r
     }\r
-    dprintf("ret = %02x", (u8)d);\r
+    elprintf(EL_IO, "ret = %02x", (u8)d);\r
     goto end;\r
   }\r
 \r
@@ -1010,13 +991,11 @@ static u32 PicoReadS68k8(u32 a)
     goto end;\r
   }\r
 \r
-  dprintf("s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
+  elprintf(EL_UIO, "s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
 \r
   end:\r
 \r
-#ifdef __debug_io2\r
-  dprintf("s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
-#endif\r
+  elprintf(EL_IO, "s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
 #ifdef EMU_CORE_DEBUG\r
   lastread_a = ab;\r
   lastread_d[lrp_cyc++&15] = d;\r
@@ -1064,7 +1043,6 @@ static u32 PicoReadS68k16(u32 a)
       int bank = (Pico_mcd->s68k_regs[3]&1)^1;\r
       d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
       d |= d << 4; d &= ~0xf0;\r
-      dprintf("FIXME: decode");\r
     } else {\r
       // allow access in any mode, like Gens does\r
       d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
@@ -1110,13 +1088,11 @@ static u32 PicoReadS68k16(u32 a)
     goto end;\r
   }\r
 \r
-  dprintf("s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
+  elprintf(EL_UIO, "s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
 \r
   end:\r
 \r
-#ifdef __debug_io2\r
-  dprintf("s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
-#endif\r
+  elprintf(EL_IO, "s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
 #ifdef EMU_CORE_DEBUG\r
   lastread_a = ab;\r
   lastread_d[lrp_cyc++&15] = d;\r
@@ -1220,13 +1196,11 @@ static u32 PicoReadS68k32(u32 a)
     goto end;\r
   }\r
 \r
-  dprintf("s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
+  elprintf(EL_UIO, "s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
 \r
   end:\r
 \r
-#ifdef __debug_io2\r
-  dprintf("s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
-#endif\r
+  elprintf(EL_IO, "s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
 #ifdef EMU_CORE_DEBUG\r
   if (ab > 0x78) { // not vectors and stuff\r
     lastread_a = ab;\r
@@ -1296,9 +1270,7 @@ void PicoWriteS68k8(u32 a,u8 d);
 #else\r
 static void PicoWriteS68k8(u32 a,u8 d)\r
 {\r
-#ifdef __debug_io2\r
-  dprintf("s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
-#endif\r
+  elprintf(EL_IO, "s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
 \r
   a&=0xffffff;\r
 \r
@@ -1366,7 +1338,7 @@ static void PicoWriteS68k8(u32 a,u8 d)
     return;\r
   }\r
 \r
-  dprintf("s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
+  elprintf(EL_UIO, "s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
 }\r
 #endif\r
 \r
@@ -1376,9 +1348,7 @@ void PicoWriteS68k16(u32 a,u16 d);
 #else\r
 static void PicoWriteS68k16(u32 a,u16 d)\r
 {\r
-#ifdef __debug_io2\r
-  dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
-#endif\r
+  elprintf(EL_IO, "s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
 \r
   a&=0xfffffe;\r
 \r
@@ -1456,7 +1426,7 @@ static void PicoWriteS68k16(u32 a,u16 d)
     return;\r
   }\r
 \r
-  dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
+  elprintf(EL_UIO, "s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
 }\r
 #endif\r
 \r
@@ -1466,9 +1436,7 @@ void PicoWriteS68k32(u32 a,u32 d);
 #else\r
 static void PicoWriteS68k32(u32 a,u32 d)\r
 {\r
-#ifdef __debug_io2\r
-  dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
-#endif\r
+  elprintf(EL_IO, "s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
 \r
   a&=0xfffffe;\r
 \r
@@ -1558,7 +1526,7 @@ static void PicoWriteS68k32(u32 a,u32 d)
     return;\r
   }\r
 \r
-  dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
+  elprintf(EL_UIO, "s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
 }\r
 #endif\r
 \r
@@ -1586,7 +1554,7 @@ static __inline int PicoMemBaseM68k(u32 pc)
   }\r
 \r
   // Error - Program Counter is invalid\r
-  dprintf("m68k FIXME: unhandled jump to %06x", pc);\r
+  elprintf(EL_ANOMALY, "m68k FIXME: unhandled jump to %06x", pc);\r
 \r
   return (int)Pico_mcd->bios;\r
 }\r
@@ -1617,7 +1585,7 @@ static __inline int PicoMemBaseS68k(u32 pc)
   }\r
 \r
   // Error - Program Counter is invalid\r
-  dprintf("s68k FIXME: unhandled jump to %06x", pc);\r
+  elprintf(EL_ANOMALY, "s68k FIXME: unhandled jump to %06x", pc);\r
 \r
   return (int)Pico_mcd->prg_ram;\r
 }\r
@@ -1658,7 +1626,6 @@ void PicoMemResetCD(int r3)
 \r
 PICO_INTERNAL void PicoMemSetupCD(void)\r
 {\r
-  dprintf("PicoMemSetupCD()");\r
 #ifdef EMU_C68K\r
   // Setup m68k memory callbacks:\r
   PicoCpuCM68k.checkpc=PicoCheckPcM68k;\r
@@ -1757,7 +1724,7 @@ unsigned int  m68k_read_pcrelative_CD8 (unsigned int a)
       int bank = (Pico_mcd->s68k_regs[3]&1)^1;\r
       return *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff));\r
     }\r
-    dprintf("s68k_read_pcrelative_CD8 FIXME: can't handle %06x", a);\r
+    elprintf(EL_ANOMALY, "s68k_read_pcrelative_CD8 FIXME: can't handle %06x", a);\r
   } else {\r
     if((a&0xe00000)==0xe00000) return *(u8 *)(Pico.ram+((a^1)&0xffff)); // Ram\r
     if(a<0x20000)              return *(u8 *)(Pico.rom+(a^1)); // Bios\r
@@ -1769,7 +1736,7 @@ unsigned int  m68k_read_pcrelative_CD8 (unsigned int a)
         return *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff));\r
       }\r
     }\r
-    dprintf("m68k_read_pcrelative_CD8 FIXME: can't handle %06x", a);\r
+    elprintf(EL_ANOMALY, "m68k_read_pcrelative_CD8 FIXME: can't handle %06x", a);\r
   }\r
   return 0;//(u8)  lastread_d;\r
 }\r
@@ -1784,7 +1751,7 @@ unsigned int  m68k_read_pcrelative_CD16(unsigned int a)
       int bank = (Pico_mcd->s68k_regs[3]&1)^1;\r
       return *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
     }\r
-    dprintf("s68k_read_pcrelative_CD16 FIXME: can't handle %06x", a);\r
+    elprintf(EL_ANOMALY, "s68k_read_pcrelative_CD16 FIXME: can't handle %06x", a);\r
   } else {\r
     if((a&0xe00000)==0xe00000) return *(u16 *)(Pico.ram+(a&0xfffe)); // Ram\r
     if(a<0x20000)              return *(u16 *)(Pico.rom+(a&~1)); // Bios\r
@@ -1796,7 +1763,7 @@ unsigned int  m68k_read_pcrelative_CD16(unsigned int a)
         return *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
       }\r
     }\r
-    dprintf("m68k_read_pcrelative_CD16 FIXME: can't handle %06x", a);\r
+    elprintf(EL_ANOMALY, "m68k_read_pcrelative_CD16 FIXME: can't handle %06x", a);\r
   }\r
   return 0;\r
 }\r
@@ -1813,7 +1780,7 @@ unsigned int  m68k_read_pcrelative_CD32(unsigned int a)
       pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
       return (pm[0]<<16)|pm[1];\r
     }\r
-    dprintf("s68k_read_pcrelative_CD32 FIXME: can't handle %06x", a);\r
+    elprintf(EL_ANOMALY, "s68k_read_pcrelative_CD32 FIXME: can't handle %06x", a);\r
   } else {\r
     if((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); return (pm[0]<<16)|pm[1]; } // Ram\r
     if(a<0x20000)              { u16 *pm=(u16 *)(Pico.rom+(a&~1));     return (pm[0]<<16)|pm[1]; }\r
@@ -1826,7 +1793,7 @@ unsigned int  m68k_read_pcrelative_CD32(unsigned int a)
         return (pm[0]<<16)|pm[1];\r
       }\r
     }\r
-    dprintf("m68k_read_pcrelative_CD32 FIXME: can't handle %06x", a);\r
+    elprintf(EL_ANOMALY, "m68k_read_pcrelative_CD32 FIXME: can't handle %06x", a);\r
   }\r
   return 0;\r
 }\r