gfx_cd finished, bugfixes
[picodrive.git] / Pico / cd / Memory.c
index 890af0a..0b11e98 100644 (file)
 #include "gfx_cd.h"\r
 #include "pcm.h"\r
 \r
-#include "cell_map.c"\r
-\r
 typedef unsigned char  u8;\r
 typedef unsigned short u16;\r
 typedef unsigned int   u32;\r
 \r
 //#define __debug_io\r
 //#define __debug_io2\r
+\r
 //#define rdprintf dprintf\r
 #define rdprintf(...)\r
+//#define wrdprintf dprintf\r
+#define wrdprintf(...)\r
 \r
 // -----------------------------------------------------------------\r
 \r
 \r
+#ifndef _ASM_CD_MEMORY_C\r
 static u32 m68k_reg_read16(u32 a)\r
 {\r
   u32 d=0;\r
@@ -51,7 +53,7 @@ static u32 m68k_reg_read16(u32 a)
       d = Pico_mcd->s68k_regs[4]<<8;\r
       goto end;\r
     case 6:\r
-      d = Pico_mcd->m.hint_vector;\r
+      d = *(u16 *)(Pico_mcd->bios + 0x72);\r
       goto end;\r
     case 8:\r
       d = Read_CDC_Host(0);\r
@@ -60,8 +62,8 @@ static u32 m68k_reg_read16(u32 a)
       dprintf("m68k FIXME: reserved read");\r
       goto end;\r
     case 0xC:\r
-      dprintf("m68k stopwatch timer read");\r
       d = Pico_mcd->m.timer_stopwatch >> 16;\r
+      dprintf("m68k stopwatch timer read (%04x)", d);\r
       goto end;\r
   }\r
 \r
@@ -78,8 +80,12 @@ end:
   // dprintf("ret = %04x", d);\r
   return d;\r
 }\r
+#endif\r
 \r
-static void m68k_reg_write8(u32 a, u32 d)\r
+#ifndef _ASM_CD_MEMORY_C\r
+static\r
+#endif\r
+void m68k_reg_write8(u32 a, u32 d)\r
 {\r
   a &= 0x3f;\r
   // dprintf("m68k_regs w%2i: [%02x] %02x @%06x", realsize, a, d, SekPc);\r
@@ -96,34 +102,44 @@ static void m68k_reg_write8(u32 a, u32 d)
       if ( (Pico_mcd->m.busreq&2) != (d&2)) dprintf("m68k: s68k brq %i", (d&2)>>1);\r
       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
+        Pico_mcd->m.state_flags&=~1;\r
+        dprintf("m68k: resetting s68k, cycles=%i", SekCyclesLeft);\r
       }\r
       Pico_mcd->m.busreq = d;\r
       return;\r
     case 2:\r
       Pico_mcd->s68k_regs[2] = d; // really use s68k side register\r
       return;\r
-    case 3:\r
+    case 3: {\r
+      u32 dold = Pico_mcd->s68k_regs[3]&0x1f;\r
       dprintf("m68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
       d &= 0xc2;\r
-      if ((Pico_mcd->s68k_regs[3]>>6) != ((d>>6)&3))\r
+      if ((dold>>6) != ((d>>6)&3))\r
         dprintf("m68k: prg bank: %i -> %i", (Pico_mcd->s68k_regs[a]>>6), ((d>>6)&3));\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
-      d |= Pico_mcd->s68k_regs[3]&0x1d;\r
-      if (!(d & 4) && (d & 2)) d &= ~1; // return word RAM to s68k in 2M mode\r
-      Pico_mcd->s68k_regs[3] = d; // really use s68k side register\r
+      if (dold & 4) {\r
+        d ^= 2;                // writing 0 to DMNA actually sets it, 1 does nothing\r
+      } else {\r
+        //dold &= ~2; // ??\r
+        if (d & 2) dold &= ~1; // return word RAM to s68k in 2M mode\r
+      }\r
+      Pico_mcd->s68k_regs[3] = d | dold; // really use s68k side register\r
+\r
+/*\r
+     d |= Pico_mcd->s68k_regs[3]&0x1d;\r
+     if (!(d & 4) && (d & 2)) d &= ~1; // return word RAM to s68k in 2M mode\r
+     Pico_mcd->s68k_regs[3] = d; // really use s68k side register\r
+*/\r
       return;\r
+    }\r
     case 6:\r
-      dprintf("FIXME hint[2]: %02x @%06x", (u8)d, SekPc);\r
       Pico_mcd->bios[0x72 + 1] = d; // simple hint vector changer\r
       return;\r
     case 7:\r
-      dprintf("FIXME hint[3]: %02x @%06x", (u8)d, SekPc);\r
       Pico_mcd->bios[0x72] = d;\r
-      dprintf("vector is now %08x", PicoRead32(0x70));\r
+      dprintf("hint vector set to %08x", PicoRead32(0x70));\r
       return;\r
     case 0xe:\r
       //dprintf("m68k: comm flag: %02x", d);\r
@@ -140,8 +156,21 @@ static void m68k_reg_write8(u32 a, u32 d)
 }\r
 \r
 \r
