32x: new SH2 memory handling, hopefully faster
authornotaz <notasas@gmail.com>
Thu, 15 Oct 2009 20:03:23 +0000 (20:03 +0000)
committernotaz <notasas@gmail.com>
Thu, 15 Oct 2009 20:03:23 +0000 (20:03 +0000)
git-svn-id: file:///home/notaz/opt/svn/PicoDrive@817 be3aeb3a-fb24-0410-a615-afba39da0efa

cpu/sh2/mame/sh2pico.c
cpu/sh2/sh2.c
cpu/sh2/sh2.h
pico/32x/memory.c
pico/cd/memory.c
pico/memory.c
pico/memory.h

index 0ed1397..bdab22b 100644 (file)
@@ -8,12 +8,12 @@ typedef unsigned int   UINT32;
 typedef unsigned short UINT16;
 typedef unsigned char  UINT8;
 
-#define RB(a) p32x_sh2_read8(a,sh2->is_slave)
-#define RW(a) p32x_sh2_read16(a,sh2->is_slave)
-#define RL(a) p32x_sh2_read32(a,sh2->is_slave)
-#define WB(a,d) p32x_sh2_write8(a,d,sh2->is_slave)
-#define WW(a,d) p32x_sh2_write16(a,d,sh2->is_slave)
-#define WL(a,d) p32x_sh2_write32(a,d,sh2->is_slave)
+#define RB(a) p32x_sh2_read8(a,sh2)
+#define RW(a) p32x_sh2_read16(a,sh2)
+#define RL(a) p32x_sh2_read32(a,sh2)
+#define WB(a,d) p32x_sh2_write8(a,d,sh2)
+#define WW(a,d) p32x_sh2_write16(a,d,sh2)
+#define WL(a,d) p32x_sh2_write32(a,d,sh2)
 
 // some stuff from sh2comn.h
 #define T      0x00000001
