optimizations, fixes, hacks, psp, ...
[picodrive.git] / Pico / cd / Memory.c
index 8053185..1910825 100644 (file)
@@ -454,47 +454,72 @@ static u32 PicoReadM68k8(u32 a)
 {\r
   u32 d=0;\r
 \r
-  if ((a&0xe00000)==0xe00000) { d = *(u8 *)(Pico.ram+((a^1)&0xffff)); goto end; } // Ram\r
-\r
   a&=0xffffff;\r
 \r
-  if (a < 0x20000) { d = *(u8 *)(Pico_mcd->bios+(a^1)); goto end; } // bios\r
+  switch (a >> 17)\r
+  {\r
+    case 0x00>>1: // BIOS: 000000 - 020000\r
+      d = *(u8 *)(Pico_mcd->bios+(a^1));\r
+      break;\r
+    case 0x02>>1: // prg RAM\r
+      if ((Pico_mcd->m.busreq&3)!=1) {\r
+        u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+        d = *(prg_bank+((a^1)&0x1ffff));\r
+      }\r
+      break;\r
+    case 0x20>>1: // word RAM: 200000 - 220000\r
+      wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
+      a &= 0x1ffff;\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        d = Pico_mcd->word_ram1M[bank][a^1];\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = Pico_mcd->word_ram2M[a^1];\r
+      }\r
+      wrdprintf("ret = %02x", (u8)d);\r
+      break;\r
+    case 0x22>>1: // word RAM: 220000 - 240000\r
+      wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
+        d = Pico_mcd->word_ram1M[bank][a^1];\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
+      }\r
+      wrdprintf("ret = %02x", (u8)d);\r
+      break;\r
+    case 0xc0>>1: case 0xc2>>1: case 0xc4>>1: case 0xc6>>1:\r
+    case 0xc8>>1: case 0xca>>1: case 0xcc>>1: case 0xce>>1:\r
+    case 0xd0>>1: case 0xd2>>1: case 0xd4>>1: case 0xd6>>1:\r
+    case 0xd8>>1: case 0xda>>1: case 0xdc>>1: case 0xde>>1:\r
+      // VDP\r
+      if ((a&0xe700e0)==0xc00000) {\r
+        d=PicoVideoRead(a);\r
+        if ((a&1)==0) d>>=8;\r
+      }\r
+      break;\r
+    case 0xe0>>1: case 0xe2>>1: case 0xe4>>1: case 0xe6>>1:\r
+    case 0xe8>>1: case 0xea>>1: case 0xec>>1: case 0xee>>1:\r
+    case 0xf0>>1: case 0xf2>>1: case 0xf4>>1: case 0xf6>>1:\r
+    case 0xf8>>1: case 0xfa>>1: case 0xfc>>1: case 0xfe>>1:\r
+      // RAM:\r
+      d = *(u8 *)(Pico.ram+((a^1)&0xffff));\r
+      break;\r
+    default:\r
+      if ((a&0xff4000)==0xa00000) { d=z80Read8(a); break; } // Z80 Ram\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("m68k_regs r8: [%02x] @%06x", a&0x3f, SekPc);\r
 \r
-  // prg RAM\r
-  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
-    u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
-    d = *(prg_bank+((a^1)&0x1ffff));\r
-    goto end;\r
-  }\r
+      d=OtherRead16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r
 \r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    wrdprintf("m68k_wram r8: [%06x] @%06x", a, SekPc);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
-      int bank = Pico_mcd->s68k_regs[3]&1;\r
-      if (a >= 0x220000)\r
-           a = (a&3) | (cell_map(a >> 2) << 2); // cell arranged\r
-      else a &= 0x1ffff;\r
-      d = Pico_mcd->word_ram1M[bank][a^1];\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      d = Pico_mcd->word_ram2M[(a^1)&0x3ffff];\r
-    }\r
-    wrdprintf("ret = %02x", (u8)d);\r
-    goto end;\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("ret = %02x", (u8)d);\r
+      break;\r
   }\r
 \r