+#define READ_FONT_DATA(basemask) \\r
+{ \\r
+      unsigned int fnt = *(unsigned int *)(Pico_mcd->s68k_regs + 0x4c); \\r
+      unsigned int col0 = (fnt >> 8) & 0x0f, col1 = (fnt >> 12) & 0x0f;   \\r
+      if (fnt & (basemask << 0)) d  = col1      ; else d  = col0;       \\r
+      if (fnt & (basemask << 1)) d |= col1 <<  4; else d |= col0 <<  4; \\r
+      if (fnt & (basemask << 2)) d |= col1 <<  8; else d |= col0 <<  8; \\r
+      if (fnt & (basemask << 3)) d |= col1 << 12; else d |= col0 << 12; \\r
+}\r
+\r
 \r
-static u32 s68k_reg_read16(u32 a)\r
+#ifndef _ASM_CD_MEMORY_C\r
+static\r
+#endif\r
+u32 s68k_reg_read16(u32 a)\r
 {\r
   u32 d=0;\r
 \r
@@ -153,7 +182,7 @@ static u32 s68k_reg_read16(u32 a)
       goto end;\r
     case 2:\r
       d = (Pico_mcd->s68k_regs[a]<<8) | (Pico_mcd->s68k_regs[a+1]&0x1f);\r
-      dprintf("s68k_regs r3: %02x @%06x", (u8)d, SekPc);\r
+      dprintf("s68k_regs r3: %02x @%06x", (u8)d, SekPcS68k);\r
       goto end;\r
     case 6:\r
       d = CDC_Read_Reg();\r
@@ -162,15 +191,27 @@ static u32 s68k_reg_read16(u32 a)
       d = Read_CDC_Host(1); // Gens returns 0 here on byte reads\r
       goto end;\r
     case 0xC:\r
-      dprintf("s68k stopwatch timer read");\r
       d = Pico_mcd->m.timer_stopwatch >> 16;\r
+      dprintf("s68k stopwatch timer read (%04x)", d);\r
       goto end;\r
     case 0x30:\r
-      dprintf("s68k int3 timer read");\r
+      dprintf("s68k int3 timer read (%02x%02x)", Pico_mcd->s68k_regs[30], Pico_mcd->s68k_regs[31]);\r
       break;\r
     case 0x34: // fader\r
       d = 0; // no busy bit\r
       goto end;\r
+    case 0x50: // font data (check: Lunar 2, Silpheed)\r
+      READ_FONT_DATA(0x00100000);\r
+      goto end;\r
+    case 0x52:\r
+      READ_FONT_DATA(0x00010000);\r
+      goto end;\r
+    case 0x54:\r
+      READ_FONT_DATA(0x10000000);\r
+      goto end;\r
+    case 0x56:\r
+      READ_FONT_DATA(0x01000000);\r
+      goto end;\r
   }\r
 \r
   d = (Pico_mcd->s68k_regs[a]<<8) | Pico_mcd->s68k_regs[a+1];\r
@@ -182,11 +223,15 @@ end:
   return d;\r
 }\r
 \r
-static void s68k_reg_write8(u32 a, u32 d)\r
+#ifndef _ASM_CD_MEMORY_C\r
+static\r
+#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
   // TODO: review against Gens\r
