.cue support, Pico stubs
[picodrive.git] / Pico / cd / Memory.c
index 1be1823..2b419b7 100644 (file)
@@ -2,9 +2,6 @@
 // Loosely based on Gens code.\r
 // (c) Copyright 2007, Grazvydas "notaz" Ignotas\r
 \r
-// A68K no longer supported here\r
-\r
-//#define __debug_io\r
 \r
 #include "../PicoInt.h"\r
 \r
@@ -21,20 +18,25 @@ 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
+#ifdef _MSC_VER\r
+#define rdprintf\r
+#define wrdprintf\r
+#else\r
+//#define rdprintf dprintf\r
+#define rdprintf(...)\r
 //#define wrdprintf dprintf\r
 #define wrdprintf(...)\r
-#define plprintf dprintf\r
-//#define plprintf(...)\r
+#endif\r
+\r
+#ifdef EMU_CORE_DEBUG\r
+extern u32 lastread_a, lastread_d[16], lastwrite_cyc_d[16];\r
+extern int lrp_cyc, lwp_cyc;\r
+#undef USE_POLL_DETECT\r
+#endif\r
 \r
 // -----------------------------------------------------------------\r
 \r
 // poller detection\r
-//#undef USE_POLL_DETECT\r
 #define POLL_LIMIT 16\r
 #define POLL_CYCLES 124\r
 // int m68k_poll_addr, m68k_poll_cnt;\r
@@ -67,7 +69,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
@@ -81,11 +83,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
@@ -101,7 +102,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
@@ -145,7 +146,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", a);\r
       }\r
 #endif\r
       return;\r
@@ -165,7 +166,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", a);\r
       }\r
 #endif\r
       return;\r
@@ -176,13 +177,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", 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
@@ -191,6 +192,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
@@ -199,7 +202,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", SekPcS68k, a);\r
       }\r
       s68k_poll_adclk = (SekCyclesDoneS68k() << 8) | a;\r
       return d;\r
