new memory handling, but asm and mappers need update.
[picodrive.git] / pico / cd / memory.c
index 8110a2e..a26cac7 100644 (file)
@@ -1,48 +1,29 @@
 // Memory I/O handlers for Sega/Mega CD.\r
-// Loosely based on Gens code.\r
-// (c) Copyright 2007, Grazvydas "notaz" Ignotas\r
-\r
+// (c) Copyright 2007-2009, Grazvydas "notaz" Ignotas\r
 \r
 #include "../pico_int.h"\r
-\r
-#include "../sound/ym2612.h"\r
-#include "../sound/sn76496.h"\r
+#include "../memory.h"\r
 \r
 #include "gfx_cd.h"\r
 #include "pcm.h"\r
 \r
-#ifndef UTYPES_DEFINED\r
-typedef unsigned char  u8;\r
-typedef unsigned short u16;\r
-typedef unsigned int   u32;\r
-#define UTYPES_DEFINED\r
-#endif\r
-\r
-#ifdef _MSC_VER\r
-#define rdprintf\r
-#define wrdprintf\r
-#define r3printf\r
-#else\r
-//#define rdprintf dprintf\r
-#define rdprintf(...)\r
-//#define wrdprintf dprintf\r
-#define wrdprintf(...)\r
-//#define r3printf elprintf\r
-#define r3printf(...)\r
-#endif\r
+unsigned long s68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];\r
+unsigned long s68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];\r
+unsigned long s68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];\r
+unsigned long s68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];\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
+MAKE_68K_READ8(s68k_read8, s68k_read8_map)\r
+MAKE_68K_READ16(s68k_read16, s68k_read16_map)\r
+MAKE_68K_READ32(s68k_read32, s68k_read16_map)\r
+MAKE_68K_WRITE8(s68k_write8, s68k_write8_map)\r
+MAKE_68K_WRITE16(s68k_write16, s68k_write16_map)\r
+MAKE_68K_WRITE32(s68k_write32, s68k_write16_map)\r
 \r
 // -----------------------------------------------------------------\r
 \r
 // poller detection\r
 #define POLL_LIMIT 16\r
 #define POLL_CYCLES 124\r
-// int m68k_poll_addr, m68k_poll_cnt;\r
 unsigned int s68k_poll_adclk, s68k_poll_cnt;\r
 \r
 #ifndef _ASM_CD_MEMORY_C\r