+  // Warning: d might have upper bits set\r
   switch (a) {\r
     case 2:\r
       return; // only m68k can change WP\r
@@ -194,20 +239,37 @@ static void s68k_reg_write8(u32 a, u32 d)
       int dold = Pico_mcd->s68k_regs[3];\r
       dprintf("s68k_regs w3: %02x @%06x", (u8)d, SekPc);\r
       d &= 0x1d;\r
+      d |= dold&0xc2;\r
       if (d&4) {\r
-        d |= dold&0xc2;\r
-        if ((d ^ dold) & 5) d &= ~2; // in case of mode or bank change we clear DMNA (m68k req) bit\r
+        if ((d ^ dold) & 5) {\r
+          d &= ~2; // in case of mode or bank change we clear DMNA (m68k req) bit\r
+#ifdef _ASM_CD_MEMORY_C\r
+          PicoMemResetCD(d);\r
+#endif\r
+        }\r
+#ifdef _ASM_CD_MEMORY_C\r
+        if ((d ^ dold) & 0x1d)\r
+          PicoMemResetCDdecode(d);\r
+#endif\r
         if (!(dold & 4)) {\r
           dprintf("wram mode 2M->1M");\r
           wram_2M_to_1M(Pico_mcd->word_ram2M);\r
-       }\r
+        }\r
       } else {\r
-        d |= Pico_mcd->s68k_regs[3]&0xc3;\r
-        if (d&1) d &= ~2; // return word RAM to m68k in 2M mode\r
         if (dold & 4) {\r
           dprintf("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
-       }\r
+#ifdef _ASM_CD_MEMORY_C\r
+          PicoMemResetCD(d);\r
+#endif\r
+        }\r
+        else\r
+          d |= dold&1;\r
+        if (d&1) d &= ~2; // return word RAM to m68k in 2M mode\r
       }\r
       break;\r
     }\r
@@ -235,7 +297,7 @@ static void s68k_reg_write8(u32 a, u32 d)
       return;\r
     case 0x31:\r
       dprintf("s68k set int3 timer: %02x", d);\r
-      Pico_mcd->m.timer_int3 = d << 16;\r
+      Pico_mcd->m.timer_int3 = (d & 0xff) << 16;\r
       break;\r
     case 0x33: // IRQ mask\r
       dprintf("s68k irq mask: %02x", d);\r
@@ -272,7 +334,7 @@ static void s68k_reg_write8(u32 a, u32 d)
 }\r
 \r
 \r
-\r
+#ifndef _ASM_CD_MEMORY_C\r
 static u32 OtherRead16End(u32 a, int realsize)\r
 {\r
   u32 d=0;\r
@@ -299,12 +361,17 @@ static void OtherWrite8End(u32 a, u32 d, int realsize)
 \r
 #undef _ASM_MEMORY_C\r
 #include "../MemoryCmn.c"\r
-\r
+#include "cell_map.c"\r
+#endif // !def _ASM_CD_MEMORY_C\r
 \r
 // -----------------------------------------------------------------\r
 //                     Read Rom and read Ram\r
 \r
-u8 PicoReadM68k8(u32 a)\r
+//u8 PicoReadM68k8_(u32 a);\r
+#ifdef _ASM_CD_MEMORY_C\r
+u8 PicoReadM68k8(u32 a);\r
+#else\r
+static u8 PicoReadM68k8(u32 a)\r
 {\r
   u32 d=0;\r
 \r
@@ -315,31 +382,15 @@ u8 PicoReadM68k8(u32 a)
   if (a < 0x20000) { d = *(u8 *)(Pico_mcd->bios+(a^1)); goto end; } // bios\r
 \r
   // prg RAM\r
-  if ((a&0xfe0000)==0x020000) {\r
+  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\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
 \r
-#if 0\r
-  if (a == 0x200000 && SekPc == 0xff0b66 && Pico.m.frame_count > 1000)\r
-  {\r
-         int i;\r
-         FILE *ff;\r
-         unsigned short *ram = (unsigned short *) Pico.ram;\r
-         // unswap and dump RAM\r
-         for (i = 0; i < 0x10000/2; i++)\r
-                 ram[i] = (ram[i]>>8) | (ram[i]<<8);\r
-         ff = fopen("ram.bin", "wb");\r
-         fwrite(ram, 1, 0x10000, ff);\r
-         fclose(ff);\r
-         exit(0);\r
-  }\r
-#endif\r
-\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
-    dprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\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
@@ -350,7 +401,7 @@ u8 PicoReadM68k8(u32 a)
       // allow access in any mode, like Gens does\r
       d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
     }\r
-    dprintf("ret = %02x", (u8)d);\r
+    wrdprintf("ret = %02x", (u8)d);\r
     goto end;\r
   }\r
 \r
@@ -371,9 +422,13 @@ u8 PicoReadM68k8(u32 a)
 #endif\r
   return (u8)d;\r
 }\r