@@ -280,7 +283,6 @@ void s68k_reg_write8(u32 a, u32 d)
 {\r
   //dprintf("s68k_regs w%2i: [%02x] %02x @ %06x", realsize, a, d, SekPcS68k);\r
 \r
-  // TODO: review against Gens\r
   // Warning: d might have upper bits set\r
   switch (a) {\r
     case 2:\r
@@ -371,7 +373,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
@@ -379,92 +381,157 @@ void s68k_reg_write8(u32 a, u32 d)
 }\r
 \r
 \r
-#ifndef _ASM_CD_MEMORY_C\r
 static u32 OtherRead16End(u32 a, int realsize)\r
 {\r
   u32 d=0;\r
 \r
+#ifndef _ASM_CD_MEMORY_C\r
   if ((a&0xffffc0)==0xa12000) {\r
     d=m68k_reg_read16(a);\r
     goto end;\r
   }\r
 \r
-  dprintf("m68k FIXME: unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r
+  if (a==0x400000) {\r
+    if (SRam.data != NULL) d=3; // 64k cart\r
+    goto end;\r
+  }\r
 \r
+  if ((a&0xfe0000)==0x600000) {\r
+    if (SRam.data != NULL) {\r
+      d=SRam.data[((a>>1)&0xffff)+0x2000];\r
+      if (realsize == 8) d|=d<<8;\r
+    }\r
+    goto end;\r
+  }\r
+\r
+  if (a==0x7ffffe) {\r
+    d=Pico_mcd->m.bcram_reg;\r
+    goto end;\r
+  }\r
+#endif\r
+\r
+  elprintf(EL_UIO, "m68k FIXME: unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r
+\r
+#ifndef _ASM_CD_MEMORY_C\r
 end:\r
+#endif\r
   return d;\r
 }\r
 \r
 \r
 static void OtherWrite8End(u32 a, u32 d, int realsize)\r
 {\r
+#ifndef _ASM_CD_MEMORY_C\r
   if ((a&0xffffc0)==0xa12000) { m68k_reg_write8(a, d); return; }\r
 \r
-  dprintf("m68k FIXME: strange w%i: [%06x], %08x @%06x", realsize, a&0xffffff, d, SekPc);\r
+  if ((a&0xfe0000)==0x600000) {\r
+    if (SRam.data != NULL && (Pico_mcd->m.bcram_reg&1)) {\r
+      SRam.data[((a>>1)&0xffff)+0x2000]=d;\r
+      SRam.changed = 1;\r
+    }\r
+    return;\r
+  }\r
+\r
+  if (a==0x7fffff) {\r
+    Pico_mcd->m.bcram_reg=d;\r
+    return;\r
+  }\r
+#endif\r
+\r
+  elprintf(EL_UIO, "m68k FIXME: strange w%i: [%06x], %08x @%06x", realsize, a&0xffffff, d, SekPc);\r
 }\r
 \r
+#ifndef _ASM_CD_MEMORY_C\r
 #define _CD_MEMORY_C\r
 #undef _ASM_MEMORY_C\r
 #include "../MemoryCmn.c"\r
 #include "cell_map.c"\r
-#endif // !def _ASM_CD_MEMORY_C\r
+#endif\r
 \r
 \r
 // -----------------------------------------------------------------\r
 //                     Read Rom and read Ram\r
 \r
-//u8 PicoReadM68k8_(u32 a);\r
 #ifdef _ASM_CD_MEMORY_C\r
 u32 PicoReadM68k8(u32 a);\r
 #else\r
-static u32 PicoReadM68k8(u32 a)\r
+u32 PicoReadM68k8(u32 a)\r
 {\r
   u32 d=0;\r
 \r
-  if ((a&0xe00000)==0xe00000) { d = *(u8 *)(Pico.ram+((a^1)&0xffff)); goto end; } // Ram\r
-\r
   a&=0xffffff;\r
 \r
-  if (a < 0x20000) { d = *(u8 *)(Pico_mcd->bios+(a^1)); goto end; } // bios\r
+  switch (a >> 17)\r
+  {\r
+    case 0x00>>1: // BIOS: 000000 - 020000\r
+      d = *(u8 *)(Pico_mcd->bios+(a^1));\r
+      break;\r
+    case 0x02>>1: // prg RAM\r
+      if ((Pico_mcd->m.busreq&3)!=1) {\r
+        u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+        d = *(prg_bank+((a^1)&0x1ffff));\r
+      }\r
+      break;\r
+    case 0x20>>1: // word RAM: 200000 - 220000\r
+      wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
+      a &= 0x1ffff;\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        d = Pico_mcd->word_ram1M[bank][a^1];\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = Pico_mcd->word_ram2M[a^1];\r
+      }\r
+      wrdprintf("ret = %02x", (u8)d);\r
+      break;\r
+    case 0x22>>1: // word RAM: 220000 - 240000\r
+      wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
+        d = Pico_mcd->word_ram1M[bank][a^1];\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
+      }\r
+      wrdprintf("ret = %02x", (u8)d);\r
+      break;\r
+    case 0xc0>>1: case 0xc2>>1: case 0xc4>>1: case 0xc6>>1:\r
+    case 0xc8>>1: case 0xca>>1: case 0xcc>>1: case 0xce>>1:\r
+    case 0xd0>>1: case 0xd2>>1: case 0xd4>>1: case 0xd6>>1:\r
+    case 0xd8>>1: case 0xda>>1: case 0xdc>>1: case 0xde>>1:\r
+      // VDP\r
+      if ((a&0xe700e0)==0xc00000) {\r
+        d=PicoVideoRead(a);\r
+        if ((a&1)==0) d>>=8;\r
+      }\r
+      break;\r
+    case 0xe0>>1: case 0xe2>>1: case 0xe4>>1: case 0xe6>>1:\r
+    case 0xe8>>1: case 0xea>>1: case 0xec>>1: case 0xee>>1:\r
+    case 0xf0>>1: case 0xf2>>1: case 0xf4>>1: case 0xf6>>1:\r
+    case 0xf8>>1: case 0xfa>>1: case 0xfc>>1: case 0xfe>>1:\r
+      // RAM:\r
+      d = *(u8 *)(Pico.ram+((a^1)&0xffff));\r
+      break;\r
+    default:\r
+      if ((a&0xff4000)==0xa00000) { d=z80Read8(a); break; } // Z80 Ram\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("m68k_regs r8: [%02x] @%06x", a&0x3f, SekPc);\r
 \r
-  // prg RAM\r
-  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
-    u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
-    d = *(prg_bank+((a^1)&0x1ffff));\r
-    goto end;\r
-  }\r
+      d=OtherRead16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r
 \r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
-      int bank = Pico_mcd->s68k_regs[3]&1;\r
-      if (a >= 0x220000)\r
-           a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
-      else a &= 0x1ffff;\r
-      d = Pico_mcd->word_ram1M[bank][a^1];\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
-    }\r
-    wrdprintf("ret = %02x", (u8)d);\r
-    goto end;\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("ret = %02x", (u8)d);\r
+      break;\r
   }\r
 \r