-  if ((a&0xff4000)==0xa00000) { d=z80Read8(a); goto end; } // Z80 Ram\r
-\r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("m68k_regs r8: [%02x] @%06x", a&0x3f, SekPc);\r
-\r
-  d=OtherRead16(a&~1, 8|(a&1)); if ((a&1)==0) d>>=8;\r
-\r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("ret = %02x", (u8)d);\r
-\r
-  end:\r
 \r
 #ifdef __debug_io\r
   dprintf("r8 : %06x,   %02x @%06x", a&0xffffff, (u8)d, SekPc);\r
@@ -517,47 +542,71 @@ static u32 PicoReadM68k16(u32 a)
 {\r
   u32 d=0;\r
 \r
-  if ((a&0xe00000)==0xe00000) { d=*(u16 *)(Pico.ram+(a&0xfffe)); goto end; } // Ram\r
-\r
   a&=0xfffffe;\r
 \r
-  if (a < 0x20000) { d = *(u16 *)(Pico_mcd->bios+a); goto end; } // bios\r
+  switch (a >> 17)\r
+  {\r
+    case 0x00>>1: // BIOS: 000000 - 020000\r
+      d = *(u16 *)(Pico_mcd->bios+a);\r
+      break;\r
+    case 0x02>>1: // prg RAM\r
+      if ((Pico_mcd->m.busreq&3)!=1) {\r
+        u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+        wrdprintf("m68k_prgram r16: [%i,%06x] @%06x", Pico_mcd->s68k_regs[3]>>6, a, SekPc);\r
+        d = *(u16 *)(prg_bank+(a&0x1fffe));\r
+        wrdprintf("ret = %04x", d);\r
+      }\r
+      break;\r
+    case 0x20>>1: // word RAM: 200000 - 220000\r
+      wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
+      a &= 0x1fffe;\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = *(u16 *)(Pico_mcd->word_ram2M+a);\r
+      }\r
+      wrdprintf("ret = %04x", d);\r
+      break;\r
+    case 0x22>>1: // word RAM: 220000 - 240000\r
+      wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        a = (a&2) | (cell_map(a >> 2) << 2); // cell arranged\r
+        d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
+      }\r
+      wrdprintf("ret = %04x", d);\r
+      break;\r
+    case 0xc0>>1: case 0xc2>>1: case 0xc4>>1: case 0xc6>>1:\r
+    case 0xc8>>1: case 0xca>>1: case 0xcc>>1: case 0xce>>1:\r
+    case 0xd0>>1: case 0xd2>>1: case 0xd4>>1: case 0xd6>>1:\r
+    case 0xd8>>1: case 0xda>>1: case 0xdc>>1: case 0xde>>1:\r
+      // VDP\r
+      if ((a&0xe700e0)==0xc00000)\r
+        d=PicoVideoRead(a);\r
+      break;\r
+    case 0xe0>>1: case 0xe2>>1: case 0xe4>>1: case 0xe6>>1:\r
+    case 0xe8>>1: case 0xea>>1: case 0xec>>1: case 0xee>>1:\r
+    case 0xf0>>1: case 0xf2>>1: case 0xf4>>1: case 0xf6>>1:\r
+    case 0xf8>>1: case 0xfa>>1: case 0xfc>>1: case 0xfe>>1:\r
+      // RAM:\r
+      d=*(u16 *)(Pico.ram+(a&0xfffe));\r
+      break;\r
+    default:\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("m68k_regs r16: [%02x] @%06x", a&0x3f, SekPc);\r
 \r
-  // prg RAM\r
-  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
-    u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
-    wrdprintf("m68k_prgram r16: [%i,%06x] @%06x", Pico_mcd->s68k_regs[3]>>6, a, SekPc);\r
-    d = *(u16 *)(prg_bank+(a&0x1fffe));\r
-    wrdprintf("ret = %04x", d);\r
-    goto end;\r
-  }\r
+      d = OtherRead16(a, 16);\r
 \r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    wrdprintf("m68k_wram r16: [%06x] @%06x", a, SekPc);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
-      int bank = Pico_mcd->s68k_regs[3]&1;\r
-      if (a >= 0x220000)\r
-           a = (a&2) | (cell_map(a >> 2) << 2); // cell arranged\r
-      else a &= 0x1fffe;\r
-      d = *(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      d = *(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
-    }\r
-    wrdprintf("ret = %04x", d);\r
-    goto end;\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("ret = %04x", d);\r
+      break;\r
   }\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("m68k_regs r16: [%02x] @%06x", a&0x3f, SekPc);\r
