memory refactoring (mostly for cd) + ARM mem asm update
[picodrive.git] / pico / cd / memory.c
index b8998f8..5b3ebf5 100644 (file)
@@ -21,6 +21,48 @@ MAKE_68K_WRITE32(s68k_write32, s68k_write16_map)
 \r
 // -----------------------------------------------------------------\r
 \r
+// provided by ASM code:\r
+#ifdef _ASM_CD_MEMORY_C\r
+u32 PicoReadM68k8_io(u32 a);\r
+u32 PicoReadM68k16_io(u32 a);\r
+void PicoWriteM68k8_io(u32 a, u32 d);\r
+void PicoWriteM68k16_io(u32 a, u32 d);\r
+\r
+u32 PicoReadS68k8_pr(u32 a);\r
+u32 PicoReadS68k16_pr(u32 a);\r
+void PicoWriteS68k8_pr(u32 a, u32 d);\r
+void PicoWriteS68k16_pr(u32 a, u32 d);\r
+\r
+u32 PicoReadM68k8_cell0(u32 a);\r
+u32 PicoReadM68k8_cell1(u32 a);\r
+u32 PicoReadM68k16_cell0(u32 a);\r
+u32 PicoReadM68k16_cell1(u32 a);\r
+void PicoWriteM68k8_cell0(u32 a, u32 d);\r
+void PicoWriteM68k8_cell1(u32 a, u32 d);\r
+void PicoWriteM68k16_cell0(u32 a, u32 d);\r
+void PicoWriteM68k16_cell1(u32 a, u32 d);\r
+\r
+u32 PicoReadS68k8_dec0(u32 a);\r
+u32 PicoReadS68k8_dec1(u32 a);\r
+u32 PicoReadS68k16_dec0(u32 a);\r
+u32 PicoReadS68k16_dec1(u32 a);\r
+void PicoWriteS68k8_dec_m0b0(u32 a, u32 d);\r
+void PicoWriteS68k8_dec_m1b0(u32 a, u32 d);\r
+void PicoWriteS68k8_dec_m2b0(u32 a, u32 d);\r
+void PicoWriteS68k8_dec_m0b1(u32 a, u32 d);\r
+void PicoWriteS68k8_dec_m1b1(u32 a, u32 d);\r
+void PicoWriteS68k8_dec_m2b1(u32 a, u32 d);\r
+void PicoWriteS68k16_dec_m0b0(u32 a, u32 d);\r
+void PicoWriteS68k16_dec_m1b0(u32 a, u32 d);\r
+void PicoWriteS68k16_dec_m2b0(u32 a, u32 d);\r
+void PicoWriteS68k16_dec_m0b1(u32 a, u32 d);\r
+void PicoWriteS68k16_dec_m1b1(u32 a, u32 d);\r
+void PicoWriteS68k16_dec_m2b1(u32 a, u32 d);\r
+#endif\r
+\r
+static void remap_prg_window(void);\r
+static void remap_word_ram(int r3);\r
+\r
 // poller detection\r
 #define POLL_LIMIT 16\r
 #define POLL_CYCLES 124\r
@@ -98,7 +140,7 @@ void m68k_reg_write8(u32 a, u32 d)
       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
+        remap_prg_window();\r
       Pico_mcd->m.busreq = d;\r
       return;\r
     case 2:\r
@@ -123,7 +165,7 @@ void m68k_reg_write8(u32 a, u32 d)
       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