-  if ((a&0xff4000)==0xa00000) { d=z80Read8(a); goto end; } // Z80 Ram\r
-\r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("m68k_regs r8: [%02x] @%06x", a&0x3f, SekPc);\r
-\r
-  d=OtherRead16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("ret = %02x", (u8)d);\r
-\r
-  end:\r
-\r
-#ifdef __debug_io\r
-  dprintf("r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPc);\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
+    lastread_d[lrp_cyc++&15] = d;\r
+  }\r
 #endif\r
   return d;\r
 }\r
@@ -478,50 +545,78 @@ static u32 PicoReadM68k16(u32 a)
 {\r
   u32 d=0;\r
 \r
-  if ((a&0xe00000)==0xe00000) { d=*(u16 *)(Pico.ram+(a&0xfffe)); goto end; } // Ram\r
-\r
   a&=0xfffffe;\r
 \r
-  if (a < 0x20000) { d = *(u16 *)(Pico_mcd->bios+a); goto end; } // bios\r
+  switch (a >> 17)\r
+  {\r
+    case 0x00>>1: // BIOS: 000000 - 020000\r
+      d = *(u16 *)(Pico_mcd->bios+a);\r
+      break;\r
+    case 0x02>>1: // prg RAM\r
+      if ((Pico_mcd->m.busreq&3)!=1) {\r
+        u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+        wrdprintf("m68k_prgram r16: [%i,%06x] @%06x", Pico_mcd->s68k_regs[3]>>6, a, SekPc);\r
+        d = *(u16 *)(prg_bank+(a&0x1fffe));\r
+        wrdprintf("ret = %04x", d);\r
+      }\r
+      break;\r
+    case 0x20>>1: // word RAM: 200000 - 220000\r
+      wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
+      a &= 0x1fffe;\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = *(u16 *)(Pico_mcd->word_ram2M+a);\r
+      }\r
+      wrdprintf("ret = %04x", d);\r
+      break;\r
+    case 0x22>>1: // word RAM: 220000 - 240000\r
+      wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        a = (a&2) | (cell_map(a >> 2) << 2); // cell arranged\r
+        d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
+      }\r
+      wrdprintf("ret = %04x", d);\r
+      break;\r
+    case 0xc0>>1: case 0xc2>>1: case 0xc4>>1: case 0xc6>>1:\r
+    case 0xc8>>1: case 0xca>>1: case 0xcc>>1: case 0xce>>1:\r
+    case 0xd0>>1: case 0xd2>>1: case 0xd4>>1: case 0xd6>>1:\r
+    case 0xd8>>1: case 0xda>>1: case 0xdc>>1: case 0xde>>1:\r
+      // VDP\r
+      if ((a&0xe700e0)==0xc00000)\r
+        d=PicoVideoRead(a);\r
+      break;\r
+    case 0xe0>>1: case 0xe2>>1: case 0xe4>>1: case 0xe6>>1:\r
+    case 0xe8>>1: case 0xea>>1: case 0xec>>1: case 0xee>>1:\r
+    case 0xf0>>1: case 0xf2>>1: case 0xf4>>1: case 0xf6>>1:\r
+    case 0xf8>>1: case 0xfa>>1: case 0xfc>>1: case 0xfe>>1:\r
+      // RAM:\r
+      d=*(u16 *)(Pico.ram+(a&0xfffe));\r
+      break;\r
+    default:\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("m68k_regs r16: [%02x] @%06x", a&0x3f, SekPc);\r
 \r