-\r
-  d = OtherRead16(a, 16);\r
-\r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("ret = %04x", d);\r
-\r
-  end:\r
 \r
 #ifdef __debug_io\r
   dprintf("r16: %06x, %04x  @%06x", a&0xffffff, d, SekPc);\r
@@ -580,52 +629,81 @@ static u32 PicoReadM68k32(u32 a)
 {\r
   u32 d=0;\r
 \r
-  if ((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); d = (pm[0]<<16)|pm[1]; goto end; } // Ram\r
-\r
   a&=0xfffffe;\r
 \r
-  if (a < 0x20000) { u16 *pm=(u16 *)(Pico_mcd->bios+a); d = (pm[0]<<16)|pm[1]; goto end; } // bios\r
-\r
-  // prg RAM\r
-  if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
-    u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
-    u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r
-    d = (pm[0]<<16)|pm[1];\r
-    goto end;\r
-  }\r
-\r
-  // word RAM\r
-  if ((a&0xfc0000)==0x200000) {\r
-    wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
-    if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
-      int bank = Pico_mcd->s68k_regs[3]&1;\r
-      if (a >= 0x220000) { // cell arranged\r
+  switch (a >> 17)\r
+  {\r
+    case 0x00>>1: { // BIOS: 000000 - 020000\r
+      u16 *pm=(u16 *)(Pico_mcd->bios+a);\r
+      d = (pm[0]<<16)|pm[1];\r
+      break;\r
+    }\r
+    case 0x02>>1: // prg RAM\r
+      if ((Pico_mcd->m.busreq&3)!=1) {\r
+        u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+        u16 *pm=(u16 *)(prg_bank+(a&0x1fffe));\r
+        d = (pm[0]<<16)|pm[1];\r
+      }\r
+      break;\r
+    case 0x20>>1: // word RAM: 200000 - 220000\r
+      wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
+      a&=0x1fffe;\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode?\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
+        u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+a);\r
+       d = (pm[0]<<16)|pm[1];\r
+      } else {\r
+        // allow access in any mode, like Gens does\r
+        u16 *pm=(u16 *)(Pico_mcd->word_ram2M+a);\r
+       d = (pm[0]<<16)|pm[1];\r
+      }\r
+      wrdprintf("ret = %08x", d);\r
+      break;\r
+    case 0x22>>1: // word RAM: 220000 - 240000\r
+      wrdprintf("m68k_wram r32: [%06x] @%06x", a, SekPc);\r
+      if (Pico_mcd->s68k_regs[3]&4) { // 1M mode, cell arranged?\r
         u32 a1, a2;\r
+        int bank = Pico_mcd->s68k_regs[3]&1;\r
         a1 = (a&2) | (cell_map(a >> 2) << 2);\r
         if (a&2) a2 = cell_map((a+2) >> 2) << 2;\r
         else     a2 = a1 + 2;\r
         d  = *(u16 *)(Pico_mcd->word_ram1M[bank]+a1) << 16;\r
         d |= *(u16 *)(Pico_mcd->word_ram1M[bank]+a2);\r
       } else {\r
-        u16 *pm=(u16 *)(Pico_mcd->word_ram1M[bank]+(a&0x1fffe)); d = (pm[0]<<16)|pm[1];\r
+        // allow access in any mode, like Gens does\r
+        u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe));\r
+       d = (pm[0]<<16)|pm[1];\r
       }\r