+#endif\r
 \r
 \r
-u16 PicoReadM68k16(u32 a)\r
+#ifdef _ASM_CD_MEMORY_C\r
+u16 PicoReadM68k16(u32 a);\r
+#else\r
+static u16 PicoReadM68k16(u32 a)\r
 {\r
   u16 d=0;\r
 \r
@@ -384,7 +439,7 @@ u16 PicoReadM68k16(u32 a)
   if (a < 0x20000) { d = *(u16 *)(Pico_mcd->bios+a); goto end; } // bios\r
 \r
   // prg RAM\r
-  if ((a&0xfe0000)==0x020000) {\r
+  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
     d = *(u16 *)(prg_bank+(a&0x1fffe));\r
     goto end;\r
@@ -392,7 +447,7 @@ u16 PicoReadM68k16(u32 a)
 \r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
-    dprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\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
@@ -403,7 +458,7 @@ u16 PicoReadM68k16(u32 a)
       // allow access in any mode, like Gens does\r
       d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
     }\r
-    dprintf("ret = %04x", d);\r
+    wrdprintf("ret = %04x", d);\r
     goto end;\r
   }\r
 \r
@@ -422,9 +477,13 @@ u16 PicoReadM68k16(u32 a)
 #endif\r
   return d;\r
 }\r
+#endif\r
 \r
 \r
-u32 PicoReadM68k32(u32 a)\r
+#ifdef _ASM_CD_MEMORY_C\r
+u32 PicoReadM68k32(u32 a);\r
+#else\r
+static u32 PicoReadM68k32(u32 a)\r
 {\r
   u32 d=0;\r
 \r
@@ -435,7 +494,7 @@ u32 PicoReadM68k32(u32 a)
   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) {\r
+  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\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
@@ -444,16 +503,16 @@ u32 PicoReadM68k32(u32 a)
 \r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
-    dprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\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
         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
-       d  = *(u16 *)(Pico_mcd->word_ram1M[bank]+a1) << 16;\r
-       d |= *(u16 *)(Pico_mcd->word_ram1M[bank]+a2);\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
       }\r
@@ -461,7 +520,7 @@ u32 PicoReadM68k32(u32 a)
       // 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
-    dprintf("ret = %08x", d);\r
+    wrdprintf("ret = %08x", d);\r
     goto end;\r
   }\r
 \r
@@ -479,12 +538,16 @@ u32 PicoReadM68k32(u32 a)
 #endif\r
   return d;\r
 }\r
+#endif\r
 \r
 \r
 // -----------------------------------------------------------------\r
 //                            Write Ram\r
 \r