-  // prg RAM\r
-  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
-    u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
-    wrdprintf("m68k_prgram r16: [%i,%06x] @%06x", Pico_mcd->s68k_regs[3]>>6, a, SekPc);\r
-    d = *(u16 *)(prg_bank+(a&0x1fffe));\r
-    wrdprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
+      d = OtherRead16(a, 16);\r
 \r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
-      int bank = Pico_mcd->s68k_regs[3]&1;\r
-      if (a >= 0x220000)\r
-           a = (a&2) | (cell_map(a >> 2) << 2); // cell arranged\r
-      else a &= 0x1fffe;\r
-      d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
-    }\r
-    wrdprintf("ret = %04x", d);\r
-    goto end;\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("ret = %04x", d);\r
+      break;\r
   }\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("m68k_regs r16: [%02x] @%06x", a&0x3f, SekPc);\r
-\r
-  d = OtherRead16(a, 16);\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("ret = %04x", d);\r
-\r
-  end:\r
-\r
-#ifdef __debug_io\r
-  dprintf("r16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\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
+    lastread_d[lrp_cyc++&15] = d;\r
+  }\r
 #endif\r
   return d;\r
 }\r
@@ -535,54 +630,87 @@ static u32 PicoReadM68k32(u32 a)
 {\r
   u32 d=0;\r
 \r
-  if ((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); d = (pm[0]<<16)|pm[1]; goto end; } // Ram\r
-\r
   a&=0xfffffe;\r
 \r
-  if (a < 0x20000) { u16 *pm=(u16 *)(Pico_mcd->bios+a); d = (pm[0]<<16)|pm[1]; goto end; } // bios\r
-\r
-  // prg RAM\r
-  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
-    u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
-    u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r
-    d = (pm[0]<<16)|pm[1];\r
-    goto end;\r
-  }\r
-\r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
-      int bank = Pico_mcd->s68k_regs[3]&1;\r
-      if (a >= 0x220000) { // cell arranged\r
+  switch (a >> 17)\r
+  {\r
+    case 0x00>>1: { // BIOS: 000000 - 020000\r
+      u16 *pm=(u16 *)(Pico_mcd->bios+a);\r
+      d = (pm[0]<<16)|pm[1];\r
+      break;\r
+    }\r
+    case 0x02>>1: // prg RAM\r
+      if ((Pico_mcd->m.busreq&3)!=1) {\r
+        u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+        u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r
+        d = (pm[0]<<16)|pm[1];\r
+      }\r
+      break;\r
+    case 0x20>>1: // word RAM: 200000 - 220000\r
+      wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
+      a&=0x1fffe;\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
+       d = (pm[0]<<16)|pm[1];\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        u16 *pm=(u16 *)(Pico_mcd->word_ram2M+a);\r
+       d = (pm[0]<<16)|pm[1];\r
+      }\r
+      wrdprintf("ret = %08x", d);\r
+      break;\r
+    case 0x22>>1: // word RAM: 220000 - 240000\r
+      wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode, cell arranged?\r
         u32 a1, a2;\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
         a1 = (a&2) | (cell_map(a >> 2) << 2);\r
         if (a&2) a2 = cell_map((a+2) >> 2) << 2;\r
         else     a2 = a1 + 2;\r
         d  = *(u16 *)(Pico_mcd->word_ram1M[bank]+a1) << 16;\r
         d |= *(u16 *)(Pico_mcd->word_ram1M[bank]+a2);\r
       } else {\r
-        u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
+        // allow access in any mode, like Gens does\r
+        u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
+       d = (pm[0]<<16)|pm[1];\r
       }\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe)); d = (pm[0]<<16)|pm[1];\r