-    } else {\r
-      // allow access in any mode, like Gens does\r
-      u16 *pm=(u16 *)(Pico_mcd->word_ram2M+(a&0x3fffe)); d = (pm[0]<<16)|pm[1];\r
+      wrdprintf("ret = %08x", d);\r
+      break;\r
+    case 0xc0>>1: case 0xc2>>1: case 0xc4>>1: case 0xc6>>1:\r
+    case 0xc8>>1: case 0xca>>1: case 0xcc>>1: case 0xce>>1:\r
+    case 0xd0>>1: case 0xd2>>1: case 0xd4>>1: case 0xd6>>1:\r
+    case 0xd8>>1: case 0xda>>1: case 0xdc>>1: case 0xde>>1:\r
+      // VDP\r
+      d = (PicoVideoRead(a)<<16)|PicoVideoRead(a+2);\r
+      break;\r
+    case 0xe0>>1: case 0xe2>>1: case 0xe4>>1: case 0xe6>>1:\r
+    case 0xe8>>1: case 0xea>>1: case 0xec>>1: case 0xee>>1:\r
+    case 0xf0>>1: case 0xf2>>1: case 0xf4>>1: case 0xf6>>1:\r
+    case 0xf8>>1: case 0xfa>>1: case 0xfc>>1: case 0xfe>>1: {\r
+      // RAM:\r
+      u16 *pm=(u16 *)(Pico.ram+(a&0xfffe));\r
+      d = (pm[0]<<16)|pm[1];\r
+      break;\r
     }\r
-    wrdprintf("ret = %08x", d);\r
-    goto end;\r
-  }\r
+    default:\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("m68k_regs r32: [%02x] @%06x", a&0x3f, SekPc);\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("m68k_regs r32: [%02x] @%06x", a&0x3f, SekPc);\r
+      d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r
 \r
-  d = (OtherRead16(a, 32)<<16)|OtherRead16(a+2, 32);\r
+      if ((a&0xffffc0)==0xa12000)\r
+        rdprintf("ret = %08x", d);\r
+      break;\r
+  }\r
 \r
-  if ((a&0xffffc0)==0xa12000)\r
-    rdprintf("ret = %08x", d);\r
 \r
-  end:\r
 #ifdef __debug_io\r
   dprintf("r32: %06x, %08x @%06x", a&0xffffff, d, SekPc);\r
 #endif\r
@@ -659,8 +737,6 @@ static void PicoWriteM68k8(u32 a,u8 d)
     return;\r
   }\r
 \r
-  a&=0xffffff;\r
-\r
   // prg RAM\r
   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
@@ -668,6 +744,8 @@ static void PicoWriteM68k8(u32 a,u8 d)
     return;\r
   }\r
 \r
+  a&=0xffffff;\r
+\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     wrdprintf("m68k_wram w8: [%06x] %02x @%06x", a, d, SekPc);\r
@@ -712,8 +790,6 @@ static void PicoWriteM68k16(u32 a,u16 d)
     return;\r
   }\r
 \r
-  a&=0xfffffe;\r
-\r
   // prg RAM\r
   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
@@ -722,6 +798,8 @@ static void PicoWriteM68k16(u32 a,u16 d)
     return;\r
   }\r
 \r
+  a&=0xfffffe;\r
+\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     wrdprintf("m68k_wram w16: [%06x] %04x @%06x", a, d, SekPc);\r
@@ -756,6 +834,12 @@ static void PicoWriteM68k16(u32 a,u16 d)
     return;\r
   }\r
 \r
+  // VDP\r
+  if ((a&0xe700e0)==0xc00000) {\r
+    PicoVideoWrite(a,(u16)d);\r
+    return;\r
+  }\r
+\r
   OtherWrite16(a,d);\r
 }\r
 #endif\r
@@ -781,8 +865,6 @@ static void PicoWriteM68k32(u32 a,u32 d)
     return;\r
   }\r
 \r
-  a&=0xfffffe;\r
-\r
   // prg RAM\r
   if ((a&0xfe0000)==0x020000 && (Pico_mcd->m.busreq&3)!=1) {\r
     u8 *prg_bank = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
@@ -791,6 +873,8 @@ static void PicoWriteM68k32(u32 a,u32 d)
     return;\r
   }\r
 \r
+  a&=0xfffffe;\r
+\r
   // word RAM\r
   if ((a&0xfc0000)==0x200000) {\r
     if (d != 0) // don't log clears\r
@@ -821,6 +905,14 @@ static void PicoWriteM68k32(u32 a,u32 d)
     if ((a&0x3e) == 0xe) dprintf("m68k FIXME: w32 [%02x]", a&0x3f);\r
   }\r
 \r
+  // VDP\r
+  if ((a&0xe700e0)==0xc00000)\r
+  {\r
+    PicoVideoWrite(a,  (u16)(d>>16));\r
+    PicoVideoWrite(a+2,(u16)d);\r
+    return;\r
+  }\r
+\r
   OtherWrite16(a,  (u16)(d>>16));\r
   OtherWrite16(a+2,(u16)d);\r
 }\r