-void PicoWriteM68k8(u32 a,u8 d)\r
+#ifdef _ASM_CD_MEMORY_C\r
+void PicoWriteM68k8(u32 a,u8 d);\r
+#else\r
+static void PicoWriteM68k8(u32 a,u8 d)\r
 {\r
 #ifdef __debug_io\r
   dprintf("w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPc);\r
@@ -501,7 +564,7 @@ void PicoWriteM68k8(u32 a,u8 d)
   a&=0xffffff;\r
 \r
   // prg RAM\r
-  if ((a&0xfe0000)==0x020000) {\r
+  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\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
@@ -509,7 +572,7 @@ void PicoWriteM68k8(u32 a,u8 d)
 \r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
-    dprintf("m68k_wram w8: [%06x] %02x @%06x", a, d, SekPc);\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
@@ -528,9 +591,13 @@ void PicoWriteM68k8(u32 a,u8 d)
 \r
   OtherWrite8(a,d,8);\r
 }\r
+#endif\r
 \r
 \r
-void PicoWriteM68k16(u32 a,u16 d)\r
+#ifdef _ASM_CD_MEMORY_C\r
+void PicoWriteM68k16(u32 a,u16 d);\r
+#else\r
+static void PicoWriteM68k16(u32 a,u16 d)\r
 {\r
 #ifdef __debug_io\r
   dprintf("w16: %06x, %04x", a&0xffffff, d);\r
@@ -545,7 +612,7 @@ void PicoWriteM68k16(u32 a,u16 d)
   a&=0xfffffe;\r
 \r
   // prg RAM\r
-  if ((a&0xfe0000)==0x020000) {\r
+  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
     *(u16 *)(prg_bank+(a&0x1fffe))=d;\r
     return;\r
@@ -553,7 +620,7 @@ void PicoWriteM68k16(u32 a,u16 d)
 \r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
-    dprintf("m68k_wram w16: [%06x] %04x @%06x", a, d, SekPc);\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
@@ -572,9 +639,13 @@ void PicoWriteM68k16(u32 a,u16 d)
 \r
   OtherWrite16(a,d);\r
 }\r
+#endif\r
 \r
 \r
-void PicoWriteM68k32(u32 a,u32 d)\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
 #ifdef __debug_io\r
   dprintf("w32: %06x, %08x", a&0xffffff, d);\r
@@ -591,7 +662,7 @@ void PicoWriteM68k32(u32 a,u32 d)
   a&=0xfffffe;\r
 \r
   // prg RAM\r
-  if ((a&0xfe0000)==0x020000) {\r
+  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&2)) {\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
@@ -601,16 +672,16 @@ void PicoWriteM68k32(u32 a,u32 d)
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     if (d != 0) // don't log clears\r
-      dprintf("m68k_wram w32: [%06x] %08x @%06x", a, d, SekPc);\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
+        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
@@ -629,12 +700,15 @@ void PicoWriteM68k32(u32 a,u32 d)
   OtherWrite16(a,  (u16)(d>>16));\r
   OtherWrite16(a+2,(u16)d);\r
 }\r
+#endif\r
 \r
 \r
 // -----------------------------------------------------------------\r
 \r
-\r
-u8 PicoReadS68k8(u32 a)\r
+#ifdef _ASM_CD_MEMORY_C\r
+u8 PicoReadS68k8(u32 a);\r
+#else\r
+static u8 PicoReadS68k8(u32 a)\r
 {\r
   u32 d=0;\r
 \r
@@ -650,7 +724,7 @@ u8 PicoReadS68k8(u32 a)
   if ((a&0xfffe00) == 0xff8000) {\r
     a &= 0x1ff;\r
     rdprintf("s68k_regs r8: [%02x] @ %06x", a, SekPcS68k);\r
-    if (a >= 0x50 && a < 0x68)\r
+    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
@@ -661,7 +735,7 @@ u8 PicoReadS68k8(u32 a)
   // word RAM (2M area)\r
   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
     // test: batman returns\r
-    dprintf("s68k_wram2M r8: [%06x] @%06x", a, SekPcS68k);\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);\r
       d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
@@ -672,19 +746,19 @@ u8 PicoReadS68k8(u32 a)
       // allow access in any mode, like Gens does\r
       d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
     }\r
-    dprintf("ret = %02x", (u8)d);\r
+    wrdprintf("ret = %02x", (u8)d);\r
     goto end;\r
   }\r
 \r
   // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000) { // 0c0000-0dffff\r
+  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
     int bank;\r
-    dprintf("s68k_wram1M r8: [%06x] @%06x", a, SekPcS68k);\r
-    if (!(Pico_mcd->s68k_regs[3]&4))\r
-      dprintf("s68k_wram1M FIXME: wrong mode");\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);\r
     d = Pico_mcd->word_ram1M[bank][(a^1)&0x1ffff];\r
-    dprintf("ret = %02x", (u8)d);\r
+    wrdprintf("ret = %02x", (u8)d);\r
     goto end;\r
   }\r
 \r
@@ -718,9 +792,14 @@ u8 PicoReadS68k8(u32 a)
 #endif\r
   return (u8)d;\r
 }\r
+#endif\r
 \r
 \r