+      wrdprintf("ret = %08x", d);\r
+      break;\r
+    case 0xc0>>1: case 0xc2>>1: case 0xc4>>1: case 0xc6>>1:\r
+    case 0xc8>>1: case 0xca>>1: case 0xcc>>1: case 0xce>>1:\r
+    case 0xd0>>1: case 0xd2>>1: case 0xd4>>1: case 0xd6>>1:\r
+    case 0xd8>>1: case 0xda>>1: case 0xdc>>1: case 0xde>>1:\r
+      // VDP\r
+      d = (PicoVideoRead(a)<<16)|PicoVideoRead(a+2);\r
+      break;\r
+    case 0xe0>>1: case 0xe2>>1: case 0xe4>>1: case 0xe6>>1:\r
+    case 0xe8>>1: case 0xea>>1: case 0xec>>1: case 0xee>>1:\r
+    case 0xf0>>1: case 0xf2>>1: case 0xf4>>1: case 0xf6>>1:\r
+    case 0xf8>>1: case 0xfa>>1: case 0xfc>>1: case 0xfe>>1: {\r
+      // RAM:\r
+      u16 *pm=(u16 *)(Pico.ram+(a&0xfffe));\r
+      d = (pm[0]<<16)|pm[1];\r
+      break;\r
     }\r
-    wrdprintf("ret = %08x", d);\r
-    goto end;\r
-  }\r
+    default:\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("m68k_regs r32: [%02x] @%06x", a&0x3f, SekPc);\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("m68k_regs r32: [%02x] @%06x", a&0x3f, SekPc);\r
+      d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r
 \r
-  d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("ret = %08x", d);\r
+      break;\r
+  }\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("ret = %08x", d);\r
 \r
-  end:\r
-#ifdef __debug_io\r
-  dprintf("r32: %06x, %08x @%06x", a&0xffffff, d, SekPc);\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
+    lastread_d[lrp_cyc++&15] = d;\r
+  }\r
 #endif\r
   return d;\r
 }\r
@@ -594,22 +722,18 @@ static u32 PicoReadM68k32(u32 a)
 #ifdef _ASM_CD_MEMORY_C\r
 void PicoWriteM68k8(u32 a,u8 d);\r
 #else\r
-static void PicoWriteM68k8(u32 a,u8 d)\r
+void PicoWriteM68k8(u32 a,u8 d)\r
 {\r
-#ifdef __debug_io\r
-  dprintf("w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\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
-  //if ((a&0xe0ffff)==0xe0a9ba+0x69c)\r
-  //  dprintf("w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\r
-\r
 \r
   if ((a&0xe00000)==0xe00000) { // Ram\r
     *(u8 *)(Pico.ram+((a^1)&0xffff)) = d;\r
     return;\r
   }\r
 \r
-  a&=0xffffff;\r
-\r
   // prg RAM\r
   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
@@ -617,6 +741,8 @@ static void PicoWriteM68k8(u32 a,u8 d)
     return;\r
   }\r
 \r
+  a&=0xffffff;\r
+\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     wrdprintf("m68k_wram w8: [%06x] %02x @%06x", a, d, SekPc);\r
@@ -649,18 +775,16 @@ 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
+  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
-  //  dprintf("w16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\r
 \r
   if ((a&0xe00000)==0xe00000) { // Ram\r
     *(u16 *)(Pico.ram+(a&0xfffe))=d;\r
     return;\r
   }\r
 \r
-  a&=0xfffffe;\r
-\r
   // prg RAM\r
   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
@@ -669,6 +793,8 @@ static void PicoWriteM68k16(u32 a,u16 d)
     return;\r
   }\r
 \r
