Sonic CD runs on GP2X
[picodrive.git] / Pico / cd / Memory.c
index 58fb5c2..fd48416 100644 (file)
@@ -1,7 +1,7 @@
 // This is part of Pico Library\r
 \r
 // (c) Copyright 2004 Dave, All rights reserved.\r
-// (c) Copyright 2006 notaz, All rights reserved.\r
+// (c) Copyright 2007 notaz, All rights reserved.\r
 // Free for non-commercial use.\r
 \r
 // For commercial use, separate licencing terms must be obtained.\r
@@ -474,6 +474,22 @@ u8 PicoReadM68k8(u32 a)
     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
@@ -764,22 +780,6 @@ void PicoWriteM68k32(u32 a,u32 d)
   if ((a&0xffffc0)==0xa12000)\r
     rdprintf("m68k_regs w32: [%02x] %08x @%06x", a&0x3f, d, SekPc);\r
 \r
-#if 0\r
-  if ((a&0x3f) == 0x1c && SekPc == 0xffff05ba)\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
   OtherWrite16(a,  (u16)(d>>16));\r
   OtherWrite16(a+2,(u16)d);\r
 }\r
@@ -1196,6 +1196,97 @@ void PicoWriteS68k32(u32 a,u32 d)
 \r
 // -----------------------------------------------------------------\r
 \r