-u16 PicoReadS68k16(u32 a)\r
+//u16 PicoReadS68k16_(u32 a);\r
+#ifdef _ASM_CD_MEMORY_C\r
+u16 PicoReadS68k16(u32 a);\r
+#else\r
+static u16 PicoReadS68k16(u32 a)\r
 {\r
   u32 d=0;\r
 \r
@@ -736,7 +815,7 @@ u16 PicoReadS68k16(u32 a)
   if ((a&0xfffe00) == 0xff8000) {\r
     a &= 0x1fe;\r
     rdprintf("s68k_regs r16: [%02x] @ %06x", a, SekPcS68k);\r
-    if (a >= 0x50 && a < 0x68)\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
@@ -745,7 +824,7 @@ u16 PicoReadS68k16(u32 a)
 \r
   // word RAM (2M area)\r
   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    dprintf("s68k_wram2M r16: [%06x] @%06x", a, SekPcS68k);\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);\r
       d = Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff];\r
@@ -755,35 +834,35 @@ u16 PicoReadS68k16(u32 a)
       // allow access in any mode, like Gens does\r
       d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
     }\r
-    dprintf("ret = %04x", d);\r
+    wrdprintf("ret = %04x", d);\r
     goto end;\r
   }\r
 \r
   // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000) { // 0c0000-0dffff\r
+  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
     int bank;\r
-    dprintf("s68k_wram1M r16: [%06x] @%06x", a, SekPcS68k);\r
-    if (!(Pico_mcd->s68k_regs[3]&4))\r
-      dprintf("s68k_wram1M FIXME: wrong mode");\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);\r
     d = *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
-    dprintf("ret = %04x", d);\r
+    wrdprintf("ret = %04x", d);\r
     goto end;\r
   }\r
 \r
   // bram\r
   if ((a&0xff0000)==0xfe0000) {\r
-    dprintf("s68k_bram r16: [%06x] @%06x", a, SekPcS68k);\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;\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("s68k_pcm r16: [%06x] @%06x", a, SekPcS68k);\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
@@ -805,9 +884,13 @@ u16 PicoReadS68k16(u32 a)
 #endif\r
   return d;\r
 }\r
+#endif\r
 \r
 \r
-u32 PicoReadS68k32(u32 a)\r
+#ifdef _ASM_CD_MEMORY_C\r
+u32 PicoReadS68k32(u32 a);\r
+#else\r
+static u32 PicoReadS68k32(u32 a)\r
 {\r
   u32 d=0;\r
 \r
@@ -824,7 +907,7 @@ u32 PicoReadS68k32(u32 a)
   if ((a&0xfffe00) == 0xff8000) {\r
     a &= 0x1fe;\r
     rdprintf("s68k_regs r32: [%02x] @ %06x", a, SekPcS68k);\r
-    if (a >= 0x50 && a < 0x68)\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
@@ -833,7 +916,7 @@ u32 PicoReadS68k32(u32 a)
 \r
   // word RAM (2M area)\r
   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    dprintf("s68k_wram2M r32: [%06x] @%06x", a, SekPcS68k);\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);\r
       a >>= 1;\r
@@ -845,25 +928,25 @@ u32 PicoReadS68k32(u32 a)
       // 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
-    dprintf("ret = %08x", d);\r
+    wrdprintf("ret = %08x", d);\r
     goto end;\r
   }\r
 \r
   // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000) { // 0c0000-0dffff\r
+  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
     int bank;\r
-    dprintf("s68k_wram1M r32: [%06x] @%06x", a, SekPcS68k);\r
-    if (!(Pico_mcd->s68k_regs[3]&4))\r
-      dprintf("s68k_wram1M FIXME: wrong mode");\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);\r
     u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