+        remap_prg_window();\r
       }\r
 #ifdef USE_POLL_DETECT\r
       if ((s68k_poll_adclk&0xfe) == 2 && s68k_poll_cnt > POLL_LIMIT) {\r
@@ -272,14 +314,10 @@ void s68k_reg_write8(u32 a, u32 d)
       d |= dold & 0xc2;\r
       if (d & 4)\r
       {\r
-        if ((d ^ dold) & 5) {\r
+        if ((d ^ dold) & 0x1d) {\r
           d &= ~2; // in case of mode or bank change we clear DMNA (m68k req) bit\r
-          PicoMemRemapCD(d);\r
+          remap_word_ram(d);\r
         }\r
-#ifdef _ASM_CD_MEMORY_C\r
-        if ((d ^ dold) & 0x1d)\r
-          PicoMemResetCDdecode(d);\r
-#endif\r
         if (!(dold & 4)) {\r
           elprintf(EL_CDREG3, "wram mode 2M->1M");\r
           wram_2M_to_1M(Pico_mcd->word_ram2M);\r
@@ -294,7 +332,7 @@ void s68k_reg_write8(u32 a, u32 d)
             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
-          PicoMemRemapCD(d);\r
+          remap_word_ram(d);\r
         }\r
         // s68k can only set RET, writing 0 has no effect\r
         else if ((dold ^ d) & d & 1) {   // RET being set\r
@@ -371,37 +409,57 @@ void s68k_reg_write8(u32 a, u32 d)
 \r
 #ifndef _ASM_CD_MEMORY_C\r
 #include "cell_map.c"\r
-#endif\r
 \r
 // WORD RAM, cell aranged area (220000 - 23ffff)\r
-static u32 PicoReadM68k8_cell(u32 a)\r
+static u32 PicoReadM68k8_cell0(u32 a)\r
 {\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
+  return Pico_mcd->word_ram1M[0][a ^ 1];\r
+}\r
+\r
+static u32 PicoReadM68k8_cell1(u32 a)\r
+{\r
+  a = (a&3) | (cell_map(a >> 2) << 2);\r
+  return Pico_mcd->word_ram1M[1][a ^ 1];\r
+}\r
+\r
+static u32 PicoReadM68k16_cell0(u32 a)\r
+{\r
+  a = (a&2) | (cell_map(a >> 2) << 2);\r
+  return *(u16 *)(Pico_mcd->word_ram1M[0] + a);\r
 }\r
 \r
-static u32 PicoReadM68k16_cell(u32 a)\r
+static u32 PicoReadM68k16_cell1(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
+  return *(u16 *)(Pico_mcd->word_ram1M[1] + a);\r
 }\r
 \r
-static void PicoWriteM68k8_cell(u32 a, u32 d)\r
+static void PicoWriteM68k8_cell0(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
+  Pico_mcd->word_ram1M[0][a ^ 1] = d;\r
 }\r
 \r
-static void PicoWriteM68k16_cell(u32 a, u32 d)\r
+static void PicoWriteM68k8_cell1(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
+  Pico_mcd->word_ram1M[1][a ^ 1] = d;\r
 }\r
 \r
+static void PicoWriteM68k16_cell0(u32 a, u32 d)\r
+{\r
+  a = (a&3) | (cell_map(a >> 2) << 2);\r
+  *(u16 *)(Pico_mcd->word_ram1M[0] + a) = d;\r
+}\r
+\r
+static void PicoWriteM68k16_cell1(u32 a, u32 d)\r
+{\r
+  a = (a&3) | (cell_map(a >> 2) << 2);\r
+  *(u16 *)(Pico_mcd->word_ram1M[1] + a) = d;\r
+}\r
+#endif\r
+\r
 // RAM cart (40000 - 7fffff, optional)\r
 static u32 PicoReadM68k8_ramc(u32 a)\r
 {\r
@@ -456,6 +514,7 @@ static void PicoWriteM68k16_ramc(u32 a, u32 d)
 }\r
 \r
 // IO/control/cd registers (a10000 - ...)\r
+#ifndef _ASM_CD_MEMORY_C\r
 static u32 PicoReadM68k8_io(u32 a)\r
 {\r
   u32 d;\r
@@ -518,6 +577,7 @@ static void PicoWriteM68k16_io(u32 a, u32 d)
 \r
   PicoWrite16_io(a, d);\r
 }\r
+#endif\r
 \r
 // -----------------------------------------------------------------\r
 //                           Sub 68k\r
@@ -545,12 +605,36 @@ static void s68k_unmapped_write16(u32 a, u32 d)
   elprintf(EL_UIO, "s68k unmapped w16 [%06x] %04x @%06x", a, d & 0xffff, SekPc);\r
 }\r
 \r
+// PRG RAM protected range (000000 - 00ff00)?\r
+// XXX verify: ff00 or 1fe00 max?\r
+static void PicoWriteS68k8_prgwp(u32 a, u32 d)\r
+{\r
+  if (a >= (Pico_mcd->s68k_regs[2] << 8))\r
+    Pico_mcd->prg_ram[a ^ 1] = d;\r
+}\r
+\r
+static void PicoWriteS68k16_prgwp(u32 a, u32 d)\r
+{\r
+  if (a >= (Pico_mcd->s68k_regs[2] << 8))\r
+    *(u16 *)(Pico_mcd->prg_ram + a) = d;\r
+}\r
+\r
+#ifndef _ASM_CD_MEMORY_C\r
+\r
 // decode (080000 - 0bffff, in 1M mode)\r
-static u32 PicoReadS68k8_dec(u32 a)\r
+static u32 PicoReadS68k8_dec0(u32 a)\r
+{\r
+  u32 d = Pico_mcd->word_ram1M[0][((a >> 1) ^ 1) & 0x1ffff];\r
+  if (a & 1)\r
+    d &= 0x0f;\r
+  else\r
+    d >>= 4;\r
+  return d;\r
+}\r
+\r
+static u32 PicoReadS68k8_dec1(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
+  u32 d = Pico_mcd->word_ram1M[1][((a >> 1) ^ 1) & 0x1ffff];\r
   if (a & 1)\r
     d &= 0x0f;\r
   else\r
@@ -558,68 +642,86 @@ static u32 PicoReadS68k8_dec(u32 a)
   return d;\r
 }\r
 \r
-static u32 PicoReadS68k16_dec(u32 a)\r
+static u32 PicoReadS68k16_dec0(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
+  u32 d = Pico_mcd->word_ram1M[0][((a >> 1) ^ 1) & 0x1ffff];\r
   d |= d << 4;\r
   d &= ~0xf0;\r
   return d;\r
 }\r
 \r
-/* check: jaguar xj 220 (draws entire world using decode) */\r
-static void PicoWriteS68k8_dec(u32 a, u32 d)\r
+static u32 PicoReadS68k16_dec1(u32 a)\r
 {\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))\r
-    d <<= 4;\r
-\r
-  if (r3 == 8) {\r
-    if ((!(*pd & (~oldmask))) && d)\r
-      goto do_it;\r
-  } else if (r3 > 8) {\r
-    if (d)\r
-      goto do_it;\r
-  } else\r
-    goto do_it;\r
-\r
-  return;\r
-\r
-do_it:\r
-  *pd = d | (*pd & oldmask);\r
+  u32 d = Pico_mcd->word_ram1M[1][((a >> 1) ^ 1) & 0x1ffff];\r
+  d |= d << 4;\r
+  d &= ~0xf0;\r
+  return d;\r
 }\r
 \r
-static void PicoWriteS68k16_dec(u32 a, u32 d)\r
-{\r
-  u8 r3 = Pico_mcd->s68k_regs[3];\r
-  u8 *pd = &Pico_mcd->word_ram1M[(r3 & 1) ^ 1][((a >> 1) ^ 1) & 0x1ffff];\r
+/* check: jaguar xj 220 (draws entire world using decode) */\r
+#define mk_decode_w8(bank)                                        \\r
+static void PicoWriteS68k8_dec_m0b##bank(u32 a, u32 d)            \\r
+{                                                                 \\r
+  u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
+                                                                  \\r
+  if (!(a & 1))                                                   \\r
+    *pd = (*pd & 0x0f) | (d << 4);                                \\r
+  else                                                            \\r
+    *pd = (*pd & 0xf0) | (d & 0x0f);                              \\r
+}                                                                 \\r
+                                                                  \\r
+static void PicoWriteS68k8_dec_m1b##bank(u32 a, u32 d)            \\r
+{                                                                 \\r
+  u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
+  u8 mask = (a & 1) ? 0x0f : 0xf0;                                \\r
+                                                                  \\r
+  if (!(*pd & mask) && (d & 0x0f)) /* underwrite */               \\r
+    PicoWriteS68k8_dec_m0b##bank(a, d);                           \\r
+}                                                                 \\r
+                                                                  \\r
+static void PicoWriteS68k8_dec_m2b##bank(u32 a, u32 d) /* ...and m3? */ \\r
+{                                                                 \\r
+  if (d & 0x0f) /* overwrite */                                   \\r
+    PicoWriteS68k8_dec_m0b##bank(a, d);                           \\r
+}\r
 \r
-  //if ((a & 0x3ffff) < 0x28000) return;\r
+mk_decode_w8(0)\r
+mk_decode_w8(1)\r
+\r
+#define mk_decode_w16(bank)                                       \\r
+static void PicoWriteS68k16_dec_m0b##bank(u32 a, u32 d)           \\r
+{                                                                 \\r
+  u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
+                                                                  \\r
+  d &= 0x0f0f;                                                    \\r
+  *pd = d | (d >> 4);                                             \\r
+}                                                                 \\r
+                                                                  \\r
+static void PicoWriteS68k16_dec_m1b##bank(u32 a, u32 d)           \\r
+{                                                                 \\r
+  u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
+                                                                  \\r
+  d &= 0x0f0f; /* underwrite */                                   \\r
+  if (!(*pd & 0xf0)) *pd |= d >> 4;                               \\r
+  if (!(*pd & 0x0f)) *pd |= d;                                    \\r
+}                                                                 \\r
+                                                                  \\r
+static void PicoWriteS68k16_dec_m2b##bank(u32 a, u32 d)           \\r
+{                                                                 \\r
+  u8 *pd = &Pico_mcd->word_ram1M[bank][((a >> 1) ^ 1) & 0x1ffff]; \\r
+                                                                  \\r
+  d &= 0x0f0f; /* overwrite */                                    \\r
+  d |= d >> 4;                                                    \\r
+                                                                  \\r
+  if (!(d & 0xf0)) d |= *pd & 0xf0;                               \\r
+  if (!(d & 0x0f)) d |= *pd & 0x0f;                               \\r
+  *pd = d;                                                        \\r
+}\r
 \r
-  r3 &= 0x18;\r
-  d  &= 0x0f0f;\r
-  d  |= d >> 4;\r
+mk_decode_w16(0)\r
+mk_decode_w16(1)\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
+#endif\r
 \r
 // backup RAM (fe0000 - feffff)\r
 static u32 PicoReadS68k8_bram(u32 a)\r
@@ -652,6 +754,8 @@ static void PicoWriteS68k16_bram(u32 a, u32 d)
   SRam.changed = 1;\r
 }\r
 \r
+#ifndef _ASM_CD_MEMORY_C\r
+\r
 // PCM and registers (ff0000 - ffffff)\r
 static u32 PicoReadS68k8_pr(u32 a)\r
 {\r
@@ -677,6 +781,7 @@ static u32 PicoReadS68k8_pr(u32 a)
   }\r
 \r
   // PCM\r
+  // XXX: verify: probably odd addrs only?\r
   if ((a & 0x8000) == 0x0000) {\r
     a &= 0x7fff;\r
     if (a >= 0x2000)\r
@@ -785,21 +890,43 @@ static void PicoWriteS68k16_pr(u32 a, u32 d)
   s68k_unmapped_write16(a, d);\r
 }\r
 \r
+#endif\r
+\r
+static const void *m68k_cell_read8[]   = { PicoReadM68k8_cell0, PicoReadM68k8_cell1 };\r
+static const void *m68k_cell_read16[]  = { PicoReadM68k16_cell0, PicoReadM68k16_cell1 };\r
+static const void *m68k_cell_write8[]  = { PicoWriteM68k8_cell0, PicoWriteM68k8_cell1 };\r
+static const void *m68k_cell_write16[] = { PicoWriteM68k16_cell0, PicoWriteM68k16_cell1 };\r
+\r
+static const void *s68k_dec_read8[]   = { PicoReadS68k8_dec0, PicoReadS68k8_dec1 };\r
+static const void *s68k_dec_read16[]  = { PicoReadS68k16_dec0, PicoReadS68k16_dec1 };\r
+\r
+static const void *s68k_dec_write8[2][4] = {\r
+  { PicoWriteS68k8_dec_m0b0, PicoWriteS68k8_dec_m1b0, PicoWriteS68k8_dec_m2b0, PicoWriteS68k8_dec_m2b0 },\r
+  { PicoWriteS68k8_dec_m0b1, PicoWriteS68k8_dec_m1b1, PicoWriteS68k8_dec_m2b1, PicoWriteS68k8_dec_m2b1 },\r
+};\r
+\r
+static const void *s68k_dec_write16[2][4] = {\r
+  { PicoWriteS68k16_dec_m0b0, PicoWriteS68k16_dec_m1b0, PicoWriteS68k16_dec_m2b0, PicoWriteS68k16_dec_m2b0 },\r
+  { PicoWriteS68k16_dec_m0b1, PicoWriteS68k16_dec_m1b1, PicoWriteS68k16_dec_m2b1, PicoWriteS68k16_dec_m2b1 },\r
+};\r
+\r
 // -----------------------------------------------------------------\r
 \r
-// TODO: probably split\r
-void PicoMemRemapCD(int r3)\r
+static void remap_prg_window(void)\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
+    void *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
+\r
+static void remap_word_ram(int r3)\r
+{\r
+  void *bank;\r
 \r
   // WORD RAM\r
   if (!(r3 & 4)) {\r
@@ -810,20 +937,22 @@ void PicoMemRemapCD(int r3)
     // TODO: handle 0x0c0000\r
   }\r
   else {\r
-    bank = Pico_mcd->word_ram1M[r3 & 1];\r
+    int b0 = r3 & 1;\r
+    int m = (r3 & 0x18) >> 3;\r
+    bank = Pico_mcd->word_ram1M[b0];\r
     cpu68k_map_all_ram(0x200000, 0x21ffff, bank, 0);\r
-    bank = Pico_mcd->word_ram1M[(r3 & 1) ^ 1];\r
+    bank = Pico_mcd->word_ram1M[b0 ^ 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
+    cpu68k_map_set(m68k_read8_map,   0x220000, 0x23ffff, m68k_cell_read8[b0], 1);\r
+    cpu68k_map_set(m68k_read16_map,  0x220000, 0x23ffff, m68k_cell_read16[b0], 1);\r
+    cpu68k_map_set(m68k_write8_map,  0x220000, 0x23ffff, m68k_cell_write8[b0], 1);\r
+    cpu68k_map_set(m68k_write16_map, 0x220000, 0x23ffff, m68k_cell_write16[b0], 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
+    cpu68k_map_set(s68k_read8_map,   0x080000, 0x0bffff, s68k_dec_read8[b0 ^ 1], 1);\r
+    cpu68k_map_set(s68k_read16_map,  0x080000, 0x0bffff, s68k_dec_read16[b0 ^ 1], 1);\r
+    cpu68k_map_set(s68k_write8_map,  0x080000, 0x0bffff, s68k_dec_write8[b0 ^ 1][m], 1);\r
+    cpu68k_map_set(s68k_write16_map, 0x080000, 0x0bffff, s68k_dec_write16[b0 ^ 1][m], 1);\r
   }\r
 \r
 #ifdef EMU_F68K\r
@@ -844,6 +973,20 @@ void PicoMemRemapCD(int r3)
 #endif\r
 }\r
 \r
+void PicoMemStateLoaded(void)\r
+{\r
+  int r3 = Pico_mcd->s68k_regs[3];\r
+\r
+  /* after load events */\r
+  if (r3 & 4) // 1M mode?\r
+    wram_2M_to_1M(Pico_mcd->word_ram2M);\r
+  remap_word_ram(r3);\r
+  remap_prg_window();\r
+\r
+  // restore hint vector\r
+  *(unsigned short *)(Pico_mcd->bios + 0x72) = Pico_mcd->m.hint_vector;\r
+}\r
+\r
 #ifdef EMU_M68K\r
 static void m68k_mem_setup_cd(void);\r
 #endif\r
@@ -853,8 +996,6 @@ PICO_INTERNAL void PicoMemSetupCD(void)
   // 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
@@ -881,6 +1022,8 @@ PICO_INTERNAL void PicoMemSetupCD(void)
   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
+  cpu68k_map_set(s68k_write8_map,  0x000000, 0x00ffff, PicoWriteS68k8_prgwp, 1);\r
+  cpu68k_map_set(s68k_write16_map, 0x000000, 0x00ffff, PicoWriteS68k16_prgwp, 1);\r
 \r
   // BRAM\r
   cpu68k_map_set(s68k_read8_map,   0xfe0000, 0xfeffff, PicoReadS68k8_bram, 1);\r
@@ -894,6 +1037,9 @@ PICO_INTERNAL void PicoMemSetupCD(void)
   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
+  // RAMs\r
+  remap_word_ram(1);\r
+\r
 #ifdef EMU_C68K\r
   // s68k\r
   PicoCpuCS68k.read8  = (void *)s68k_read8_map;\r
@@ -939,7 +1085,7 @@ 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
-    // PicoMemRemapCD() will setup word ram for both\r
+    // remap_word_ram() will setup word ram for both\r
   }\r
 #endif\r
 #ifdef EMU_M68K\r