@@ -50,7 +31,6 @@ static u32 m68k_reg_read16(u32 a)
 {\r
   u32 d=0;\r
   a &= 0x3e;\r
-  // dprintf("m68k_regs r%2i: [%02x] @%06x", realsize&~1, a+(realsize&1), SekPc);\r
 \r
   switch (a) {\r
     case 0:\r
@@ -58,7 +38,7 @@ static u32 m68k_reg_read16(u32 a)
       goto end;\r
     case 2:\r
       d = (Pico_mcd->s68k_regs[a]<<8) | (Pico_mcd->s68k_regs[a+1]&0xc7);\r
-      r3printf(EL_STATUS, "m68k_regs r3: %02x @%06x", (u8)d, SekPc);\r
+      elprintf(EL_CDREG3, "m68k_regs r3: %02x @%06x", (u8)d, SekPc);\r
       goto end;\r
     case 4:\r
       d = Pico_mcd->s68k_regs[4]<<8;\r
@@ -74,7 +54,7 @@ static u32 m68k_reg_read16(u32 a)
       goto end;\r
     case 0xC:\r
       d = Pico_mcd->m.timer_stopwatch >> 16;\r
-      dprintf("m68k stopwatch timer read (%04x)", d);\r
+      elprintf(EL_CDREGS, "m68k stopwatch timer read (%04x)", d);\r
       goto end;\r
   }\r
 \r
@@ -97,8 +77,8 @@ static
 #endif\r
 void m68k_reg_write8(u32 a, u32 d)\r
 {\r
+  u32 dold;\r
   a &= 0x3f;\r
-  // dprintf("m68k_regs w%2i: [%02x] %02x @%06x", realsize, a, d, SekPc);\r
 \r
   switch (a) {\r
     case 0:\r
@@ -113,20 +93,21 @@ void m68k_reg_write8(u32 a, u32 d)
       if ((Pico_mcd->m.state_flags&1) && (d&3)==1) {\r
         SekResetS68k(); // S68k comes out of RESET or BRQ state\r
         Pico_mcd->m.state_flags&=~1;\r
-        dprintf("m68k: resetting s68k, cycles=%i", SekCyclesLeft);\r
+        elprintf(EL_CDREGS, "m68k: resetting s68k, cycles=%i", SekCyclesLeft);\r
       }\r
+      if (!(d & 1))\r
+        d |= 2; // verified: reset also gives bus\r
+      if ((d ^ Pico_mcd->m.busreq) & 2)\r
+        PicoMemRemapCD(Pico_mcd->s68k_regs[3]);\r
       Pico_mcd->m.busreq = d;\r
       return;\r
     case 2:\r
-      dprintf("m68k: prg wp=%02x", d);\r
+      elprintf(EL_CDREGS, "m68k: prg wp=%02x", d);\r
       Pico_mcd->s68k_regs[2] = d; // really use s68k side register\r
       return;\r
-    case 3: {\r
-      u32 dold = Pico_mcd->s68k_regs[3]&0x1f;\r
-      r3printf(EL_STATUS, "m68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
-      d &= 0xc2;\r
-      if ((dold>>6) != ((d>>6)&3))\r
-        dprintf("m68k: prg bank: %i -> %i", (Pico_mcd->s68k_regs[a]>>6), ((d>>6)&3));\r
+    case 3:\r
+      dold = Pico_mcd->s68k_regs[3];\r
+      elprintf(EL_CDREG3, "m68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
       //if ((Pico_mcd->s68k_regs[3]&4) != (d&4)) dprintf("m68k: ram mode %i mbit", (d&4) ? 1 : 2);\r
       //if ((Pico_mcd->s68k_regs[3]&2) != (d&2)) dprintf("m68k: %s", (d&4) ? ((d&2) ? "word swap req" : "noop?") :\r
       //                                             ((d&2) ? "word ram to s68k" : "word ram to m68k"));\r
@@ -139,7 +120,11 @@ void m68k_reg_write8(u32 a, u32 d)
           SekEndRun(20+16+10+12+16);\r
         }\r
       }\r
-      Pico_mcd->s68k_regs[3] = d | dold; // really use s68k side register\r
+      Pico_mcd->s68k_regs[3] = (d & 0xc2) | (dold & 0x1f);\r
+      if ((d ^ dold) & 0xc0) {\r
+        elprintf(EL_CDREGS, "m68k: prg bank: %i -> %i", (Pico_mcd->s68k_regs[a]>>6), ((d>>6)&3));\r
+        PicoMemRemapCD(Pico_mcd->s68k_regs[3]);\r
+      }\r
 #ifdef USE_POLL_DETECT\r
       if ((s68k_poll_adclk&0xfe) == 2 && s68k_poll_cnt > POLL_LIMIT) {\r
         SekSetStopS68k(0); s68k_poll_adclk = 0;\r
@@ -147,13 +132,13 @@ void m68k_reg_write8(u32 a, u32 d)
       }\r
 #endif\r
       return;\r
-    }\r
     case 6:\r
       Pico_mcd->bios[0x72 + 1] = d; // simple hint vector changer\r
       return;\r
     case 7:\r
       Pico_mcd->bios[0x72] = d;\r
-      dprintf("hint vector set to %08x", PicoRead32(0x70));\r
+      elprintf(EL_CDREGS, "hint vector set to %04x%04x",\r
+        ((u16 *)Pico_mcd->bios)[0x70/2], ((u16 *)Pico_mcd->bios)[0x72/2]);\r
       return;\r
     case 0xf:\r
       d = (d << 1) | ((d >> 7) & 1); // rol8 1 (special case)\r
@@ -229,14 +214,12 @@ u32 s68k_reg_read16(u32 a)
 {\r
   u32 d=0;\r
 \r
-  // dprintf("s68k_regs r%2i: [%02x] @ %06x", realsize&~1, a+(realsize&1), SekPcS68k);\r
-\r
   switch (a) {\r
     case 0:\r
       return ((Pico_mcd->s68k_regs[0]&3)<<8) | 1; // ver = 0, not in reset state\r
     case 2:\r
       d = (Pico_mcd->s68k_regs[2]<<8) | (Pico_mcd->s68k_regs[3]&0x1f);\r
-      r3printf(EL_STATUS, "s68k_regs r3: %02x @%06x", (u8)d, SekPcS68k);\r
+      elprintf(EL_CDREG3, "s68k_regs r3: %02x @%06x", (u8)d, SekPcS68k);\r
       return s68k_poll_detect(a, d);\r
     case 6:\r
       return CDC_Read_Reg();\r
@@ -244,10 +227,10 @@ u32 s68k_reg_read16(u32 a)
       return Read_CDC_Host(1); // Gens returns 0 here on byte reads\r
     case 0xC:\r
       d = Pico_mcd->m.timer_stopwatch >> 16;\r
-      dprintf("s68k stopwatch timer read (%04x)", d);\r
+      elprintf(EL_CDREGS, "s68k stopwatch timer read (%04x)", d);\r
       return d;\r
     case 0x30:\r
-      dprintf("s68k int3 timer read (%02x)", Pico_mcd->s68k_regs[31]);\r
+      elprintf(EL_CDREGS, "s68k int3 timer read (%02x)", Pico_mcd->s68k_regs[31]);\r
       return Pico_mcd->s68k_regs[31];\r
     case 0x34: // fader\r
       return 0; // no busy bit\r
@@ -278,42 +261,40 @@ static
 #endif\r
 void s68k_reg_write8(u32 a, u32 d)\r
 {\r
-  //dprintf("s68k_regs w%2i: [%02x] %02x @ %06x", realsize, a, d, SekPcS68k);\r
-\r
   // Warning: d might have upper bits set\r
   switch (a) {\r
     case 2:\r
       return; // only m68k can change WP\r
     case 3: {\r
       int dold = Pico_mcd->s68k_regs[3];\r
-      r3printf(EL_STATUS, "s68k_regs w3: %02x @%06x", (u8)d, SekPcS68k);\r
+      elprintf(EL_CDREG3, "s68k_regs w3: %02x @%06x", (u8)d, SekPcS68k);\r
       d &= 0x1d;\r
-      d |= dold&0xc2;\r
-      if (d&4)\r
+      d |= dold & 0xc2;\r
+      if (d & 4)\r
       {\r
         if ((d ^ dold) & 5) {\r
           d &= ~2; // in case of mode or bank change we clear DMNA (m68k req) bit\r
-          PicoMemResetCD(d);\r
+          PicoMemRemapCD(d);\r
         }\r
 #ifdef _ASM_CD_MEMORY_C\r
         if ((d ^ dold) & 0x1d)\r
           PicoMemResetCDdecode(d);\r
 #endif\r
         if (!(dold & 4)) {\r
-          r3printf(EL_STATUS, "wram mode 2M->1M");\r
+          elprintf(EL_CDREG3, "wram mode 2M->1M");\r
           wram_2M_to_1M(Pico_mcd->word_ram2M);\r
         }\r
       }\r
       else\r
       {\r
         if (dold & 4) {\r
-          r3printf(EL_STATUS, "wram mode 1M->2M");\r
+          elprintf(EL_CDREG3, "wram mode 1M->2M");\r
           if (!(d&1)) { // it didn't set the ret bit, which means it doesn't want to give WRAM to m68k\r
             d &= ~3;\r
             d |= (dold&1) ? 2 : 1; // then give it to the one which had bank0 in 1M mode\r
           }\r
           wram_1M_to_2M(Pico_mcd->word_ram2M);\r
-          PicoMemResetCD(d);\r
+          PicoMemRemapCD(d);\r
         }\r
         // s68k can only set RET, writing 0 has no effect\r
         else if ((dold ^ d) & d & 1) {   // RET being set\r
@@ -326,7 +307,7 @@ void s68k_reg_write8(u32 a, u32 d)
       break;\r
     }\r
     case 4:\r
-      dprintf("s68k CDC dest: %x", d&7);\r
+      elprintf(EL_CDREGS, "s68k CDC dest: %x", d&7);\r
       Pico_mcd->s68k_regs[4] = (Pico_mcd->s68k_regs[4]&0xC0) | (d&7); // CDC mode\r
       return;\r
     case 5:\r
@@ -336,22 +317,22 @@ void s68k_reg_write8(u32 a, u32 d)
       CDC_Write_Reg(d);\r
       return;\r
     case 0xa:\r
-      dprintf("s68k set CDC dma addr");\r
+      elprintf(EL_CDREGS, "s68k set CDC dma addr");\r
       break;\r
     case 0xc:\r
     case 0xd:\r
-      dprintf("s68k set stopwatch timer");\r
+      elprintf(EL_CDREGS, "s68k set stopwatch timer");\r
       Pico_mcd->m.timer_stopwatch = 0;\r
       return;\r
     case 0xe:\r
       Pico_mcd->s68k_regs[0xf] = (d>>1) | (d<<7); // ror8 1, Gens note: Dragons lair\r
       return;\r
     case 0x31:\r
-      dprintf("s68k set int3 timer: %02x", d);\r
+      elprintf(EL_CDREGS, "s68k set int3 timer: %02x", d);\r
       Pico_mcd->m.timer_int3 = (d & 0xff) << 16;\r
       break;\r
     case 0x33: // IRQ mask\r
-      dprintf("s68k irq mask: %02x", d);\r
+      elprintf(EL_CDREGS, "s68k irq mask: %02x", d);\r
       if ((d&(1<<4)) && (Pico_mcd->s68k_regs[0x37]&4) && !(Pico_mcd->s68k_regs[0x33]&(1<<4))) {\r
         CDD_Export_Status();\r
       }\r
@@ -384,438 +365,141 @@ void s68k_reg_write8(u32 a, u32 d)
   Pico_mcd->s68k_regs[a] = (u8) d;\r
 }\r
 \r
+// -----------------------------------------------------------------\r
+//                          Main 68k\r
+// -----------------------------------------------------------------\r
+\r
+#ifndef _ASM_CD_MEMORY_C\r
+#include "cell_map.c"\r
+#endif\r
 \r
-static u32 OtherRead16End(u32 a, int realsize)\r
+// WORD RAM, cell aranged area (220000 - 23ffff)\r
+static u32 PicoReadM68k8_cell(u32 a)\r
 {\r
-  u32 d=0;\r
+  int bank = Pico_mcd->s68k_regs[3] & 1;\r
+  a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
+  return Pico_mcd->word_ram1M[bank][a ^ 1];\r
+}\r
 \r
-#ifndef _ASM_CD_MEMORY_C\r
-  if ((a&0xffffc0)==0xa12000) {\r
-    d=m68k_reg_read16(a);\r
-    goto end;\r
-  }\r
+static u32 PicoReadM68k16_cell(u32 a)\r
+{\r
+  int bank = Pico_mcd->s68k_regs[3] & 1;\r
+  a = (a&2) | (cell_map(a >> 2) << 2);\r
+  return *(u16 *)(Pico_mcd->word_ram1M[bank] + a);\r
+}\r
 \r
-  if (a==0x400000) {\r
-    if (SRam.data != NULL) d=3; // 64k cart\r
-    goto end;\r
-  }\r
+static void PicoWriteM68k8_cell(u32 a, u32 d)\r
+{\r
+  int bank = Pico_mcd->s68k_regs[3] & 1;\r
+  a = (a&3) | (cell_map(a >> 2) << 2);\r
+  Pico_mcd->word_ram1M[bank][a ^ 1] = d;\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
+static void PicoWriteM68k16_cell(u32 a, u32 d)\r
+{\r
+  int bank = Pico_mcd->s68k_regs[3] & 1;\r
+  a = (a&3) | (cell_map(a >> 2) << 2);\r
+  *(u16 *)(Pico_mcd->word_ram1M[bank] + a) = d;\r
+}\r
+\r
+// RAM cart (40000 - 7fffff, optional)\r
+static u32 PicoReadM68k8_ramc(u32 a)\r
+{\r
+  u32 d = 0;\r
+  if (a == 0x400001) {\r
+    if (SRam.data != NULL)\r
+      d = 3; // 64k cart\r
+    return d;\r
   }\r
 \r
-  if (a==0x7ffffe) {\r
-    d=Pico_mcd->m.bcram_reg;\r
-    goto end;\r
+  if ((a & 0xfe0000) == 0x600000) {\r
+    if (SRam.data != NULL)\r
+      d = SRam.data[((a >> 1) & 0xffff) + 0x2000];\r
+    return d;\r
   }\r
-#endif\r
 \r
-  elprintf(EL_UIO, "m68k FIXME: unusual r%i: %06x @%06x", realsize&~1, (a&0xfffffe)+(realsize&1), SekPc);\r
+  if (a == 0x7fffff)\r
+    return Pico_mcd->m.bcram_reg;\r
 \r
-#ifndef _ASM_CD_MEMORY_C\r
-end:\r
-#endif\r
+  elprintf(EL_UIO, "m68k unmapped r8  [%06x] @%06x", a, SekPc);\r
   return d;\r
 }\r
 \r
-\r
-static void OtherWrite8End(u32 a, u32 d, int realsize)\r
+static u32 PicoReadM68k16_ramc(u32 a)\r
 {\r
-#ifndef _ASM_CD_MEMORY_C\r
-  if ((a&0xffffc0)==0xa12000) { m68k_reg_write8(a, d); return; }\r
+  elprintf(EL_ANOMALY, "ramcart r16: [%06x] @%06x", a, SekPcS68k);\r
+  return PicoReadM68k8_ramc(a + 1);\r
+}\r
 \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
+static void PicoWriteM68k8_ramc(u32 a, u32 d)\r
+{\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
+  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
+  elprintf(EL_UIO, "m68k unmapped w8  [%06x]   %02x @%06x", a, d & 0xff, SekPc);\r
 }\r
 \r
-#ifndef _ASM_CD_MEMORY_C\r
-#define _CD_MEMORY_C\r
-#undef _ASM_MEMORY_C\r
-#include "../memory_cmn.c"\r
-#include "cell_map.c"\r
-#endif\r
-\r
-\r
-// -----------------------------------------------------------------\r
-//                     Read Rom and read Ram\r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-u32 PicoReadM68k8(u32 a);\r
-#else\r
-u32 PicoReadM68k8(u32 a)\r
+static void PicoWriteM68k16_ramc(u32 a, u32 d)\r
 {\r
-  u32 d=0;\r
-\r
-  a&=0xffffff;\r
-\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=PicoVideoRead8(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 = *(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
-      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
-      break;\r
-  }\r
-\r
-\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
+  elprintf(EL_ANOMALY, "ramcart w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
+  PicoWriteM68k8_ramc(a + 1, d);\r
 }\r
-#endif\r
-\r
 \r
-#ifdef _ASM_CD_MEMORY_C\r
-u32 PicoReadM68k16(u32 a);\r
-#else\r
-static u32 PicoReadM68k16(u32 a)\r
+// IO/control/cd registers (a10000 - ...)\r
+static u32 PicoReadM68k8_io(u32 a)\r
 {\r
-  u32 d=0;\r
-\r
-  a&=0xfffffe;\r
-\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
-      d = OtherRead16(a, 16);\r
-\r
-      if ((a&0xffffc0)==0xa12000)\r
-        rdprintf("ret = %04x", d);\r
-      break;\r
-  }\r
-\r
-\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
+  u32 d;\r
+  if ((a & 0xff00) == 0x2000) { // a12000 - a120ff\r
+    d = m68k_reg_read16(a); // TODO: m68k_reg_read8\r
+    if (!(a & 1))\r
+      d >>= 8;\r
+    d &= 0xff;\r
+    elprintf(EL_CDREGS, "m68k_regs r8:  [%02x]   %02x @%06x", a & 0x3f, d, SekPc);\r
+    return d;\r
+  }\r
+\r
+  // fallback to default MD handler\r
+  return PicoRead8_io(a);\r
 }\r
-#endif\r
 \r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-u32 PicoReadM68k32(u32 a);\r
-#else\r
-static u32 PicoReadM68k32(u32 a)\r
+static u32 PicoReadM68k16_io(u32 a)\r
 {\r
-  u32 d=0;\r
-\r
-  a&=0xfffffe;\r
-\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
-        // 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
-      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
-    default:\r
-      if ((a&0xffffc0)==0xa12000)\r
-        rdprintf("m68k_regs r32: [%02x] @%06x", a&0x3f, SekPc);\r
-\r
-      d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r
-\r
-      if ((a&0xffffc0)==0xa12000)\r
-        rdprintf("ret = %08x", d);\r
-      break;\r
+  u32 d;\r
+  if ((a & 0xff00) == 0x2000) {\r
+    d = m68k_reg_read16(a);\r
+    elprintf(EL_CDREGS, "m68k_regs r16: [%02x] %04x @%06x", a & 0x3f, d, SekPc);\r
+    return d;\r
   }\r
 \r
-\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
+  return PicoRead16_io(a);\r
 }\r
-#endif\r
-\r
 \r
-// -----------------------------------------------------------------\r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-void PicoWriteM68k8(u32 a,u8 d);\r
-#else\r
-void PicoWriteM68k8(u32 a,u8 d)\r
+static void PicoWriteM68k8_io(u32 a, u32 d)\r
 {\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
-\r
-  if ((a&0xe00000)==0xe00000) { // Ram\r
-    *(u8 *)(Pico.ram+((a^1)&0xffff)) = d;\r
-    return;\r
-  }\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
-    *(u8 *)(prg_bank+((a^1)&0x1ffff))=d;\r
-    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
-    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
-      *(u8 *)(Pico_mcd->word_ram1M[bank]+(a^1))=d;\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      *(u8 *)(Pico_mcd->word_ram2M+((a^1)&0x3ffff))=d;\r
-    }\r
-    return;\r
-  }\r
-\r
-  if ((a&0xffffc0)==0xa12000) {\r
-    rdprintf("m68k_regs w8: [%02x] %02x @%06x", a&0x3f, d, SekPc);\r
+  if ((a & 0xff00) == 0x2000) { // a12000 - a120ff\r
+    elprintf(EL_CDREGS, "m68k_regs w8:  [%02x]   %02x @%06x", a&0x3f, d, SekPc);\r
     m68k_reg_write8(a, d);\r
     return;\r
   }\r
 \r
-  OtherWrite8(a,d);\r
+  PicoWrite16_io(a, d);\r
 }\r
-#endif\r
 \r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-void PicoWriteM68k16(u32 a,u16 d);\r
-#else\r
-static void PicoWriteM68k16(u32 a,u16 d)\r
+static void PicoWriteM68k16_io(u32 a, u32 d)\r
 {\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
-\r
-  if ((a&0xe00000)==0xe00000) { // Ram\r
-    *(u16 *)(Pico.ram+(a&0xfffe))=d;\r
-    return;\r
-  }\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 w16: [%i,%06x] %04x @%06x", Pico_mcd->s68k_regs[3]>>6, a, d, SekPc);\r
-    *(u16 *)(prg_bank+(a&0x1fffe))=d;\r
-    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
-    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
-      *(u16 *)(Pico_mcd->word_ram1M[bank]+a)=d;\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe))=d;\r
-    }\r
-    return;\r
-  }\r
-\r
-  // regs\r
-  if ((a&0xffffc0)==0xa12000) {\r
-    rdprintf("m68k_regs w16: [%02x] %04x @%06x", a&0x3f, d, SekPc);\r
+  if ((a & 0xff00) == 0x2000) { // a12000 - a120ff\r
+    elprintf(EL_CDREGS, "m68k_regs w16: [%02x] %04x @%06x", a&0x3f, d, SekPc);\r
+/* TODO FIXME?\r
     if (a == 0xe) { // special case, 2 byte writes would be handled differently\r
       Pico_mcd->s68k_regs[0xe] = d >> 8;\r
 #ifdef USE_POLL_DETECT\r
@@ -826,434 +510,95 @@ static void PicoWriteM68k16(u32 a,u16 d)
 #endif\r
       return;\r
     }\r
-    m68k_reg_write8(a,  d>>8);\r
-    m68k_reg_write8(a+1,d&0xff);\r
-    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
-\r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-void PicoWriteM68k32(u32 a,u32 d);\r
-#else\r
-static void PicoWriteM68k32(u32 a,u32 d)\r
-{\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
-  {\r
-    // Ram:\r
-    u16 *pm=(u16 *)(Pico.ram+(a&0xfffe));\r
-    pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
-    return;\r
-  }\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
-    pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
-    return;\r
-  }\r
-\r
-  a&=0xfffffe;\r
-\r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    if (d != 0) // don't log clears\r
-      wrdprintf("m68k_wram w32: [%06x] %08x @%06x", a, d, 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
-        u32 a1, a2;\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
-        *(u16 *)(Pico_mcd->word_ram1M[bank]+a1) = d >> 16;\r
-        *(u16 *)(Pico_mcd->word_ram1M[bank]+a2) = d;\r
-      } else {\r
-        u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
-        pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
-      }\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
-      pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
-    }\r
+*/\r
+    m68k_reg_write8(a,     d >> 8);\r
+    m68k_reg_write8(a + 1, d & 0xff);\r
     return;\r
   }\r
 \r
-  if ((a&0xffffc0)==0xa12000) {\r
-    rdprintf("m68k_regs w32: [%02x] %08x @%06x", a&0x3f, d, SekPc);\r
-    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
+  PicoWrite16_io(a, d);\r
 }\r
-#endif\r
-\r
 \r
 // -----------------------------------------------------------------\r
-//                            S68k\r
+//                           Sub 68k\r
 // -----------------------------------------------------------------\r
 \r
-#ifdef _ASM_CD_MEMORY_C\r
-u32 PicoReadS68k8(u32 a);\r
-#else\r
-static u32 PicoReadS68k8(u32 a)\r
+static u32 s68k_unmapped_read8(u32 a)\r
 {\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
-  if (a < 0x80000) {\r
-    d = *(Pico_mcd->prg_ram+(a^1));\r
-    goto end;\r
-  }\r
-\r
-  // regs\r
-  if ((a&0xfffe00) == 0xff8000) {\r
-    a &= 0x1ff;\r
-    rdprintf("s68k_regs r8: [%02x] @ %06x", a, SekPcS68k);\r
-    if (a >= 0x0e && a < 0x30) {\r
-      d = Pico_mcd->s68k_regs[a];\r
-      s68k_poll_detect(a, d);\r
-      rdprintf("ret = %02x", (u8)d);\r
-      goto end;\r
-    }\r
-    else if (a >= 0x58 && a < 0x68)\r
-         d = gfx_cd_read(a&~1);\r
-    else d = s68k_reg_read16(a&~1);\r
-    if ((a&1)==0) d>>=8;\r
-    rdprintf("ret = %02x", (u8)d);\r
-    goto end;\r
-  }\r
-\r
-  // word RAM (2M area)\r
-  if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    // test: batman returns\r
-    wrdprintf("s68k_wram2M r8: [%06x] @%06x", a, SekPcS68k);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
-      int bank = (Pico_mcd->s68k_regs[3]&1)^1;\r
-      d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
-      if (a&1) d &= 0x0f;\r
-      else d >>= 4;\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
-  }\r
-\r
-  // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
-    int bank;\r
-    wrdprintf("s68k_wram1M r8: [%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
-    d = Pico_mcd->word_ram1M[bank][(a^1)&0x1ffff];\r
-    wrdprintf("ret = %02x", (u8)d);\r
-    goto end;\r
-  }\r
-\r
-  // PCM\r
-  if ((a&0xff8000)==0xff0000) {\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
-    else if (a >= 0x20) {\r
-      a &= 0x1e;\r
-      d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
-      if (a & 2) d >>= 8;\r
-    }\r
-    elprintf(EL_IO, "ret = %02x", (u8)d);\r
-    goto end;\r
-  }\r
-\r
-  // bram\r
-  if ((a&0xff0000)==0xfe0000) {\r
-    d = Pico_mcd->bram[(a>>1)&0x1fff];\r
-    goto end;\r
-  }\r
-\r
-  elprintf(EL_UIO, "s68k r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPcS68k);\r
-\r
-  end:\r
-\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
+  elprintf(EL_UIO, "s68k unmapped r8  [%06x] @%06x", a, SekPc);\r
+  return 0;\r
 }\r
-#endif\r
-\r
 \r
-#ifdef _ASM_CD_MEMORY_C\r
-u32 PicoReadS68k16(u32 a);\r
-#else\r
-static u32 PicoReadS68k16(u32 a)\r
+static u32 s68k_unmapped_read16(u32 a)\r
 {\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
-  if (a < 0x80000) {\r
-    wrdprintf("s68k_prgram r16: [%06x] @%06x", a, SekPcS68k);\r
-    d = *(u16 *)(Pico_mcd->prg_ram+a);\r
-    wrdprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
-\r
-  // regs\r
-  if ((a&0xfffe00) == 0xff8000) {\r
-    a &= 0x1fe;\r
-    rdprintf("s68k_regs r16: [%02x] @ %06x", a, SekPcS68k);\r
-    if (a >= 0x58 && a < 0x68)\r
-         d = gfx_cd_read(a);\r
-    else d = s68k_reg_read16(a);\r
-    rdprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
-\r
-  // word RAM (2M area)\r
-  if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    wrdprintf("s68k_wram2M r16: [%06x] @%06x", a, SekPcS68k);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
-      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
-    } 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
-  }\r
-\r
-  // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
-    int bank;\r
-    wrdprintf("s68k_wram1M r16: [%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
-    d = *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
-    wrdprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
-\r
-  // bram\r
-  if ((a&0xff0000)==0xfe0000) {\r
-    dprintf("FIXME: s68k_bram r16: [%06x] @%06x", a, SekPcS68k);\r
-    a = (a>>1)&0x1fff;\r
-    d = Pico_mcd->bram[a++];           // Gens does little endian here, and so do we..\r
-    d|= Pico_mcd->bram[a++] << 8;      // This is most likely wrong\r
-    dprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
-\r
-  // PCM\r
-  if ((a&0xff8000)==0xff0000) {\r
-    dprintf("FIXME: s68k_pcm r16: [%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
-    else if (a >= 0x20) {\r
-      a &= 0x1e;\r
-      d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
-      if (a & 2) d >>= 8;\r
-    }\r
-    dprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
+  elprintf(EL_UIO, "s68k unmapped r16 [%06x] @%06x", a, SekPc);\r
+  return 0;\r
+}\r
 \r
-  elprintf(EL_UIO, "s68k r16: %06x, %04x  @%06x", a&0xffffff, d, SekPcS68k);\r
+static void s68k_unmapped_write8(u32 a, u32 d)\r
+{\r
+  elprintf(EL_UIO, "s68k unmapped w8  [%06x]   %02x @%06x", a, d & 0xff, SekPc);\r
+}\r
 \r
-  end:\r
+static void s68k_unmapped_write16(u32 a, u32 d)\r
+{\r
+  elprintf(EL_UIO, "s68k unmapped w16 [%06x] %04x @%06x", a, d & 0xffff, SekPc);\r
+}\r
 \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
+// decode (080000 - 0bffff, in 1M mode)\r
+static u32 PicoReadS68k8_dec(u32 a)\r
+{\r
+  u32 d, bank;\r
+  bank = (Pico_mcd->s68k_regs[3] & 1) ^ 1;\r
+  d = Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff];\r
+  if (a & 1)\r
+    d &= 0x0f;\r
+  else\r
+    d >>= 4;\r
   return d;\r
 }\r
-#endif\r
-\r
 \r
-#ifdef _ASM_CD_MEMORY_C\r
-u32 PicoReadS68k32(u32 a);\r
-#else\r
-static u32 PicoReadS68k32(u32 a)\r
+static u32 PicoReadS68k16_dec(u32 a)\r
 {\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
-  if (a < 0x80000) {\r
-    u16 *pm=(u16 *)(Pico_mcd->prg_ram+a);\r
-    d = (pm[0]<<16)|pm[1];\r
-    goto end;\r
-  }\r
-\r
-  // regs\r
-  if ((a&0xfffe00) == 0xff8000) {\r
-    a &= 0x1fe;\r
-    rdprintf("s68k_regs r32: [%02x] @ %06x", a, SekPcS68k);\r
-    if (a >= 0x58 && a < 0x68)\r
-         d = (gfx_cd_read(a)<<16)|gfx_cd_read(a+2);\r
-    else d = (s68k_reg_read16(a)<<16)|s68k_reg_read16(a+2);\r
-    rdprintf("ret = %08x", d);\r
-    goto end;\r
-  }\r
-\r
-  // word RAM (2M area)\r
-  if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    wrdprintf("s68k_wram2M r32: [%06x] @%06x", a, SekPcS68k);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
-      int bank = (Pico_mcd->s68k_regs[3]&1)^1;\r
-      a >>= 1;\r
-      d  = Pico_mcd->word_ram1M[bank][((a+0)^1)&0x1ffff] << 16;\r
-      d |= Pico_mcd->word_ram1M[bank][((a+1)^1)&0x1ffff];\r
-      d |= d << 4; d &= 0x0f0f0f0f;\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
-    }\r
-    wrdprintf("ret = %08x", d);\r
-    goto end;\r
-  }\r
-\r
-  // 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
-    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
-\r
-  // PCM\r
-  if ((a&0xff8000)==0xff0000) {\r
-    dprintf("s68k_pcm r32: [%06x] @%06x", a, SekPcS68k);\r
-    a &= 0x7fff;\r
-    if (a >= 0x2000) {\r
-      a >>= 1;\r
-      d  = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][a&0xfff] << 16;\r
-      d |= Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a+1)&0xfff];\r
-    } else if (a >= 0x20) {\r
-      a &= 0x1e;\r
-      if (a & 2) {\r
-        a >>= 2;\r
-        d  = (Pico_mcd->pcm.ch[a].addr >> (PCM_STEP_SHIFT-8)) & 0xff0000;\r
-        d |= (Pico_mcd->pcm.ch[(a+1)&7].addr >> PCM_STEP_SHIFT)   & 0xff;\r
-      } else {\r
-        d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
-        d = ((d<<16)&0xff0000) | ((d>>8)&0xff); // PCM chip is LE\r
-      }\r
-    }\r
-    dprintf("ret = %08x", d);\r
-    goto end;\r
-  }\r
-\r
-  // bram\r
-  if ((a&0xff0000)==0xfe0000) {\r
-    dprintf("FIXME: s68k_bram r32: [%06x] @%06x", a, SekPcS68k);\r
-    a = (a>>1)&0x1fff;\r
-    d = Pico_mcd->bram[a++] << 16;             // middle endian? TODO: verify against Fusion..\r
-    d|= Pico_mcd->bram[a++] << 24;\r
-    d|= Pico_mcd->bram[a++];\r
-    d|= Pico_mcd->bram[a++] << 8;\r
-    dprintf("ret = %08x", d);\r
-    goto end;\r
-  }\r
-\r
-  elprintf(EL_UIO, "s68k r32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
-\r
-  end:\r
-\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
+  u32 d, bank;\r
+  bank = (Pico_mcd->s68k_regs[3] & 1) ^ 1;\r
+  d = Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff];\r
+  d |= d << 4;\r
+  d &= ~0xf0;\r
   return d;\r
 }\r
-#endif\r
 \r
-\r
-#ifndef _ASM_CD_MEMORY_C\r
 /* check: jaguar xj 220 (draws entire world using decode) */\r
-static void decode_write8(u32 a, u8 d, int r3)\r
+static void PicoWriteS68k8_dec(u32 a, u32 d)\r
 {\r
-  u8 *pd = Pico_mcd->word_ram1M[(r3 & 1)^1] + (((a>>1)^1)&0x1ffff);\r
-  u8 oldmask = (a&1) ? 0xf0 : 0x0f;\r
+  u8 r3 = Pico_mcd->s68k_regs[3];\r
+  u8 *pd = &Pico_mcd->word_ram1M[(r3 & 1) ^ 1][((a >> 1) ^ 1) & 0x1ffff];\r
+  u8 oldmask = (a & 1) ? 0xf0 : 0x0f;\r
 \r
   r3 &= 0x18;\r
   d  &= 0x0f;\r
-  if (!(a&1)) d <<= 4;\r
+  if (!(a & 1))\r
+    d <<= 4;\r
 \r
   if (r3 == 8) {\r
-    if ((!(*pd & (~oldmask))) && d) goto do_it;\r
+    if ((!(*pd & (~oldmask))) && d)\r
+      goto do_it;\r
   } else if (r3 > 8) {\r
-    if (d) goto do_it;\r
-  } else {\r
+    if (d)\r
+      goto do_it;\r
+  } else\r
     goto do_it;\r
-  }\r
 \r
   return;\r
+\r
 do_it:\r
   *pd = d | (*pd & oldmask);\r
 }\r
 \r
-\r
-static void decode_write16(u32 a, u16 d, int r3)\r
+static void PicoWriteS68k16_dec(u32 a, u32 d)\r
 {\r
-  u8 *pd = Pico_mcd->word_ram1M[(r3 & 1)^1] + (((a>>1)^1)&0x1ffff);\r
+  u8 r3 = Pico_mcd->s68k_regs[3];\r
+  u8 *pd = &Pico_mcd->word_ram1M[(r3 & 1) ^ 1][((a >> 1) ^ 1) & 0x1ffff];\r
 \r
   //if ((a & 0x3ffff) < 0x28000) return;\r
 \r
@@ -1275,279 +620,173 @@ static void decode_write16(u32 a, u16 d, int r3)
     *pd = d;\r
   }\r
 }\r
-#endif\r
 \r
-// -----------------------------------------------------------------\r
+// backup RAM (fe0000 - feffff)\r
+static u32 PicoReadS68k8_bram(u32 a)\r
+{\r
+  return Pico_mcd->bram[(a>>1)&0x1fff];\r
+}\r
 \r
-#ifdef _ASM_CD_MEMORY_C\r
-void PicoWriteS68k8(u32 a,u8 d);\r
-#else\r
-static void PicoWriteS68k8(u32 a,u8 d)\r
+static u32 PicoReadS68k16_bram(u32 a)\r
 {\r
-  elprintf(EL_IO, "s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
+  u32 d;\r
+  elprintf(EL_ANOMALY, "FIXME: s68k_bram r16: [%06x] @%06x", a, SekPcS68k);\r
+  a = (a >> 1) & 0x1fff;\r
+  d = Pico_mcd->bram[a++];\r
+  d|= Pico_mcd->bram[a++] << 8; // probably wrong, TODO: verify\r
+  return d;\r
+}\r
 \r
-  a&=0xffffff;\r
+static void PicoWriteS68k8_bram(u32 a, u32 d)\r
+{\r
+  Pico_mcd->bram[(a >> 1) & 0x1fff] = d;\r
+  SRam.changed = 1;\r
+}\r
 \r
-#ifdef EMU_CORE_DEBUG\r
-  lastwrite_cyc_d[lwp_cyc++&15] = d;\r
-#endif\r
+static void PicoWriteS68k16_bram(u32 a, u32 d)\r
+{\r
+  elprintf(EL_ANOMALY, "s68k_bram w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
+  a = (a >> 1) & 0x1fff;\r
+  Pico_mcd->bram[a++] = d;\r
+  Pico_mcd->bram[a++] = d >> 8; // TODO: verify..\r
+  SRam.changed = 1;\r
+}\r
 \r
-  // prg RAM\r
-  if (a < 0x80000) {\r
-    u8 *pm=(u8 *)(Pico_mcd->prg_ram+(a^1));\r
-    if (a >= (Pico_mcd->s68k_regs[2]<<8)) *pm=d;\r
-    return;\r
-  }\r
+// PCM and registers (ff0000 - ffffff)\r
+static u32 PicoReadS68k8_pr(u32 a)\r
+{\r
+  u32 d = 0;\r
 \r
   // regs\r
-  if ((a&0xfffe00) == 0xff8000) {\r
+  if ((a & 0xfe00) == 0x8000) {\r
     a &= 0x1ff;\r
-    rdprintf("s68k_regs w8: [%02x] %02x @ %06x", a, d, SekPcS68k);\r
-    if (a >= 0x58 && a < 0x68)\r
-         gfx_cd_write16(a&~1, (d<<8)|d);\r
-    else s68k_reg_write8(a,d);\r
-    return;\r
-  }\r
-\r
-  // word RAM (2M area)\r
-  if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    int r3 = Pico_mcd->s68k_regs[3];\r
-    wrdprintf("s68k_wram2M w8: [%06x] %02x @%06x", a, d, SekPcS68k);\r
-    if (r3 & 4) { // 1M decode mode?\r
-      decode_write8(a, d, r3);\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      *(u8 *)(Pico_mcd->word_ram2M+((a^1)&0x3ffff))=d;\r
+    elprintf(EL_CDREGS, "s68k_regs r8: [%02x] @ %06x", a, SekPcS68k);\r
+    if (a >= 0x0e && a < 0x30) {\r
+      d = Pico_mcd->s68k_regs[a];\r
+      s68k_poll_detect(a, d);\r
+      elprintf(EL_CDREGS, "ret = %02x", (u8)d);\r
+      return d;\r
     }\r
-    return;\r
-  }\r
-\r
-  // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
-    // Wing Commander tries to write here in wrong mode\r
-    int bank;\r
-    if (d)\r
-      wrdprintf("s68k_wram1M w8: [%06x] %02x @%06x", a, d, 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
-    *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff))=d;\r
-    return;\r
+    else if (a >= 0x58 && a < 0x68)\r
+         d = gfx_cd_read(a & ~1);\r
+    else d = s68k_reg_read16(a & ~1);\r
+    if (!(a & 1))\r
+      d >>= 8;\r
+    elprintf(EL_CDREGS, "ret = %02x", (u8)d);\r
+    return d & 0xff;\r
   }\r
 \r
   // PCM\r
-  if ((a&0xff8000)==0xff0000) {\r
+  if ((a & 0x8000) == 0x0000) {\r
     a &= 0x7fff;\r
     if (a >= 0x2000)\r
-      Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
-    else if (a < 0x12)\r
-      pcm_write(a>>1, d);\r
-    return;\r
-  }\r
-\r
-  // bram\r
-  if ((a&0xff0000)==0xfe0000) {\r
-    Pico_mcd->bram[(a>>1)&0x1fff] = d;\r
-    SRam.changed = 1;\r
-    return;\r
+      d = Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a >> 1) & 0xfff];\r
+    else if (a >= 0x20) {\r
+      a &= 0x1e;\r
+      d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
+      if (a & 2)\r
+        d >>= 8;\r
+    }\r
+    return d & 0xff;\r
   }\r
 \r
-  elprintf(EL_UIO, "s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
+  return s68k_unmapped_read8(a);\r
 }\r
-#endif\r
 \r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-void PicoWriteS68k16(u32 a,u16 d);\r
-#else\r
-static void PicoWriteS68k16(u32 a,u16 d)\r
+static u32 PicoReadS68k16_pr(u32 a)\r
 {\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
-    if (a >= (Pico_mcd->s68k_regs[2]<<8)) // needed for Dungeon Explorer\r
-      *(u16 *)(Pico_mcd->prg_ram+a)=d;\r
-    return;\r
-  }\r
+  u32 d = 0;\r
 \r
   // regs\r
-  if ((a&0xfffe00) == 0xff8000) {\r
+  if ((a & 0xfe00) == 0x8000) {\r
     a &= 0x1fe;\r
-    rdprintf("s68k_regs w16: [%02x] %04x @ %06x", a, d, SekPcS68k);\r
-    if (a >= 0x58 && a < 0x68)\r
-      gfx_cd_write16(a, d);\r
-    else {\r
-      if (a == 0xe) { // special case, 2 byte writes would be handled differently\r
-        Pico_mcd->s68k_regs[0xf] = d;\r
-        return;\r
-      }\r
-      s68k_reg_write8(a,  d>>8);\r
-      s68k_reg_write8(a+1,d&0xff);\r
-    }\r
-    return;\r
+    elprintf(EL_CDREGS, "s68k_regs r16: [%02x] @ %06x", a, SekPcS68k);\r
+    if (0x58 <= a && a < 0x68)\r
+         d = gfx_cd_read(a);\r
+    else d = s68k_reg_read16(a);\r
+    elprintf(EL_CDREGS, "ret = %04x", d);\r
+    return d;\r
   }\r
 \r
-  // word RAM (2M area)\r
-  if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    int r3 = Pico_mcd->s68k_regs[3];\r
-    wrdprintf("s68k_wram2M w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
-    if (r3 & 4) { // 1M decode mode?\r
-      decode_write16(a, d, r3);\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe))=d;\r
+  // PCM\r
+  if ((a & 0x8000) == 0x0000) {\r
+    //elprintf(EL_ANOMALY, "FIXME: s68k_pcm r16: [%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
+    else if (a >= 0x20) {\r
+      a &= 0x1e;\r
+      d = Pico_mcd->pcm.ch[a>>2].addr >> PCM_STEP_SHIFT;\r
+      if (a & 2) d >>= 8;\r
     }\r
-    return;\r
+    elprintf(EL_CDREGS, "ret = %04x", d);\r
+    return d;\r
   }\r
 \r
-  // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
-    int bank;\r
-    if (d)\r
-      wrdprintf("s68k_wram1M w16: [%06x] %04x @%06x", a, d, 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 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe))=d;\r
+  return s68k_unmapped_read16(a);\r
+}\r
+\r
+static void PicoWriteS68k8_pr(u32 a, u32 d)\r
+{\r
+  // regs\r
+  if ((a & 0xfe00) == 0x8000) {\r
+    a &= 0x1ff;\r
+    elprintf(EL_CDREGS, "s68k_regs w8: [%02x] %02x @ %06x", a, d, SekPcS68k);\r
+    if (0x58 <= a && a < 0x68)\r
+         gfx_cd_write16(a&~1, (d<<8)|d);\r
+    else s68k_reg_write8(a,d);\r
     return;\r
   }\r
 \r
   // PCM\r
-  if ((a&0xff8000)==0xff0000) {\r
+  if ((a & 0x8000) == 0x0000) {\r
     a &= 0x7fff;\r
     if (a >= 0x2000)\r
       Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
     else if (a < 0x12)\r
-      pcm_write(a>>1, d & 0xff);\r
-    return;\r
-  }\r
-\r
-  // bram\r
-  if ((a&0xff0000)==0xfe0000) {\r
-    dprintf("s68k_bram w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
-    a = (a>>1)&0x1fff;\r
-    Pico_mcd->bram[a++] = d;           // Gens does little endian here, an so do we..\r
-    Pico_mcd->bram[a++] = d >> 8;\r
-    SRam.changed = 1;\r
+      pcm_write(a>>1, d);\r
     return;\r
   }\r
 \r
-  elprintf(EL_UIO, "s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
+  s68k_unmapped_write8(a, d);\r
 }\r
-#endif\r
 \r
-\r
-#ifdef _ASM_CD_MEMORY_C\r
-void PicoWriteS68k32(u32 a,u32 d);\r
-#else\r
-static void PicoWriteS68k32(u32 a,u32 d)\r
+static void PicoWriteS68k16_pr(u32 a, u32 d)\r
 {\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
-      u16 *pm=(u16 *)(Pico_mcd->prg_ram+a);\r
-      pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
-    }\r
-    return;\r
-  }\r
-\r
   // regs\r
-  if ((a&0xfffe00) == 0xff8000) {\r
+  if ((a & 0xfe00) == 0x8000) {\r
     a &= 0x1fe;\r
-    rdprintf("s68k_regs w32: [%02x] %08x @ %06x", a, d, SekPcS68k);\r
-    if (a >= 0x58 && a < 0x68) {\r
-      gfx_cd_write16(a,   d>>16);\r
-      gfx_cd_write16(a+2, d&0xffff);\r
-    } else {\r
-      if ((a&0x1fe) == 0xe) dprintf("s68k FIXME: w32 [%02x]", a&0x3f);\r
-      s68k_reg_write8(a,   d>>24);\r
-      s68k_reg_write8(a+1,(d>>16)&0xff);\r
-      s68k_reg_write8(a+2,(d>>8) &0xff);\r
-      s68k_reg_write8(a+3, d     &0xff);\r
-    }\r
-    return;\r
-  }\r
-\r
-  // word RAM (2M area)\r
-  if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    int r3 = Pico_mcd->s68k_regs[3];\r
-    wrdprintf("s68k_wram2M w32: [%06x] %08x @%06x", a, d, SekPcS68k);\r
-    if (r3 & 4) { // 1M decode mode?\r
-      decode_write16(a  , d >> 16, r3);\r
-      decode_write16(a+2, d      , r3);\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
-      pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
+    elprintf(EL_CDREGS, "s68k_regs w16: [%02x] %04x @ %06x", a, d, SekPcS68k);\r
+    if (a >= 0x58 && a < 0x68)\r
+      gfx_cd_write16(a, d);\r
+    else {\r
+      if (a == 0xe) {\r
+        // special case, 2 byte writes would be handled differently\r
+        // TODO: verify\r
+        Pico_mcd->s68k_regs[0xf] = d;\r
+        return;\r
+      }\r
+      s68k_reg_write8(a,     d >> 8);\r
+      s68k_reg_write8(a + 1, d & 0xff);\r
     }\r
     return;\r
   }\r
 \r
-  // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
-    int bank;\r
-    u16 *pm;\r
-    if (d)\r
-      wrdprintf("s68k_wram1M w32: [%06x] %08x @%06x", a, d, 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
-    pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
-    pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
-    return;\r
-  }\r
-\r
   // PCM\r
-  if ((a&0xff8000)==0xff0000) {\r
+  if ((a & 0x8000) == 0x0000) {\r
     a &= 0x7fff;\r
-    if (a >= 0x2000) {\r
-      a >>= 1;\r
-      Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][a&0xfff] = (d >> 16);\r
-      Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a+1)&0xfff] = d;\r
-    } else if (a < 0x12) {\r
-      a >>= 1;\r
-      pcm_write(a,  (d>>16) & 0xff);\r
-      pcm_write(a+1, d & 0xff);\r
-    }\r
-    return;\r
-  }\r
-\r
-  // bram\r
-  if ((a&0xff0000)==0xfe0000) {\r
-    dprintf("s68k_bram w32: [%06x] %08x @%06x", a, d, SekPcS68k);\r
-    a = (a>>1)&0x1fff;\r
-    Pico_mcd->bram[a++] = d >> 16;             // middle endian? verify?\r
-    Pico_mcd->bram[a++] = d >> 24;\r
-    Pico_mcd->bram[a++] = d;\r
-    Pico_mcd->bram[a++] = d >> 8;\r
-    SRam.changed = 1;\r
+    if (a >= 0x2000)\r
+      Pico_mcd->pcm_ram_b[Pico_mcd->pcm.bank][(a>>1)&0xfff] = d;\r
+    else if (a < 0x12)\r
+      pcm_write(a>>1, d & 0xff);\r
     return;\r
   }\r
 \r
-  elprintf(EL_UIO, "s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
+  s68k_unmapped_write16(a, d);\r
 }\r
-#endif\r
-\r
 \r
 // -----------------------------------------------------------------\r
 \r
-\r
 #ifdef EMU_C68K\r
 static __inline int PicoMemBaseM68k(u32 pc)\r
 {\r
@@ -1616,9 +855,45 @@ static u32 PicoCheckPcS68k(u32 pc)
 }\r
 #endif\r
 \r
-#ifndef _ASM_CD_MEMORY_C\r
-void PicoMemResetCD(int r3)\r
+// TODO: probably split\r
+void PicoMemRemapCD(int r3)\r
 {\r
+  void *bank;\r
+\r
+  // PRG RAM\r
+  if (Pico_mcd->m.busreq & 2) {\r
+    bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3] >> 6];\r
+    cpu68k_map_all_ram(0x020000, 0x03ffff, bank, 0);\r
+  }\r
+  else {\r
+    m68k_map_unmap(0x020000, 0x03ffff);\r
+  }\r
+\r
+  // WORD RAM\r
+  if (!(r3 & 4)) {\r
+    // 2M mode. XXX: allowing access in all cases for simplicity\r
+    bank = Pico_mcd->word_ram2M;\r
+    cpu68k_map_all_ram(0x200000, 0x23ffff, bank, 0);\r
+    cpu68k_map_all_ram(0x080000, 0x0bffff, bank, 1);\r
+    // TODO: handle 0x0c0000\r
+  }\r
+  else {\r
+    bank = Pico_mcd->word_ram1M[r3 & 1];\r
+    cpu68k_map_all_ram(0x200000, 0x21ffff, bank, 0);\r
+    bank = Pico_mcd->word_ram1M[(r3 & 1) ^ 1];\r
+    cpu68k_map_all_ram(0x0c0000, 0x0effff, bank, 1);\r
+    // "cell arrange" on m68k\r
+    cpu68k_map_set(m68k_read8_map,   0x220000, 0x23ffff, PicoReadM68k8_cell, 1);\r
+    cpu68k_map_set(m68k_read16_map,  0x220000, 0x23ffff, PicoReadM68k16_cell, 1);\r
+    cpu68k_map_set(m68k_write8_map,  0x220000, 0x23ffff, PicoWriteM68k8_cell, 1);\r
+    cpu68k_map_set(m68k_write16_map, 0x220000, 0x23ffff, PicoWriteM68k16_cell, 1);\r
+    // "decode format" on s68k\r
+    cpu68k_map_set(s68k_read8_map,   0x080000, 0x0bffff, PicoReadS68k8_dec, 1);\r
+    cpu68k_map_set(s68k_read16_map,  0x080000, 0x0bffff, PicoReadS68k16_dec, 1);\r
+    cpu68k_map_set(s68k_write8_map,  0x080000, 0x0bffff, PicoWriteS68k8_dec, 1);\r
+    cpu68k_map_set(s68k_write16_map, 0x080000, 0x0bffff, PicoWriteS68k16_dec, 1);\r
+  }\r
+\r
 #ifdef EMU_F68K\r
   // update fetchmap..\r
   int i;\r
@@ -1636,7 +911,6 @@ void PicoMemResetCD(int r3)
   }\r
 #endif\r
 }\r
-#endif\r
 \r
 #ifdef EMU_M68K\r
 static void m68k_mem_setup_cd(void);\r
@@ -1644,43 +918,69 @@ static void m68k_mem_setup_cd(void);
 \r
 PICO_INTERNAL void PicoMemSetupCD(void)\r
 {\r
-  // additional handlers for common code\r
-  PicoRead16Hook = OtherRead16End;\r
-  PicoWrite8Hook = OtherWrite8End;\r
+  // setup default main68k map\r
+  PicoMemSetup();\r
+\r
+  // PicoMemRemapCD() will set up RAMs, so not done here\r
+\r
+  // main68k map (BIOS mapped by PicoMemSetup()):\r
+  // RAM cart\r
+  if (PicoOpt & POPT_EN_MCD_RAMCART) {\r
+    cpu68k_map_set(m68k_read8_map,   0x400000, 0x7fffff, PicoReadM68k8_ramc, 1);\r
+    cpu68k_map_set(m68k_read16_map,  0x400000, 0x7fffff, PicoReadM68k16_ramc, 1);\r
+    cpu68k_map_set(m68k_write8_map,  0x400000, 0x7fffff, PicoWriteM68k8_ramc, 1);\r
+    cpu68k_map_set(m68k_write16_map, 0x400000, 0x7fffff, PicoWriteM68k16_ramc, 1);\r
+  }\r
+\r
+  // registers/IO:\r
+  cpu68k_map_set(m68k_read8_map,   0xa10000, 0xa1ffff, PicoReadM68k8_io, 1);\r
+  cpu68k_map_set(m68k_read16_map,  0xa10000, 0xa1ffff, PicoReadM68k16_io, 1);\r
+  cpu68k_map_set(m68k_write8_map,  0xa10000, 0xa1ffff, PicoWriteM68k8_io, 1);\r
+  cpu68k_map_set(m68k_write16_map, 0xa10000, 0xa1ffff, PicoWriteM68k16_io, 1);\r
+\r
+  // sub68k map\r
+  cpu68k_map_set(s68k_read8_map,   0x000000, 0xffffff, s68k_unmapped_read8, 1);\r
+  cpu68k_map_set(s68k_read16_map,  0x000000, 0xffffff, s68k_unmapped_read16, 1);\r
+  cpu68k_map_set(s68k_write8_map,  0x000000, 0xffffff, s68k_unmapped_write8, 1);\r
+  cpu68k_map_set(s68k_write16_map, 0x000000, 0xffffff, s68k_unmapped_write16, 1);\r
+\r
+  // PRG RAM\r
+  cpu68k_map_set(s68k_read8_map,   0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
+  cpu68k_map_set(s68k_read16_map,  0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
+  cpu68k_map_set(s68k_write8_map,  0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
+  cpu68k_map_set(s68k_write16_map, 0x000000, 0x07ffff, Pico_mcd->prg_ram, 0);\r
+\r
+  // BRAM\r
+  cpu68k_map_set(s68k_read8_map,   0xfe0000, 0xfeffff, PicoReadS68k8_bram, 1);\r
+  cpu68k_map_set(s68k_read16_map,  0xfe0000, 0xfeffff, PicoReadS68k16_bram, 1);\r
+  cpu68k_map_set(s68k_write8_map,  0xfe0000, 0xfeffff, PicoWriteS68k8_bram, 1);\r
+  cpu68k_map_set(s68k_write16_map, 0xfe0000, 0xfeffff, PicoWriteS68k16_bram, 1);\r
+\r
+  // PCM, regs\r
+  cpu68k_map_set(s68k_read8_map,   0xff0000, 0xffffff, PicoReadS68k8_pr, 1);\r
+  cpu68k_map_set(s68k_read16_map,  0xff0000, 0xffffff, PicoReadS68k16_pr, 1);\r
+  cpu68k_map_set(s68k_write8_map,  0xff0000, 0xffffff, PicoWriteS68k8_pr, 1);\r
+  cpu68k_map_set(s68k_write16_map, 0xff0000, 0xffffff, PicoWriteS68k16_pr, 1);\r
 \r
 #ifdef EMU_C68K\r
-  // Setup m68k memory callbacks:\r
-  PicoCpuCM68k.checkpc=PicoCheckPcM68k;\r
-  PicoCpuCM68k.fetch8 =PicoCpuCM68k.read8 =PicoReadM68k8;\r
-  PicoCpuCM68k.fetch16=PicoCpuCM68k.read16=PicoReadM68k16;\r
-  PicoCpuCM68k.fetch32=PicoCpuCM68k.read32=PicoReadM68k32;\r
-  PicoCpuCM68k.write8 =PicoWriteM68k8;\r
-  PicoCpuCM68k.write16=PicoWriteM68k16;\r
-  PicoCpuCM68k.write32=PicoWriteM68k32;\r
+  PicoCpuCM68k.checkpc = PicoCheckPcM68k;\r
   // s68k\r
-  PicoCpuCS68k.checkpc=PicoCheckPcS68k;\r
-  PicoCpuCS68k.fetch8 =PicoCpuCS68k.read8 =PicoReadS68k8;\r
-  PicoCpuCS68k.fetch16=PicoCpuCS68k.read16=PicoReadS68k16;\r
-  PicoCpuCS68k.fetch32=PicoCpuCS68k.read32=PicoReadS68k32;\r
-  PicoCpuCS68k.write8 =PicoWriteS68k8;\r
-  PicoCpuCS68k.write16=PicoWriteS68k16;\r
-  PicoCpuCS68k.write32=PicoWriteS68k32;\r
+  PicoCpuCS68k.checkpc = PicoCheckPcS68k;\r
+  PicoCpuCS68k.fetch8  = PicoCpuCS68k.read8  = s68k_read8;\r
+  PicoCpuCS68k.fetch16 = PicoCpuCS68k.read16 = s68k_read16;\r
+  PicoCpuCS68k.fetch32 = PicoCpuCS68k.read32 = s68k_read32;\r
+  PicoCpuCS68k.write8  = s68k_write8;\r
+  PicoCpuCS68k.write16 = s68k_write16;\r
+  PicoCpuCS68k.write32 = s68k_write32;\r
 #endif\r
 #ifdef EMU_F68K\r
-  // m68k\r
-  PicoCpuFM68k.read_byte =PicoReadM68k8;\r
-  PicoCpuFM68k.read_word =PicoReadM68k16;\r
-  PicoCpuFM68k.read_long =PicoReadM68k32;\r
-  PicoCpuFM68k.write_byte=PicoWriteM68k8;\r
-  PicoCpuFM68k.write_word=PicoWriteM68k16;\r
-  PicoCpuFM68k.write_long=PicoWriteM68k32;\r
   // s68k\r
-  PicoCpuFS68k.read_byte =PicoReadS68k8;\r
-  PicoCpuFS68k.read_word =PicoReadS68k16;\r
-  PicoCpuFS68k.read_long =PicoReadS68k32;\r
-  PicoCpuFS68k.write_byte=PicoWriteS68k8;\r
-  PicoCpuFS68k.write_word=PicoWriteS68k16;\r
-  PicoCpuFS68k.write_long=PicoWriteS68k32;\r
+  PicoCpuFS68k.read_byte  = s68k_read8;\r
+  PicoCpuFS68k.read_word  = s68k_read16;\r
+  PicoCpuFS68k.read_long  = s68k_read32;\r
+  PicoCpuFS68k.write_byte = s68k_write8;\r
+  PicoCpuFS68k.write_word = s68k_write16;\r
+  PicoCpuFS68k.write_long = s68k_write32;\r
 \r
   // setup FAME fetchmap\r
   {\r
@@ -1705,13 +1005,12 @@ PICO_INTERNAL void PicoMemSetupCD(void)
     // WORD RAM 2M area\r
     for (i = M68K_FETCHBANK1*0x08/0x100; i < M68K_FETCHBANK1 && (i<<(24-FAMEC_FETCHBITS)) < 0xc0000; i++)\r
       PicoCpuFS68k.Fetch[i] = (unsigned int)Pico_mcd->word_ram2M - 0x80000;\r
-    // PicoMemResetCD() will setup word ram for both\r
+    // PicoMemRemapCD() will setup word ram for both\r
   }\r
 #endif\r
 #ifdef EMU_M68K\r
   m68k_mem_setup_cd();\r
 #endif\r
-  z80_mem_setup();\r
 \r
   // m68k_poll_addr = m68k_poll_cnt = 0;\r
   s68k_poll_adclk = s68k_poll_cnt = 0;\r
@@ -1719,23 +1018,30 @@ PICO_INTERNAL void PicoMemSetupCD(void)
 \r
 \r
 #ifdef EMU_M68K\r
+u32  m68k_read8(u32 a);\r
+u32  m68k_read16(u32 a);\r
+u32  m68k_read32(u32 a);\r
+void m68k_write8(u32 a, u8 d);\r
+void m68k_write16(u32 a, u16 d);\r
+void m68k_write32(u32 a, u32 d);\r
+\r
 static unsigned int PicoReadCD8w (unsigned int a) {\r
-       return m68ki_cpu_p == &PicoCpuMS68k ? PicoReadS68k8(a) : PicoReadM68k8(a);\r
+       return m68ki_cpu_p == &PicoCpuMS68k ? s68k_read8(a) : m68k_read8(a);\r
 }\r
 static unsigned int PicoReadCD16w(unsigned int a) {\r
-       return m68ki_cpu_p == &PicoCpuMS68k ? PicoReadS68k16(a) : PicoReadM68k16(a);\r
+       return m68ki_cpu_p == &PicoCpuMS68k ? s68k_read16(a) : m68k_read16(a);\r
 }\r
 static unsigned int PicoReadCD32w(unsigned int a) {\r
-       return m68ki_cpu_p == &PicoCpuMS68k ? PicoReadS68k32(a) : PicoReadM68k32(a);\r
+       return m68ki_cpu_p == &PicoCpuMS68k ? s68k_read32(a) : m68k_read32(a);\r
 }\r
 static void PicoWriteCD8w (unsigned int a, unsigned char d) {\r
-       if (m68ki_cpu_p == &PicoCpuMS68k) PicoWriteS68k8(a, d); else PicoWriteM68k8(a, d);\r
+       if (m68ki_cpu_p == &PicoCpuMS68k) s68k_write8(a, d); else m68k_write8(a, d);\r
 }\r
 static void PicoWriteCD16w(unsigned int a, unsigned short d) {\r
-       if (m68ki_cpu_p == &PicoCpuMS68k) PicoWriteS68k16(a, d); else PicoWriteM68k16(a, d);\r
+       if (m68ki_cpu_p == &PicoCpuMS68k) s68k_write16(a, d); else m68k_write16(a, d);\r
 }\r
 static void PicoWriteCD32w(unsigned int a, unsigned int d) {\r
-       if (m68ki_cpu_p == &PicoCpuMS68k) PicoWriteS68k32(a, d); else PicoWriteM68k32(a, d);\r
+       if (m68ki_cpu_p == &PicoCpuMS68k) s68k_write32(a, d); else m68k_write32(a, d);\r
 }\r
 \r
 // these are allowed to access RAM\r