+\r
+#if defined(EMU_C68K)\r
+static __inline int PicoMemBaseM68k(u32 pc)\r
+{\r
+  int membase=0;\r
+\r
+  if (pc < 0x20000)\r
+  {\r
+    membase=(int)Pico_mcd->bios; // Program Counter in BIOS\r
+  }\r
+  else if ((pc&0xe00000)==0xe00000)\r
+  {\r
+    membase=(int)Pico.ram-(pc&0xff0000); // Program Counter in Ram\r
+  }\r
+  else if ((pc&0xfc0000)==0x200000 && !(Pico_mcd->s68k_regs[3]&4))\r
+  {\r
+    membase=(int)Pico_mcd->word_ram-0x200000; // Program Counter in Word Ram\r
+  }\r
+  else\r
+  {\r
+    // Error - Program Counter is invalid\r
+    dprintf("m68k: unhandled jump to %06x", pc);\r
+    membase=(int)Pico.rom;\r
+  }\r
+\r
+  return membase;\r
+}\r
+\r
+\r
+static u32 PicoCheckPcM68k(u32 pc)\r
+{\r
+  pc-=PicoCpu.membase; // Get real pc\r
+  pc&=0xfffffe;\r
+\r
+  PicoCpu.membase=PicoMemBaseM68k(pc);\r
+\r
+  return PicoCpu.membase+pc;\r
+}\r
+\r
+\r
+static __inline int PicoMemBaseS68k(u32 pc)\r
+{\r
+  int membase;\r
+\r
+  membase=(int)Pico_mcd->prg_ram; // Program Counter in Prg RAM\r
+  if (pc >= 0x80000)\r
+  {\r
+    // Error - Program Counter is invalid\r
+    dprintf("s68k: unhandled jump to %06x", pc);\r
+  }\r
+\r
+  return membase;\r
+}\r
+\r
+\r
+static u32 PicoCheckPcS68k(u32 pc)\r
+{\r
+  pc-=PicoCpuS68k.membase; // Get real pc\r
+  pc&=0xfffffe;\r
+\r
+  PicoCpuS68k.membase=PicoMemBaseS68k(pc);\r
+\r
+  return PicoCpuS68k.membase+pc;\r
+}\r
+#endif\r
+\r
+\r
+void PicoMemSetupCD()\r
+{\r
+  dprintf("PicoMemSetupCD()");\r
+#ifdef EMU_C68K\r
+  // Setup m68k memory callbacks:\r
+  PicoCpu.checkpc=PicoCheckPcM68k;\r
+  PicoCpu.fetch8 =PicoCpu.read8 =PicoReadM68k8;\r
+  PicoCpu.fetch16=PicoCpu.read16=PicoReadM68k16;\r
+  PicoCpu.fetch32=PicoCpu.read32=PicoReadM68k32;\r
+  PicoCpu.write8 =PicoWriteM68k8;\r
+  PicoCpu.write16=PicoWriteM68k16;\r
+  PicoCpu.write32=PicoWriteM68k32;\r
+  // s68k\r
+  PicoCpuS68k.checkpc=PicoCheckPcS68k;\r
+  PicoCpuS68k.fetch8 =PicoCpuS68k.read8 =PicoReadS68k8;\r
+  PicoCpuS68k.fetch16=PicoCpuS68k.read16=PicoReadS68k16;\r
+  PicoCpuS68k.fetch32=PicoCpuS68k.read32=PicoReadS68k32;\r
+  PicoCpuS68k.write8 =PicoWriteS68k8;\r
+  PicoCpuS68k.write16=PicoWriteS68k16;\r
+  PicoCpuS68k.write32=PicoWriteS68k32;\r
+#endif\r
+}\r
+\r
+\r
 #ifdef EMU_M68K\r
 unsigned char  PicoReadCD8w (unsigned int a) {\r
        return m68ki_cpu_p == &PicoS68kCPU ? PicoReadS68k8(a) : PicoReadM68k8(a);\r
@@ -1221,10 +1312,13 @@ unsigned int  m68k_read_pcrelative_CD8 (unsigned int a) {
   a&=0xffffff;\r
   if(m68ki_cpu_p == &PicoS68kCPU) {\r
     if (a < 0x80000) return *(u8 *)(Pico_mcd->prg_ram+(a^1)); // PRG Ram\r
-    else dprintf("s68k read_pcrel8 @ %06x", a);\r
+    dprintf("s68k_read_pcrelative_CD8: can't handle %06x", a);\r
   } else {\r
-    if(a<Pico.romsize)         return *(u8 *)(Pico.rom+(a^1)); // Rom\r
+    if(a<0x20000)              return *(u8 *)(Pico.rom+(a^1)); // Bios\r
     if((a&0xe00000)==0xe00000) return *(u8 *)(Pico.ram+((a^1)&0xffff)); // Ram\r
+    if(!(Pico_mcd->s68k_regs[3]&4) && (a&0xfc0000)==0x200000)\r
+      return Pico_mcd->word_ram[(a^1)&0x3fffe];\r
+    dprintf("m68k_read_pcrelative_CD8: can't handle %06x", a);\r
   }\r
   return 0;//(u8)  lastread_d;\r
 }\r
@@ -1232,23 +1326,29 @@ unsigned int  m68k_read_pcrelative_CD16(unsigned int a) {
   a&=0xffffff;\r
   if(m68ki_cpu_p == &PicoS68kCPU) {\r
     if (a < 0x80000) return *(u16 *)(Pico_mcd->prg_ram+(a&~1)); // PRG Ram\r
-    else dprintf("s68k read_pcrel16 @ %06x", a);\r
+    dprintf("s68k_read_pcrelative_CD16: can't handle %06x", a);\r
   } else {\r
-    if(a<Pico.romsize)         return *(u16 *)(Pico.rom+(a&~1)); // Rom\r
+    if(a<0x20000)              return *(u16 *)(Pico.rom+(a&~1)); // Bios\r
     if((a&0xe00000)==0xe00000) return *(u16 *)(Pico.ram+(a&0xfffe)); // Ram\r
+    if(!(Pico_mcd->s68k_regs[3]&4) && (a&0xfc0000)==0x200000)\r
+      return *(u16 *)(Pico_mcd->word_ram+(a&0x3fffe));\r
+    dprintf("m68k_read_pcrelative_CD16: can't handle %06x", a);\r
   }\r
-  return 0;//(u16) lastread_d;\r
+  return 0;\r
 }\r
 unsigned int  m68k_read_pcrelative_CD32(unsigned int a) {\r
   a&=0xffffff;\r
   if(m68ki_cpu_p == &PicoS68kCPU) {\r
     if (a < 0x80000) { u16 *pm=(u16 *)(Pico_mcd->prg_ram+(a&~1)); return (pm[0]<<16)|pm[1]; } // PRG Ram\r
-    else dprintf("s68k read_pcrel32 @ %06x", a);\r
+    dprintf("s68k_read_pcrelative_CD32: can't handle %06x", a);\r
   } else {\r
-    if(a<Pico.romsize)         { u16 *pm=(u16 *)(Pico.rom+(a&~1));     return (pm[0]<<16)|pm[1]; }\r
+    if(a<0x20000)              { u16 *pm=(u16 *)(Pico.rom+(a&~1));     return (pm[0]<<16)|pm[1]; }\r
     if((a&0xe00000)==0xe00000) { u16 *pm=(u16 *)(Pico.ram+(a&0xfffe)); return (pm[0]<<16)|pm[1]; } // Ram\r
+    if(!(Pico_mcd->s68k_regs[3]&4) && (a&0xfc0000)==0x200000)\r
+      { u16 *pm=(u16 *)(Pico_mcd->word_ram+(a&0x3fffe)); return (pm[0]<<16)|pm[1]; }\r
+    dprintf("m68k_read_pcrelative_CD32: can't handle %06x", a);\r
   }\r
-  return 0; //lastread_d;\r
+  return 0;\r
 }\r
 #endif // EMU_M68K\r
 \r