+  a&=0xfffffe;\r
+\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     wrdprintf("m68k_wram w16: [%06x] %04x @%06x", a, d, SekPc);\r
@@ -693,7 +819,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", a);\r
       }\r
 #endif\r
       return;\r
@@ -703,6 +829,12 @@ static void PicoWriteM68k16(u32 a,u16 d)
     return;\r
   }\r
 \r
+  // VDP\r
+  if ((a&0xe700e0)==0xc00000) {\r
+    PicoVideoWrite(a,(u16)d);\r
+    return;\r
+  }\r
+\r
   OtherWrite16(a,d);\r
 }\r
 #endif\r
@@ -713,8 +845,9 @@ 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
+  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
 \r
   if ((a&0xe00000)==0xe00000)\r
@@ -725,8 +858,6 @@ static void PicoWriteM68k32(u32 a,u32 d)
     return;\r
   }\r
 \r
-  a&=0xfffffe;\r
-\r
   // prg RAM\r
   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
@@ -735,6 +866,8 @@ static void PicoWriteM68k32(u32 a,u32 d)
     return;\r
   }\r
 \r
+  a&=0xfffffe;\r
+\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     if (d != 0) // don't log clears\r
@@ -765,6 +898,14 @@ static void PicoWriteM68k32(u32 a,u32 d)
     if ((a&0x3e) == 0xe) dprintf("m68k FIXME: w32 [%02x]", a&0x3f);\r
   }\r
 \r
+  // VDP\r
+  if ((a&0xe700e0)==0xc00000)\r
+  {\r
+    PicoVideoWrite(a,  (u16)(d>>16));\r
+    PicoVideoWrite(a+2,(u16)d);\r
+    return;\r
+  }\r
+\r
   OtherWrite16(a,  (u16)(d>>16));\r
   OtherWrite16(a+2,(u16)d);\r
 }\r
@@ -782,6 +923,9 @@ static u32 PicoReadS68k8(u32 a)
 {\r
   u32 d=0;\r
 \r
+#ifdef EMU_CORE_DEBUG\r
+  u32 ab=a&0xfffffe;\r
+#endif\r
   a&=0xffffff;\r
 \r
   // prg RAM\r
@@ -817,7 +961,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
@@ -840,7 +983,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
@@ -849,7 +992,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
@@ -859,12 +1002,14 @@ 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
+  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
 #endif\r
   return d;\r
 }\r
@@ -878,6 +1023,9 @@ static u32 PicoReadS68k16(u32 a)
 {\r
   u32 d=0;\r
 \r
+#ifdef EMU_CORE_DEBUG\r
+  u32 ab=a&0xfffffe;\r
+#endif\r
   a&=0xfffffe;\r
 \r
   // prg RAM\r
@@ -906,7 +1054,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
@@ -952,12 +1099,14 @@ 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
+  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
 #endif\r
   return d;\r
 }\r
@@ -971,6 +1120,9 @@ static u32 PicoReadS68k32(u32 a)
 {\r
   u32 d=0;\r
 \r
+#ifdef EMU_CORE_DEBUG\r
+  u32 ab=a&0xfffffe;\r
+#endif\r
   a&=0xfffffe;\r
 \r
   // prg RAM\r
@@ -1011,11 +1163,12 @@ static u32 PicoReadS68k32(u32 a)
   // word RAM (1M area)\r
   if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
     int bank;\r
+    u16 *pm;\r
     wrdprintf("s68k_wram1M r32: [%06x] @%06x", a, SekPcS68k);\r
 //    if (!(Pico_mcd->s68k_regs[3]&4))\r
 //      dprintf("s68k_wram1M FIXME: wrong mode");\r
     bank = (Pico_mcd->s68k_regs[3]&1)^1;\r
-    u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
+    pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
     wrdprintf("ret = %08x", d);\r
     goto end;\r
   }\r