index 87343b0..cd07bef 100644 (file)
@@ -25,8 +25,8 @@ void sh2_finish(SH2 *sh2)
 
 void sh2_reset(SH2 *sh2)
 {
-       sh2->pc = p32x_sh2_read32(0, sh2->is_slave);
-       sh2->r[15] = p32x_sh2_read32(4, sh2->is_slave);
+       sh2->pc = p32x_sh2_read32(0, sh2);
+       sh2->r[15] = p32x_sh2_read32(4, sh2);
        sh2->sr = I;
        sh2->vbr = 0;
        sh2->pending_int_irq = 0;
@@ -37,15 +37,15 @@ void sh2_do_irq(SH2 *sh2, int level, int vector)
        sh2->irq_callback(sh2->is_slave, level);
 
        sh2->r[15] -= 4;
-       p32x_sh2_write32(sh2->r[15], sh2->sr, sh2->is_slave);   /* push SR onto stack */
+       p32x_sh2_write32(sh2->r[15], sh2->sr, sh2);     /* push SR onto stack */
        sh2->r[15] -= 4;
-       p32x_sh2_write32(sh2->r[15], sh2->pc, sh2->is_slave);   /* push PC onto stack */
+       p32x_sh2_write32(sh2->r[15], sh2->pc, sh2);     /* push PC onto stack */
 
        /* set I flags in SR */
        sh2->sr = (sh2->sr & ~I) | (level << 4);
 
        /* fetch PC */
-       sh2->pc = p32x_sh2_read32(sh2->vbr + vector * 4, sh2->is_slave);
+       sh2->pc = p32x_sh2_read32(sh2->vbr + vector * 4, sh2);
 
        /* 13 cycles at best */
        sh2->cycles_done += 13;
index 33293b6..f9435e0 100644 (file)
@@ -1,16 +1,6 @@
 #ifndef __SH2_H__\r
 #define __SH2_H__\r
 \r
-// pico memhandlers\r
-// XXX: move somewhere else\r
-unsigned int p32x_sh2_read8(unsigned int a, int id);\r
-unsigned int p32x_sh2_read16(unsigned int a, int id);\r
-unsigned int p32x_sh2_read32(unsigned int a, int id);\r
-void p32x_sh2_write8(unsigned int a, unsigned int d, int id);\r
-void p32x_sh2_write16(unsigned int a, unsigned int d, int id);\r
-void p32x_sh2_write32(unsigned int a, unsigned int d, int id);\r
-\r
-\r
 typedef struct\r
 {\r
        unsigned int    r[16];          // 00\r
@@ -27,10 +17,15 @@ typedef struct
        unsigned int    delay;\r
        unsigned int    test_irq;\r
 \r
+       // common\r
+       void    *read8_map;             // 70\r
+       void    *read16_map;\r
+       void    *write8_map;\r
+       void    *write16_map;\r
+\r
        // drc stuff\r
-       void    **pc_hashtab;           // 70\r
+       void    **pc_hashtab;           // 80\r
 \r
-       // common\r
        int     pending_level;          // MAX(pending_irl, pending_int_irq)\r
        int     pending_irl;\r
        int     pending_int_irq;        // internal irq\r
@@ -53,4 +48,13 @@ void sh2_do_irq(SH2 *sh2, int level, int vector);
 \r
 void sh2_execute(SH2 *sh2, int cycles);\r
 \r
+// pico memhandlers\r
+// XXX: move somewhere else\r
+unsigned int p32x_sh2_read8(unsigned int a, SH2 *sh2);\r
+unsigned int p32x_sh2_read16(unsigned int a, SH2 *sh2);\r
+unsigned int p32x_sh2_read32(unsigned int a, SH2 *sh2);\r
+void p32x_sh2_write8(unsigned int a, unsigned int d, SH2 *sh2);\r
+void p32x_sh2_write16(unsigned int a, unsigned int d, SH2 *sh2);\r
+void p32x_sh2_write32(unsigned int a, unsigned int d, SH2 *sh2);\r
+\r
 #endif /* __SH2_H__ */\r
index 332b0bc..7cad030 100644 (file)
@@ -1,4 +1,7 @@
 /*
+ * SH2 addr lines:
+ * iii. .cc. ..xx *   // Internal, Cs, x
+ *
  * Register map:
  * a15100 F....... R.....EA  F.....AC N...VHMP 4000 // Fm Ren nrEs Aden Cart heN V H cMd Pwm
  * a15102 ........ ......SM  ?                 4002 // intS intM
@@ -147,9 +150,8 @@ static void dma_68k2sh2_do(void)
   Pico32x.emu_flags |= P32XF_MSH2POLL; // id ? P32XF_SSH2POLL : P32XF_MSH2POLL;
 
   for (i = 0; i < Pico32x.dmac_ptr && dmac0->tcr0 > 0; i++) {
-    extern void p32x_sh2_write16(u32 a, u32 d, int id);
-      elprintf(EL_32X, "dmaw [%08x] %04x, left %d", dmac0->dar0, Pico32x.dmac_fifo[i], *dreqlen);
-    p32x_sh2_write16(dmac0->dar0, Pico32x.dmac_fifo[i], 0);
+    elprintf(EL_32X, "dmaw [%08x] %04x, left %d", dmac0->dar0, Pico32x.dmac_fifo[i], *dreqlen);
+    p32x_sh2_write16(dmac0->dar0, Pico32x.dmac_fifo[i], &msh2);
     dmac0->dar0 += 2;
     dmac0->tcr0--;
     (*dreqlen)--;
@@ -877,14 +879,6 @@ static void PicoWrite16_hint(u32 a, u32 d)
   elprintf(EL_UIO, "m68k unmapped w16 [%06x] %04x @%06x", a, d & 0xffff, SekPc);
 }
 
-void Pico32xSwapDRAM(int b)
-{
-  cpu68k_map_set(m68k_read8_map,   0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
-  cpu68k_map_set(m68k_read16_map,  0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
-  cpu68k_map_set(m68k_write8_map,  0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
-  cpu68k_map_set(m68k_write16_map, 0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
-}
-
 static void bank_switch(int b)
 {
   unsigned int rs, bank;
@@ -916,54 +910,43 @@ static void bank_switch(int b)
 //                              SH2  
 // -----------------------------------------------------------------
 
-u32 p32x_sh2_read8(u32 a, int id)
+// read8
+static u32 sh2_read8_unmapped(u32 a, int id)
 {
-  u32 d = 0;
-
-  if (id == 0 && a < sizeof(Pico32xMem->sh2_rom_m))
-    return Pico32xMem->sh2_rom_m[a ^ 1];
-  if (id == 1 && a < sizeof(Pico32xMem->sh2_rom_s))
-    return Pico32xMem->sh2_rom_s[a ^ 1];
-
-  if ((a & 0xdffc0000) == 0x06000000)
-    return Pico32xMem->sdram[(a & 0x3ffff) ^ 1];
-
-  if ((a & 0xdfc00000) == 0x02000000)
-    if ((a & 0x003fffff) < Pico.romsize)
-      return Pico.rom[(a & 0x3fffff) ^ 1];
-
-  if ((a & ~0xfff) == 0xc0000000)
-    return Pico32xMem->data_array[id][(a & 0xfff) ^ 1];
+  elprintf(EL_UIO, "%csh2 unmapped r8  [%08x]       %02x @%06x",
+    id ? 's' : 'm', a, 0, sh2_pc(id));
+  return 0;
+}
 
-  if ((a & 0xdffc0000) == 0x04000000) {
-    /* XXX: overwrite readable as normal? */
-    u8 *dram = (u8 *)Pico32xMem->dram[(Pico32x.vdp_regs[0x0a/2] & P32XV_FS) ^ 1];
-    return dram[(a & 0x1ffff) ^ 1];
-  }
+static u32 sh2_read8_cs0(u32 a, int id)
+{
+  u32 d = 0;
 
-  if ((a & 0xdfffff00) == 0x4000) {
+  // 0x3ff00 is veridied
+  if ((a & 0x3ff00) == 0x4000) {
     d = p32x_sh2reg_read16(a, id);
     goto out_16to8;
   }
 
-  if ((a & 0xdfffff00) == 0x4100) {
+  if ((a & 0x3ff00) == 0x4100) {
     d = p32x_vdp_read16(a);
     if (p32x_poll_detect(&sh2_poll[id], a, ash2_cycles_done(), 1))
       ash2_end_run(8);
     goto out_16to8;
   }
 
-  if ((a & 0xdfffff00) == 0x4200) {
+  // TODO: mirroring?
+  if (id == 0 && a < sizeof(Pico32xMem->sh2_rom_m))
+    return Pico32xMem->sh2_rom_m[a ^ 1];
+  if (id == 1 && a < sizeof(Pico32xMem->sh2_rom_s))
+    return Pico32xMem->sh2_rom_s[a ^ 1];
+
+  if ((a & 0x3ff00) == 0x4200) {
     d = Pico32xMem->pal[(a & 0x1ff) / 2];
     goto out_16to8;
   }
 
-  if ((a & 0xfffffe00) == 0xfffffe00)
-    return sh2_peripheral_read8(a, id);
-
-  elprintf(EL_UIO, "%csh2 unmapped r8  [%08x]       %02x @%06x",
-    id ? 's' : 'm', a, d, sh2_pc(id));
-  return d;
+  return sh2_read8_unmapped(a, id);
 
 out_16to8:
   if (a & 1)
@@ -976,53 +959,48 @@ out_16to8:
   return d;
 }
 
-u32 p32x_sh2_read16(u32 a, int id)
+static u32 sh2_read8_da(u32 a, int id)
 {
-  u32 d = 0;
-
-  if (id == 0 && a < sizeof(Pico32xMem->sh2_rom_m))
-    return *(u16 *)(Pico32xMem->sh2_rom_m + a);
-  if (id == 1 && a < sizeof(Pico32xMem->sh2_rom_s))
-    return *(u16 *)(Pico32xMem->sh2_rom_s + a);
-
-  if ((a & 0xdffc0000) == 0x06000000)
-    return ((u16 *)Pico32xMem->sdram)[(a & 0x3ffff) / 2];
-
-  if ((a & 0xdfc00000) == 0x02000000)
-    if ((a & 0x003fffff) < Pico.romsize)
-      return ((u16 *)Pico.rom)[(a & 0x3fffff) / 2];
+  return Pico32xMem->data_array[id][(a & 0xfff) ^ 1];
+}
 
-  if ((a & ~0xfff) == 0xc0000000)
-    return ((u16 *)Pico32xMem->data_array[id])[(a & 0xfff) / 2];
+// read16
+static u32 sh2_read16_unmapped(u32 a, int id)
+{
+  elprintf(EL_UIO, "%csh2 unmapped r16 [%08x]     %04x @%06x",
+    id ? 's' : 'm', a, 0, sh2_pc(id));
+  return 0;
+}
 
-  if ((a & 0xdffe0000) == 0x04000000)
-    return Pico32xMem->dram[(Pico32x.vdp_regs[0x0a/2] & P32XV_FS) ^ 1][(a & 0x1ffff) / 2];
+static u32 sh2_read16_cs0(u32 a, int id)
+{
+  u32 d = 0;
 
-  if ((a & 0xdfffff00) == 0x4000) {
+  if ((a & 0x3ff00) == 0x4000) {
     d = p32x_sh2reg_read16(a, id);
     if (!(EL_LOGMASK & EL_PWM) && (a & 0x30) == 0x30) // hide PWM
       return d;
     goto out;
   }
 
-  if ((a & 0xdfffff00) == 0x4100) {
+  if ((a & 0x3ff00) == 0x4100) {
     d = p32x_vdp_read16(a);
     if (p32x_poll_detect(&sh2_poll[id], a, ash2_cycles_done(), 1))
       ash2_end_run(8);
     goto out;
   }
 
-  if ((a & 0xdfffff00) == 0x4200) {
+  if (id == 0 && a < sizeof(Pico32xMem->sh2_rom_m))
+    return *(u16 *)(Pico32xMem->sh2_rom_m + a);
+  if (id == 1 && a < sizeof(Pico32xMem->sh2_rom_s))
+    return *(u16 *)(Pico32xMem->sh2_rom_s + a);
+
+  if ((a & 0x3ff00) == 0x4200) {
     d = Pico32xMem->pal[(a & 0x1ff) / 2];
     goto out;
   }
 
-  if ((a & 0xfffffe00) == 0xfffffe00)
-    return sh2_peripheral_read16(a, id);
-
-  elprintf(EL_UIO, "%csh2 unmapped r16 [%08x]     %04x @%06x",
-    id ? 's' : 'm', a, d, sh2_pc(id));
-  return d;
+  return sh2_read16_unmapped(a, id);
 
 out:
   elprintf(EL_32X, "%csh2 r16 [%08x]     %04x @%06x",
@@ -1030,129 +1008,232 @@ out:
   return d;
 }
 
-u32 p32x_sh2_read32(u32 a, int id)
+static u32 sh2_read16_da(u32 a, int id)
 {
-  if ((a & 0xfffffe00) == 0xfffffe00)
-    return sh2_peripheral_read32(a, id);
-
-//  elprintf(EL_UIO, "sh2 r32 [%08x] %08x @%06x", a, d, ash2_pc());
-  return (p32x_sh2_read16(a, id) << 16) | p32x_sh2_read16(a + 2, id);
+  return ((u16 *)Pico32xMem->data_array[id])[(a & 0xfff) / 2];
 }
 
-void p32x_sh2_write8(u32 a, u32 d, int id)
+// write8
+static void sh2_write8_unmapped(u32 a, u32 d, int id)
 {
-  if ((a & 0xdffffc00) == 0x4000)
-    elprintf(EL_32X, "%csh2 w8  [%08x]       %02x @%06x",
-      id ? 's' : 'm', a, d & 0xff, sh2_pc(id));
-
-  if ((a & 0xdffc0000) == 0x06000000) {
-    Pico32xMem->sdram[(a & 0x3ffff) ^ 1] = d;
-    return;
-  }
-
-  if ((a & 0xdffc0000) == 0x04000000) {
-    u8 *dram;
-    if (!(a & 0x20000) || d) {
-      dram = (u8 *)Pico32xMem->dram[(Pico32x.vdp_regs[0x0a/2] & P32XV_FS) ^ 1];
-      dram[(a & 0x1ffff) ^ 1] = d;
-    }
-    return;
-  }
+  elprintf(EL_UIO, "%csh2 unmapped w8  [%08x]       %02x @%06x",
+    id ? 's' : 'm', a, d & 0xff, sh2_pc(id));
+}
 
-  if ((a & ~0xfff) == 0xc0000000) {
-    Pico32xMem->data_array[id][(a & 0xfff) ^ 1] = d;
-    return;
-  }
+static void sh2_write8_cs0(u32 a, u32 d, int id)
+{
+  elprintf(EL_32X, "%csh2 w8  [%08x]       %02x @%06x",
+    id ? 's' : 'm', a, d & 0xff, sh2_pc(id));
 
-  if ((a & 0xdfffff00) == 0x4100) {
+  if ((a & 0x3ff00) == 0x4100) {
     p32x_vdp_write8(a, d);
     return;
   }
 
-  if ((a & 0xdfffff00) == 0x4000) {
+  if ((a & 0x3ff00) == 0x4000) {
     p32x_sh2reg_write8(a, d, id);
     return;
   }
 
-  if ((a & 0xfffffe00) == 0xfffffe00) {
-    sh2_peripheral_write8(a, d, id);
-    return;
+  sh2_write8_unmapped(a, d, id);
+}
+
+#define sh2_write8_dramN(n) \
+  if (!(a & 0x20000) || d) { \
+    u8 *dram = (u8 *)Pico32xMem->dram[n]; \
+    dram[(a & 0x1ffff) ^ 1] = d; \
   }
 
-  elprintf(EL_UIO, "%csh2 unmapped w8  [%08x]       %02x @%06x",
-    id ? 's' : 'm', a, d & 0xff, sh2_pc(id));
+static void sh2_write8_dram0(u32 a, u32 d, int id)
+{
+  sh2_write8_dramN(0);
 }
 
-void p32x_sh2_write16(u32 a, u32 d, int id)
+static void sh2_write8_dram1(u32 a, u32 d, int id)
 {
-  if ((a & 0xdffffc00) == 0x4000 && ((EL_LOGMASK & EL_PWM) || (a & 0x30) != 0x30)) // hide PWM
-    elprintf(EL_32X, "%csh2 w16 [%08x]     %04x @%06x",
-      id ? 's' : 'm', a, d & 0xffff, sh2_pc(id));
-
-  // ignore "Associative purge space"
-  if ((a & 0xf8000000) == 0x40000000)
-    return;
+  sh2_write8_dramN(1);
+}
 
-  if ((a & 0xdffc0000) == 0x06000000) {
-    ((u16 *)Pico32xMem->sdram)[(a & 0x3ffff) / 2] = d;
-    return;
-  }
+static void sh2_write8_da(u32 a, u32 d, int id)
+{
+  Pico32xMem->data_array[id][(a & 0xfff) ^ 1] = d;
+}
 
-  if ((a & ~0xfff) == 0xc0000000) {
-    ((u16 *)Pico32xMem->data_array[id])[(a & 0xfff) / 2] = d;
-    return;
-  }
+// write16
+static void sh2_write16_unmapped(u32 a, u32 d, int id)
+{
+  elprintf(EL_UIO, "%csh2 unmapped w16 [%08x]     %04x @%06x",
+    id ? 's' : 'm', a, d & 0xffff, sh2_pc(id));
+}
 
-  if ((a & 0xdffc0000) == 0x04000000) {
-    u16 *pd = &Pico32xMem->dram[(Pico32x.vdp_regs[0x0a/2] & P32XV_FS) ^ 1][(a & 0x1ffff) / 2];
-    if (!(a & 0x20000)) {
-      *pd = d;
-      return;
-    }
-    // overwrite
-    if (!(d & 0xff00)) d |= *pd & 0xff00;
-    if (!(d & 0x00ff)) d |= *pd & 0x00ff;
-    *pd = d;
-    return;
-  }
+static void sh2_write16_cs0(u32 a, u32 d, int id)
+{
+  if (((EL_LOGMASK & EL_PWM) || (a & 0x30) != 0x30)) // hide PWM
+    elprintf(EL_32X, "%csh2 w16 [%08x]     %04x @%06x",
+      id ? 's' : 'm', a, d & 0xffff, sh2_pc(id));
 
-  if ((a & 0xdfffff00) == 0x4100) {
+  if ((a & 0x3ff00) == 0x4100) {
     sh2_poll[id].cnt = 0; // for poll before VDP accesses
     p32x_vdp_write16(a, d);
     return;
   }
 
-  if ((a & 0xdffffe00) == 0x4200) {
+  if ((a & 0x3fe00) == 0x4200) {
     Pico32xMem->pal[(a & 0x1ff) / 2] = d;
     Pico32x.dirty_pal = 1;
     return;
   }
 
-  if ((a & 0xdfffff00) == 0x4000) {
+  if ((a & 0x3ff00) == 0x4000) {
     p32x_sh2reg_write16(a, d, id);
     return;
   }
 
-  if ((a & 0xfffffe00) == 0xfffffe00) {
-    sh2_peripheral_write16(a, d, id);
-    return;
+  sh2_write16_unmapped(a, d, id);
+}
+
+#define sh2_write16_dramN(n) \
+  u16 *pd = &Pico32xMem->dram[n][(a & 0x1ffff) / 2]; \
+  if (!(a & 0x20000)) { \
+    *pd = d; \
+    return; \
+  } \
+  /* overwrite */ \
+  if (!(d & 0xff00)) d |= *pd & 0xff00; \
+  if (!(d & 0x00ff)) d |= *pd & 0x00ff; \
+  *pd = d
+
+static void sh2_write16_dram0(u32 a, u32 d, int id)
+{
+  sh2_write16_dramN(0);
+}
+
+static void sh2_write16_dram1(u32 a, u32 d, int id)
+{
+  sh2_write16_dramN(1);
+}
+
+static void sh2_write16_da(u32 a, u32 d, int id)
+{
+  ((u16 *)Pico32xMem->data_array[id])[(a & 0xfff) / 2] = d;
+}
+
+
+typedef struct {
+  uptr addr; // stores (membase >> 1) or ((handler >> 1) | (1<<31))
+  u32 mask;
+} sh2_memmap;
+
+typedef u32  (sh2_read_handler)(u32 a, int id);
+typedef void (sh2_write_handler)(u32 a, u32 d, int id);
+
+#define SH2MAP_ADDR2OFFS(a) \
+  (((a >> 25) & 3) | ((a >> 27) & 0x1c))
+
+u32 p32x_sh2_read8(u32 a, SH2 *sh2)
+{
+  const sh2_memmap *sh2_map = sh2->read8_map;
+  uptr p;
+
+  sh2_map += SH2MAP_ADDR2OFFS(a);
+  p = sh2_map->addr;
+  if (p & (1 << 31))
+    return ((sh2_read_handler *)(p << 1))(a, sh2->is_slave);
+  else
+    return *(u8 *)((p << 1) + ((a & sh2_map->mask) ^ 1));
+}
+
+u32 p32x_sh2_read16(u32 a, SH2 *sh2)
+{
+  const sh2_memmap *sh2_map = sh2->read16_map;
+  uptr p;
+
+  sh2_map += SH2MAP_ADDR2OFFS(a);
+  p = sh2_map->addr;
+  if (p & (1 << 31))
+    return ((sh2_read_handler *)(p << 1))(a, sh2->is_slave);
+  else
+    return *(u16 *)((p << 1) + ((a & sh2_map->mask) & ~1));
+}
+
+u32 p32x_sh2_read32(u32 a, SH2 *sh2)
+{
+  const sh2_memmap *sh2_map = sh2->read16_map;
+  sh2_read_handler *handler;
+  u32 offs;
+  uptr p;
+
+  offs = SH2MAP_ADDR2OFFS(a);
+  sh2_map += offs;
+  p = sh2_map->addr;
+  if (!(p & (1 << 31))) {
+    // XXX: maybe 32bit access instead with ror?
+    u16 *pd = (u16 *)((p << 1) + ((a & sh2_map->mask) & ~1));
+    return (pd[0] << 16) | pd[1];
   }
 
-  elprintf(EL_UIO, "%csh2 unmapped w16 [%08x]     %04x @%06x",
-    id ? 's' : 'm', a, d & 0xffff, sh2_pc(id));
+  if (offs == 0x1f)
+    return sh2_peripheral_read32(a, sh2->is_slave);
+
+  handler = (sh2_read_handler *)(p << 1);
+  return (handler(a, sh2->is_slave) << 16) | handler(a + 2, sh2->is_slave);
+}
+
+void p32x_sh2_write8(u32 a, u32 d, SH2 *sh2)
+{
+  const sh2_memmap *sh2_map = sh2->write8_map;
+  uptr p;
+
+  sh2_map += SH2MAP_ADDR2OFFS(a);
+  p = sh2_map->addr;
+  if (p & (1 << 31))
+    ((sh2_write_handler *)(p << 1))(a, d, sh2->is_slave);
+  else
+    *(u8 *)((p << 1) + ((a & sh2_map->mask) ^ 1)) = d;
+}
+
+void p32x_sh2_write16(u32 a, u32 d, SH2 *sh2)
+{
+  const sh2_memmap *sh2_map = sh2->write16_map;
+  uptr p;
+
+  sh2_map += SH2MAP_ADDR2OFFS(a);
+  p = sh2_map->addr;
+  if (p & (1 << 31))
+    ((sh2_write_handler *)(p << 1))(a, d, sh2->is_slave);
+  else
+    *(u16 *)((p << 1) + ((a & sh2_map->mask) & ~1)) = d;
 }
 
-void p32x_sh2_write32(u32 a, u32 d, int id)
+void p32x_sh2_write32(u32 a, u32 d, SH2 *sh2)
 {
-  if ((a & 0xfffffe00) == 0xfffffe00) {
-    sh2_peripheral_write32(a, d, id);
+  const sh2_memmap *sh2_map = sh2->write16_map;
+  sh2_write_handler *handler;
+  u32 offs;
+  uptr p;
+
+  offs = SH2MAP_ADDR2OFFS(a);
+  sh2_map += offs;
+  p = sh2_map->addr;
+  if (!(p & (1 << 31))) {
+    u16 *pd = (u16 *)((p << 1) + ((a & sh2_map->mask) & ~1));
+    pd[0] = d >> 16;
+    pd[1] = d;
+    return;
+  }
+
+  if (offs == 0x1f) {
+    sh2_peripheral_write32(a, d, sh2->is_slave);
     return;
   }
 
-  p32x_sh2_write16(a, d >> 16, id);
-  p32x_sh2_write16(a + 2, d, id);
+  handler = (sh2_write_handler *)(p << 1);
+  handler(a, d >> 16, sh2->is_slave);
+  handler(a + 2, d, sh2->is_slave);
 }
 
+// -----------------------------------------------------------------
+
 static const u16 msh2_code[] = {
   // trap instructions
   0xaffe, // bra <self>
@@ -1270,9 +1351,31 @@ static void get_bios(void)
   }
 }
 
+#define MAP_MEMORY(m) ((uptr)(m) >> 1)
+#define MAP_HANDLER(h) (((uptr)(h) >> 1) | (1 << 31))
+
+static sh2_memmap sh2_read8_map[0x20], sh2_read16_map[0x20];
+static sh2_memmap sh2_write8_map[0x20], sh2_write16_map[0x20];
+
+void Pico32xSwapDRAM(int b)
+{
+  cpu68k_map_set(m68k_read8_map,   0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
+  cpu68k_map_set(m68k_read16_map,  0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
+  cpu68k_map_set(m68k_write8_map,  0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
+  cpu68k_map_set(m68k_write16_map, 0x840000, 0x85ffff, Pico32xMem->dram[b], 0);
+
+  // SH2
+  sh2_read8_map[2].addr   = sh2_read8_map[6].addr   =
+  sh2_read16_map[2].addr  = sh2_read16_map[6].addr  = MAP_MEMORY(Pico32xMem->dram[b]);
+
+  sh2_write8_map[2].addr  = sh2_write8_map[6].addr  = MAP_HANDLER(b ? sh2_write8_dram1 : sh2_write8_dram0);
+  sh2_write16_map[2].addr = sh2_write16_map[6].addr = MAP_HANDLER(b ? sh2_write16_dram1 : sh2_write16_dram0);
+}
+
 void PicoMemSetup32x(void)
 {
   unsigned int rs;
+  int i;
 
   Pico32xMem = calloc(1, sizeof(*Pico32xMem));
   if (Pico32xMem == NULL) {
@@ -1296,9 +1399,6 @@ void PicoMemSetup32x(void)
   cpu68k_map_set(m68k_write8_map,  0x000000, rs - 1, PicoWrite8_hint, 1); // TODO verify
   cpu68k_map_set(m68k_write16_map, 0x000000, rs - 1, PicoWrite16_hint, 1);
 
-  // DRAM area
-  Pico32xSwapDRAM(1);
-
   // 32X ROM (unbanked, XXX: consider mirroring?)
   rs = (Pico.romsize + M68K_BANK_MASK) & ~M68K_BANK_MASK;
   if (rs > 0x80000)
@@ -1321,6 +1421,56 @@ void PicoMemSetup32x(void)
   cpu68k_map_set(m68k_write8_map,  0xa10000, 0xa1ffff, PicoWrite8_32x_on, 1);
   cpu68k_map_set(m68k_write16_map, 0xa10000, 0xa1ffff, PicoWrite16_32x_on, 1);
 
+  // SH2 maps: A31,A30,A29,CS1,CS0
+  // all unmapped by default
+  for (i = 0; i < 0x20; i++) {
+    sh2_read8_map[i].addr   = MAP_HANDLER(sh2_read8_unmapped);
+    sh2_read16_map[i].addr  = MAP_HANDLER(sh2_read16_unmapped);
+    sh2_write8_map[i].addr  = MAP_HANDLER(sh2_write8_unmapped);
+    sh2_write16_map[i].addr = MAP_HANDLER(sh2_write16_unmapped);
+  }
+
+  // CS0
+  sh2_read8_map[0].addr   = sh2_read8_map[4].addr   = MAP_HANDLER(sh2_read8_cs0);
+  sh2_read16_map[0].addr  = sh2_read16_map[4].addr  = MAP_HANDLER(sh2_read16_cs0);
+  sh2_write8_map[0].addr  = sh2_write8_map[4].addr  = MAP_HANDLER(sh2_write8_cs0);
+  sh2_write16_map[0].addr = sh2_write16_map[4].addr = MAP_HANDLER(sh2_write16_cs0);
+  // CS1 - ROM
+  sh2_read8_map[1].addr   = sh2_read8_map[5].addr   =
+  sh2_read16_map[1].addr  = sh2_read16_map[5].addr  = MAP_MEMORY(Pico.rom);
+  sh2_read8_map[1].mask   = sh2_read8_map[5].mask   =
+  sh2_read16_map[1].mask  = sh2_read16_map[5].mask  = 0x3fffff; // FIXME
+  // CS2 - DRAM - done by Pico32xSwapDRAM()
+  sh2_read8_map[2].mask   = sh2_read8_map[6].mask   =
+  sh2_read16_map[2].mask  = sh2_read16_map[6].mask  = 0x01ffff;
+  // CS3 - SDRAM
+  sh2_read8_map[3].addr   = sh2_read8_map[7].addr   =
+  sh2_read16_map[3].addr  = sh2_read16_map[7].addr  =
+  sh2_write8_map[3].addr  = sh2_write8_map[7].addr  =
+  sh2_write16_map[3].addr = sh2_write16_map[7].addr = MAP_MEMORY(Pico32xMem->sdram);
+  sh2_read8_map[3].mask   = sh2_read8_map[7].mask   =
+  sh2_read16_map[3].mask  = sh2_read16_map[7].mask  =
+  sh2_write8_map[3].mask  = sh2_write8_map[7].mask  =
+  sh2_write16_map[3].mask = sh2_write16_map[7].mask = 0x03ffff;
+  // SH2 data array
+  sh2_read8_map[0x18].addr   = MAP_HANDLER(sh2_read8_da);
+  sh2_read16_map[0x18].addr  = MAP_HANDLER(sh2_read16_da);
+  sh2_write8_map[0x18].addr  = MAP_HANDLER(sh2_write8_da);
+  sh2_write16_map[0x18].addr = MAP_HANDLER(sh2_write16_da);
+  // SH2 IO
+  sh2_read8_map[0x1f].addr   = MAP_HANDLER(sh2_peripheral_read8);
+  sh2_read16_map[0x1f].addr  = MAP_HANDLER(sh2_peripheral_read16);
+  sh2_write8_map[0x1f].addr  = MAP_HANDLER(sh2_peripheral_write8);
+  sh2_write16_map[0x1f].addr = MAP_HANDLER(sh2_peripheral_write16);
+
+  // map DRAM area, both 68k and SH2
+  Pico32xSwapDRAM(1);
+
+  msh2.read8_map   = ssh2.read8_map   = sh2_read8_map;
+  msh2.read16_map  = ssh2.read16_map  = sh2_read16_map;
+  msh2.write8_map  = ssh2.write8_map  = sh2_write8_map;
+  msh2.write16_map = ssh2.write16_map = sh2_write16_map;
+
   // setup poll detector
   m68k_poll.flag = P32XF_68KPOLL;
   m68k_poll.cyc_max = 64;
@@ -1330,3 +1480,4 @@ void PicoMemSetup32x(void)
   sh2_poll[1].cyc_max = 16;
 }
 
+// vim:shiftwidth=2:expandtab
index 5b3ebf5..f58fc0c 100644 (file)
@@ -7,10 +7,10 @@
 #include "gfx_cd.h"\r
 #include "pcm.h"\r
 \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
+uptr s68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];\r
+uptr s68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];\r
+uptr s68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];\r
+uptr s68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];\r
 \r
 MAKE_68K_READ8(s68k_read8, s68k_read8_map)\r
 MAKE_68K_READ16(s68k_read16, s68k_read16_map)\r
index d36ac62..6281501 100644 (file)
 \r
 extern unsigned int lastSSRamWrite; // used by serial eeprom code\r
 \r
-unsigned long m68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];\r
-unsigned long m68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];\r
-unsigned long m68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];\r
-unsigned long m68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];\r
+uptr m68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];\r
+uptr m68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];\r
+uptr m68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];\r
+uptr m68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];\r
 \r
-static void xmap_set(unsigned long *map, int shift, int start_addr, int end_addr,\r
+static void xmap_set(uptr *map, int shift, int start_addr, int end_addr,\r
     const void *func_or_mh, int is_func)\r
 {\r
-  unsigned long addr = (unsigned long)func_or_mh;\r
+  uptr addr = (uptr)func_or_mh;\r
   int mask = (1 << shift) - 1;\r
   int i;\r
 \r
@@ -48,13 +48,13 @@ static void xmap_set(unsigned long *map, int shift, int start_addr, int end_addr
   }\r
 }\r
 \r
-void z80_map_set(unsigned long *map, int start_addr, int end_addr,\r
+void z80_map_set(uptr *map, int start_addr, int end_addr,\r
     const void *func_or_mh, int is_func)\r
 {\r
   xmap_set(map, Z80_MEM_SHIFT, start_addr, end_addr, func_or_mh, is_func);\r
 }\r
 \r
-void cpu68k_map_set(unsigned long *map, int start_addr, int end_addr,\r
+void cpu68k_map_set(uptr *map, int start_addr, int end_addr,\r
     const void *func_or_mh, int is_func)\r
 {\r
   xmap_set(map, M68K_MEM_SHIFT, start_addr, end_addr, func_or_mh, is_func);\r
@@ -63,8 +63,8 @@ void cpu68k_map_set(unsigned long *map, int start_addr, int end_addr,
 // more specialized/optimized function (does same as above)\r
 void cpu68k_map_all_ram(int start_addr, int end_addr, void *ptr, int is_sub)\r
 {\r
-  unsigned long *r8map, *r16map, *w8map, *w16map;\r
-  unsigned long addr = (unsigned long)ptr;\r
+  uptr *r8map, *r16map, *w8map, *w16map;\r
+  uptr addr = (uptr)ptr;\r
   int shift = M68K_MEM_SHIFT;\r
   int i;\r
 \r
@@ -110,23 +110,23 @@ static void m68k_unmapped_write16(u32 a, u32 d)
 \r
 void m68k_map_unmap(int start_addr, int end_addr)\r
 {\r
-  unsigned long addr;\r
+  uptr addr;\r
   int shift = M68K_MEM_SHIFT;\r
   int i;\r
 \r
-  addr = (unsigned long)m68k_unmapped_read8;\r
+  addr = (uptr)m68k_unmapped_read8;\r
   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
     m68k_read8_map[i] = (addr >> 1) | (1 << 31);\r
 \r
-  addr = (unsigned long)m68k_unmapped_read16;\r
+  addr = (uptr)m68k_unmapped_read16;\r
   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
     m68k_read16_map[i] = (addr >> 1) | (1 << 31);\r
 \r
-  addr = (unsigned long)m68k_unmapped_write8;\r
+  addr = (uptr)m68k_unmapped_write8;\r
   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
     m68k_write8_map[i] = (addr >> 1) | (1 << 31);\r
 \r
-  addr = (unsigned long)m68k_unmapped_write16;\r
+  addr = (uptr)m68k_unmapped_write16;\r
   for (i = start_addr >> shift; i <= end_addr >> shift; i++)\r
     m68k_write16_map[i] = (addr >> 1) | (1 << 31);\r
 }\r
index ec7873f..d43fe23 100644 (file)
@@ -3,25 +3,26 @@
 typedef unsigned char  u8;
 typedef unsigned short u16;
 typedef unsigned int   u32;
+typedef unsigned long  uptr; // unsigned pointer-sized int
 
 #define M68K_MEM_SHIFT 16
 // minimum size we can map
 #define M68K_BANK_SIZE (1 << M68K_MEM_SHIFT)
 #define M68K_BANK_MASK (M68K_BANK_SIZE - 1)
 
-extern unsigned long m68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];
-extern unsigned long m68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];
-extern unsigned long m68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];
-extern unsigned long m68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];
+extern uptr m68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];
+extern uptr m68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];
+extern uptr m68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];
+extern uptr m68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];
 
-extern unsigned long s68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];
-extern unsigned long s68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];
-extern unsigned long s68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];
-extern unsigned long s68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];
+extern uptr s68k_read8_map  [0x1000000 >> M68K_MEM_SHIFT];
+extern uptr s68k_read16_map [0x1000000 >> M68K_MEM_SHIFT];
+extern uptr s68k_write8_map [0x1000000 >> M68K_MEM_SHIFT];
+extern uptr s68k_write16_map[0x1000000 >> M68K_MEM_SHIFT];
 
-void z80_map_set(unsigned long *map, int start_addr, int end_addr,
+void z80_map_set(uptr *map, int start_addr, int end_addr,
     const void *func_or_mh, int is_func);
-void cpu68k_map_set(unsigned long *map, int start_addr, int end_addr,
+void cpu68k_map_set(uptr *map, int start_addr, int end_addr,
     const void *func_or_mh, int is_func);
 void cpu68k_map_all_ram(int start_addr, int end_addr, void *ptr, int is_sub);
 void m68k_map_unmap(int start_addr, int end_addr);
@@ -35,7 +36,7 @@ typedef void (cpu68k_write_f)(u32 a, u32 d);
 #define MAKE_68K_READ8(name, map)               \
 u32 name(u32 a)                                 \
 {                                               \
-  unsigned long v;                              \
+  uptr v;                                       \
   a &= 0x00ffffff;                              \
   v = map[a >> M68K_MEM_SHIFT];                 \
   if (v & 0x80000000)                           \
@@ -47,7 +48,7 @@ u32 name(u32 a)                                 \
 #define MAKE_68K_READ16(name, map)              \
 u32 name(u32 a)                                 \
 {                                               \
-  unsigned long v;                              \
+  uptr v;                                       \
   a &= 0x00fffffe;                              \
   v = map[a >> M68K_MEM_SHIFT];                 \
   if (v & 0x80000000)                           \
@@ -59,7 +60,7 @@ u32 name(u32 a)                                 \
 #define MAKE_68K_READ32(name, map)              \
 u32 name(u32 a)                                 \
 {                                               \
-  unsigned long v, vs;                          \
+  uptr v, vs;                                   \
   u32 d;                                        \
   a &= 0x00fffffe;                              \
   v = map[a >> M68K_MEM_SHIFT];                 \
@@ -78,7 +79,7 @@ u32 name(u32 a)                                 \
 #define MAKE_68K_WRITE8(name, map)              \
 void name(u32 a, u8 d)                          \
 {                                               \
-  unsigned long v;                              \
+  uptr v;                                       \
   a &= 0x00ffffff;                              \
   v = map[a >> M68K_MEM_SHIFT];                 \
   if (v & 0x80000000)                           \
@@ -90,7 +91,7 @@ void name(u32 a, u8 d)                          \
 #define MAKE_68K_WRITE16(name, map)             \
 void name(u32 a, u16 d)                         \
 {                                               \
-  unsigned long v;                              \
+  uptr v;                                       \
   a &= 0x00fffffe;                              \
   v = map[a >> M68K_MEM_SHIFT];                 \
   if (v & 0x80000000)                           \
@@ -102,7 +103,7 @@ void name(u32 a, u16 d)                         \
 #define MAKE_68K_WRITE32(name, map)             \
 void name(u32 a, u32 d)                         \
 {                                               \
-  unsigned long v, vs;                          \
+  uptr v, vs;                                   \
   a &= 0x00fffffe;                              \
   v = map[a >> M68K_MEM_SHIFT];                 \
   vs = v << 1;                                  \