-    dprintf("ret = %08x", d);\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
+    dprintf("FIXME: s68k_pcm r32: [%06x] @%06x", a, SekPcS68k);\r
     a &= 0x7fff;\r
     if (a >= 0x2000) {\r
       a >>= 1;\r
@@ -886,7 +969,7 @@ u32 PicoReadS68k32(u32 a)
 \r
   // bram\r
   if ((a&0xff0000)==0xfe0000) {\r
-    dprintf("s68k_bram r32: [%06x] @%06x", a, SekPcS68k);\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
@@ -905,17 +988,88 @@ u32 PicoReadS68k32(u32 a)
 #endif\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
+{\r
+  u8 *pd = Pico_mcd->word_ram1M[!(r3 & 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
+\r
+  //dprintf("FIXME: decode, r3 = %02x", r3);\r
+\r
+  if (r3 == 8) {\r
+    if ((!(*pd & (~oldmask))) && d) goto do_it;\r
+  } else if (r3 > 8) {\r
+    if (d) goto do_it;\r
+  } else {\r
+    goto do_it;\r
+  }\r
+\r
+  return;\r
+do_it:\r
+  *pd = d | (*pd & oldmask);\r
+}\r
+\r
 \r
+static void decode_write16(u32 a, u16 d, int r3)\r
+{\r
+  u8 *pd = Pico_mcd->word_ram1M[!(r3 & 1)] + (((a>>1)^1)&0x1ffff);\r
+\r
+  //if ((a & 0x3ffff) < 0x28000) return;\r
+\r
+  r3 &= 0x18;\r
+  d  &= 0x0f0f;\r
+  d  |= d >> 4;\r
+\r
+  if (r3 == 8) {\r
+    u8 dold = *pd;\r
+    if (!(dold & 0xf0)) dold |= d & 0xf0;\r
+    if (!(dold & 0x0f)) dold |= d & 0x0f;\r
+    *pd = dold;\r
+  } else if (r3 > 8) {\r
+    u8 dold = *pd;\r
+    if (!(d & 0xf0)) d |= dold & 0xf0;\r
+    if (!(d & 0x0f)) d |= dold & 0x0f;\r
+    *pd = d;\r
+  } else {\r
+    *pd = d;\r
+  }\r
+\r
+  //dprintf("FIXME: decode");\r
+}\r
+#endif\r
 \r
 // -----------------------------------------------------------------\r
 \r
-void PicoWriteS68k8(u32 a,u8 d)\r
+//void PicoWriteS68k8_(u32 a,u8 d);\r
+//void PicoWriteS68k8__(u32 a,u8 d);\r
+#ifdef _ASM_CD_MEMORY_C\r
+void PicoWriteS68k8(u32 a,u8 d);\r
+#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
 \r
   a&=0xffffff;\r
+#if 0\r
+    PicoWriteS68k8_(a, d);\r
+/*  if ((a&0xfc0000)!=0x080000) {\r
+    PicoWriteS68k8_(a, d);\r
+    return;\r
+  }\r
+  printf("r3: %02x\n", Pico_mcd->s68k_regs[3]);\r
+  PicoWriteS68k8__(a,d);*/\r
+  return;\r
+#endif\r
 \r
   // prg RAM\r
   if (a < 0x80000) {\r
@@ -928,21 +1082,18 @@ void PicoWriteS68k8(u32 a,u8 d)
   if ((a&0xfffe00) == 0xff8000) {\r
     a &= 0x1ff;\r
     rdprintf("s68k_regs w8: [%02x] %02x @ %06x", a, d, SekPcS68k);\r
-    if (a >= 0x50 && a < 0x68)\r
-         gfx_cd_write(a&~1, (d<<8)|d);\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
-    dprintf("s68k_wram2M w8: [%06x] %02x @%06x", a, d, SekPcS68k);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
-      int bank = !(Pico_mcd->s68k_regs[3]&1);\r
-      if (a&1) d &= 0x0f;\r
-      else d >>= 4;\r
-      Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff]=d;\r
-      dprintf("FIXME: decode");\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
@@ -951,12 +1102,13 @@ void PicoWriteS68k8(u32 a,u8 d)
   }\r
 \r
   // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000) { // 0c0000-0dffff\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
-      dprintf("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
+      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);\r
     *(u8 *)(Pico_mcd->word_ram1M[bank]+((a^1)&0x1ffff))=d;\r
     return;\r
@@ -981,9 +1133,13 @@ void PicoWriteS68k8(u32 a,u8 d)
 \r
   dprintf("s68k w8 : %06x,   %02x @%06x", a&0xffffff, d, SekPcS68k);\r
 }\r
+#endif\r
 \r
 \r
-void PicoWriteS68k16(u32 a,u16 d)\r
+#ifdef _ASM_CD_MEMORY_C\r
+void PicoWriteS68k16(u32 a,u16 d);\r
+#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
@@ -1001,12 +1157,12 @@ void PicoWriteS68k16(u32 a,u16 d)
   if ((a&0xfffe00) == 0xff8000) {\r
     a &= 0x1fe;\r
     rdprintf("s68k_regs w16: [%02x] %04x @ %06x", a, d, SekPcS68k);\r
-    if (a >= 0x50 && a < 0x68)\r
-      gfx_cd_write(a, d);\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
+        return;\r
       }\r
       s68k_reg_write8(a,  d>>8);\r
       s68k_reg_write8(a+1,d&0xff);\r
@@ -1016,12 +1172,10 @@ void PicoWriteS68k16(u32 a,u16 d)
 \r
   // word RAM (2M area)\r
   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    dprintf("s68k_wram2M w16: [%06x] %04x @%06x", a, d, SekPcS68k);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
-      int bank = !(Pico_mcd->s68k_regs[3]&1);\r
-      d &= ~0xf0; d |= d >> 8;\r
-      Pico_mcd->word_ram1M[bank][((a>>1)^1)&0x1ffff] = d;\r
-      dprintf("FIXME: decode");\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
@@ -1030,12 +1184,12 @@ void PicoWriteS68k16(u32 a,u16 d)
   }\r
 \r
   // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000) { // 0c0000-0dffff\r
+  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
     int bank;\r
     if (d)\r
-      dprintf("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
+      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);\r
     *(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe))=d;\r
     return;\r
@@ -1063,9 +1217,13 @@ void PicoWriteS68k16(u32 a,u16 d)
 \r
   dprintf("s68k w16: %06x, %04x @%06x", a&0xffffff, d, SekPcS68k);\r
 }\r