@@ -1055,12 +1208,16 @@ 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
+  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
+    lastread_d[lrp_cyc++&15] = d;\r
+  }\r
 #endif\r
   return d;\r
 }\r
@@ -1125,12 +1282,14 @@ 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
+#ifdef EMU_CORE_DEBUG\r
+  lastwrite_cyc_d[lwp_cyc++&15] = d;\r
+#endif\r
+\r
   // prg RAM\r
   if (a < 0x80000) {\r
     u8 *pm=(u8 *)(Pico_mcd->prg_ram+(a^1));\r
@@ -1191,7 +1350,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
@@ -1201,12 +1360,14 @@ 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
+#ifdef EMU_CORE_DEBUG\r
+  lastwrite_cyc_d[lwp_cyc++&15] = d;\r
+#endif\r
+\r
   // prg RAM\r
   if (a < 0x80000) {\r
     wrdprintf("s68k_prgram w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
@@ -1277,7 +1438,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
@@ -1287,12 +1448,14 @@ 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
+#ifdef EMU_CORE_DEBUG\r
+  lastwrite_cyc_d[lwp_cyc++&15] = d;\r
+#endif\r
+\r
   // prg RAM\r
   if (a < 0x80000) {\r
     if (a >= (Pico_mcd->s68k_regs[2]<<8)) {\r
@@ -1375,7 +1538,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
@@ -1403,7 +1566,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
@@ -1434,7 +1597,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
@@ -1473,9 +1636,16 @@ void PicoMemResetCD(int r3)
 }\r
 #endif\r
 \r
+#ifdef EMU_M68K\r
+static void m68k_mem_setup_cd(void);\r
+#endif\r
+\r
 PICO_INTERNAL void PicoMemSetupCD(void)\r
 {\r
-  dprintf("PicoMemSetupCD()");\r
+  // additional handlers for common code\r
+  PicoRead16Hook = OtherRead16End;\r
+  PicoWrite8Hook = OtherWrite8End;\r
+\r
 #ifdef EMU_C68K\r
   // Setup m68k memory callbacks:\r
   PicoCpuCM68k.checkpc=PicoCheckPcM68k;\r
@@ -1536,6 +1706,9 @@ PICO_INTERNAL void PicoMemSetupCD(void)
     // PicoMemResetCD() will setup word ram for both\r
   }\r
 #endif\r
+#ifdef EMU_M68K\r
+  m68k_mem_setup_cd();\r
+#endif\r
 \r
   // m68k_poll_addr = m68k_poll_cnt = 0;\r
   s68k_poll_adclk = s68k_poll_cnt = 0;\r
@@ -1543,27 +1716,28 @@ PICO_INTERNAL void PicoMemSetupCD(void)
 \r
 \r
 #ifdef EMU_M68K\r
-unsigned char  PicoReadCD8w (unsigned int a) {\r
+static unsigned int PicoReadCD8w (unsigned int a) {\r
        return m68ki_cpu_p == &PicoCpuMS68k ? PicoReadS68k8(a) : PicoReadM68k8(a);\r
 }\r
-unsigned short PicoReadCD16w(unsigned int a) {\r
+static unsigned int PicoReadCD16w(unsigned int a) {\r
        return m68ki_cpu_p == &PicoCpuMS68k ? PicoReadS68k16(a) : PicoReadM68k16(a);\r
 }\r
-unsigned int   PicoReadCD32w(unsigned int a) {\r
+static unsigned int PicoReadCD32w(unsigned int a) {\r
        return m68ki_cpu_p == &PicoCpuMS68k ? PicoReadS68k32(a) : PicoReadM68k32(a);\r
 }\r
-void PicoWriteCD8w (unsigned int a, unsigned char d) {\r
+static void PicoWriteCD8w (unsigned int a, unsigned char d) {\r
        if (m68ki_cpu_p == &PicoCpuMS68k) PicoWriteS68k8(a, d); else PicoWriteM68k8(a, d);\r
 }\r
-void PicoWriteCD16w(unsigned int a, unsigned short d) {\r
+static void PicoWriteCD16w(unsigned int a, unsigned short d) {\r
        if (m68ki_cpu_p == &PicoCpuMS68k) PicoWriteS68k16(a, d); else PicoWriteM68k16(a, d);\r
 }\r
-void PicoWriteCD32w(unsigned int a, unsigned int d) {\r
+static void PicoWriteCD32w(unsigned int a, unsigned int d) {\r
        if (m68ki_cpu_p == &PicoCpuMS68k) PicoWriteS68k32(a, d); else PicoWriteM68k32(a, d);\r
 }\r
 \r
 // these are allowed to access RAM\r
-unsigned int  m68k_read_pcrelative_CD8 (unsigned int a) {\r
+static unsigned int  m68k_read_pcrelative_CD8 (unsigned int a)\r
+{\r
   a&=0xffffff;\r
   if(m68ki_cpu_p == &PicoCpuMS68k) {\r
     if (a < 0x80000) return *(u8 *)(Pico_mcd->prg_ram+(a^1)); // PRG Ram\r
@@ -1573,7 +1747,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
@@ -1585,11 +1759,12 @@ 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
-unsigned int  m68k_read_pcrelative_CD16(unsigned int a) {\r
+static unsigned int  m68k_read_pcrelative_CD16(unsigned int a)\r
+{\r
   a&=0xffffff;\r
   if(m68ki_cpu_p == &PicoCpuMS68k) {\r
     if (a < 0x80000) return *(u16 *)(Pico_mcd->prg_ram+(a&~1)); // PRG Ram\r
@@ -1599,7 +1774,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
@@ -1611,11 +1786,12 @@ 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
-unsigned int  m68k_read_pcrelative_CD32(unsigned int a) {\r
+static unsigned int  m68k_read_pcrelative_CD32(unsigned int a)\r
+{\r
   u16 *pm;\r
   a&=0xffffff;\r
   if(m68ki_cpu_p == &PicoCpuMS68k) {\r
@@ -1627,7 +1803,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
@@ -1640,9 +1816,32 @@ 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
+\r
+extern unsigned int (*pm68k_read_memory_8) (unsigned int address);\r
+extern unsigned int (*pm68k_read_memory_16)(unsigned int address);\r
+extern unsigned int (*pm68k_read_memory_32)(unsigned int address);\r
+extern void (*pm68k_write_memory_8) (unsigned int address, unsigned char  value);\r
+extern void (*pm68k_write_memory_16)(unsigned int address, unsigned short value);\r
+extern void (*pm68k_write_memory_32)(unsigned int address, unsigned int   value);\r
+extern unsigned int (*pm68k_read_memory_pcr_8) (unsigned int address);\r
+extern unsigned int (*pm68k_read_memory_pcr_16)(unsigned int address);\r
+extern unsigned int (*pm68k_read_memory_pcr_32)(unsigned int address);\r
+\r
+static void m68k_mem_setup_cd(void)\r
+{\r
+  pm68k_read_memory_8  = PicoReadCD8w;\r
+  pm68k_read_memory_16 = PicoReadCD16w;\r
+  pm68k_read_memory_32 = PicoReadCD32w;\r
+  pm68k_write_memory_8  = PicoWriteCD8w;\r
+  pm68k_write_memory_16 = PicoWriteCD16w;\r
+  pm68k_write_memory_32 = PicoWriteCD32w;\r
+  pm68k_read_memory_pcr_8  = m68k_read_pcrelative_CD8;\r
+  pm68k_read_memory_pcr_16 = m68k_read_pcrelative_CD16;\r
+  pm68k_read_memory_pcr_32 = m68k_read_pcrelative_CD32;\r
+}\r
 #endif // EMU_M68K\r
 \r