+#endif\r
 \r
 \r
-void PicoWriteS68k32(u32 a,u32 d)\r
+#ifdef _ASM_CD_MEMORY_C\r
+void PicoWriteS68k32(u32 a,u32 d);\r
+#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
@@ -1084,9 +1242,9 @@ void PicoWriteS68k32(u32 a,u32 d)
   if ((a&0xfffe00) == 0xff8000) {\r
     a &= 0x1fe;\r
     rdprintf("s68k_regs w32: [%02x] %08x @ %06x", a, d, SekPcS68k);\r
-    if (a >= 0x50 && a < 0x68) {\r
-      gfx_cd_write(a,   d>>16);\r
-      gfx_cd_write(a+2, d&0xffff);\r
+    if (a >= 0x58 && a < 0x68) {\r
+      gfx_cd_write16(a,   d>>16);\r
+      gfx_cd_write16(a+2, d&0xffff);\r
     } else {\r
       s68k_reg_write8(a,   d>>24);\r
       s68k_reg_write8(a+1,(d>>16)&0xff);\r
@@ -1098,14 +1256,11 @@ void PicoWriteS68k32(u32 a,u32 d)
 \r
   // word RAM (2M area)\r
   if ((a&0xfc0000)==0x080000) { // 080000-0bffff\r
-    dprintf("s68k_wram2M w32: [%06x] %08x @%06x", a, d, SekPcS68k);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M decode mode?\r
-      int bank = !(Pico_mcd->s68k_regs[3]&1);\r
-      a >>= 1;\r
-      d &= 0x0f0f0f0f; d |= d >> 4;\r
-      Pico_mcd->word_ram1M[bank][((a+0)^1)&0x1ffff] = d >> 16;\r
-      Pico_mcd->word_ram1M[bank][((a+1)^1)&0x1ffff] = d;\r
-      dprintf("FIXME: decode");\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
@@ -1115,13 +1270,13 @@ void PicoWriteS68k32(u32 a,u32 d)
   }\r
 \r
   // word RAM (1M area)\r
-  if ((a&0xfe0000)==0x0c0000) { // 0c0000-0dffff\r
+  if ((a&0xfe0000)==0x0c0000 && (Pico_mcd->s68k_regs[3]&4)) { // 0c0000-0dffff\r
     int bank;\r
     u16 *pm;\r
     if (d)\r
-      dprintf("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
+      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);\r
     pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe));\r
     pm[0]=(u16)(d>>16); pm[1]=(u16)d;\r
@@ -1157,7 +1312,7 @@ void PicoWriteS68k32(u32 a,u32 d)
 \r
   dprintf("s68k w32: %06x, %08x @%06x", a&0xffffff, d, SekPcS68k);\r
 }\r
-\r
+#endif\r
 \r
 \r
 // -----------------------------------------------------------------\r