X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=pico%2Fsms.c;fp=pico%2Fsms.c;h=5416845c34d0a2de7b52383d3de50c54dde52816;hb=2ec9bec58b89831cdead4cdec8f593c5b99d2715;hp=a7a0f8f1f3bc35b07f18992f6b3523c9b716128b;hpb=30eb4622c4b3d88dc5169ce255c66b40a22febbb;p=picodrive.git

diff --git a/pico/sms.c b/pico/sms.c
index a7a0f8f..5416845 100644
--- a/pico/sms.c
+++ b/pico/sms.c
@@ -1,29 +1,185 @@
 #include "pico_int.h"
+#include "sound/sn76496.h"
 
-static unsigned char z80_sms_in(unsigned short p)
+static unsigned char vdp_data_read(void)
 {
-  elprintf(EL_ANOMALY, "Z80 port %04x read", p);
-  return 0xff;
+  struct PicoVideo *pv = &Pico.video;
+  unsigned char d;
+
+  d = Pico.vramb[pv->addr];
+  pv->addr = (pv->addr + 1) & 0x3fff;
+  pv->pending = 0;
+  return d;
+}
+
+static unsigned char vdp_ctl_read(void)
+{
+  unsigned char d = Pico.video.pending_ints << 7;
+  Pico.video.pending = 0;
+  Pico.video.pending_ints = 0;
+
+  elprintf(EL_SR, "VDP sr: %02x", d);
+  return d;
+}
+
+static void vdp_data_write(unsigned char d)
+{
+  struct PicoVideo *pv = &Pico.video;
+
+  if (pv->type == 3) {
+    Pico.cram[pv->addr & 0x1f] = d;
+  } else {
+    Pico.vramb[pv->addr] = d;
+  }
+  pv->addr = (pv->addr + 1) & 0x3fff;
+  elprintf(EL_ANOMALY, "  addr=%04x", pv->addr);
+
+  pv->pending = 0;
+}
+
+static void vdp_ctl_write(unsigned char d)
+{
+  struct PicoVideo *pv = &Pico.video;
+
+  if (pv->pending) {
+    if ((d >> 6) == 2) {
+      pv->reg[d & 0x0f] = pv->addr;
+      elprintf(EL_ANOMALY, "  VDP r%02x=%02x", d & 0x0f, pv->addr & 0xff);
+    }
+    pv->type = d >> 6;
+    pv->addr &= 0x00ff;
+    pv->addr |= (d & 0x3f) << 8;
+  } else {
+    pv->addr &= 0x3f00;
+    pv->addr |= d;
+  }
+  pv->pending ^= 1;
 }
 
-static void z80_sms_out(unsigned short p, unsigned char d)
+static unsigned char z80_sms_in(unsigned short a)
 {
-  elprintf(EL_ANOMALY, "Z80 port %04x write %02x", p, d);
+  unsigned char d = 0;
+
+  elprintf(EL_ANOMALY, "z80 port %04x read", a);
+  a &= 0xc1;
+  switch (a)
+  {
+    case 0x00:
+    case 0x01:
+      d = 0xff;
+      break;
+
+    case 0x40: /* V counter */
+      d = Pico.video.v_counter;
+      break;
+
+    case 0x41: /* H counter */
+      d = Pico.m.rotate++;
+      break;
+
+    case 0x80:
+      d = vdp_data_read();
+      break;
+
+    case 0x81:
+      d = vdp_ctl_read();
+      break;
+
+    case 0xc0: /* I/O port A and B */
+      d = ~((PicoPad[0] & 0x3f) | (PicoPad[1] << 6));
+      break;
+
+    case 0xc1: /* I/O port B and miscellaneous */
+      d = (Pico.sms_io_ctl & 0x80) | ((Pico.sms_io_ctl << 1) & 0x40) | 0x30;
+      d |= ~(PicoPad[1] >> 2) & 0x0f;
+      break;
+  }
+
+  elprintf(EL_ANOMALY, "ret = %02x", d);
+  return d;
+}
+
+static void z80_sms_out(unsigned short a, unsigned char d)
+{
+  elprintf(EL_ANOMALY, "z80 port %04x write %02x", a, d);
+  a &= 0xc1;
+  switch (a)
+  {
+    case 0x01:
+      Pico.sms_io_ctl = d;
+      break;
+
+    case 0x40:
+    case 0x41:
+      if (PicoOpt & POPT_EN_PSG)
+        SN76496Write(d);
+      break;
+
+    case 0x80:
+      vdp_data_write(d);
+      break;
+
+    case 0x81:
+      vdp_ctl_write(d);
+      break;
+  }
+}
+
+static void write_bank(unsigned short a, unsigned char d)
+{
+  d &= 0x3f; // XXX
+  switch (a & 0x0f)
+  {
+    case 0x0c:
+      break;
+    case 0x0d:
+      if (d != 0)
+        elprintf(EL_STATUS|EL_ANOMALY, "bank0 changed to %d!", d);
+      break;
+    case 0x0e:
+      z80_map_set(z80_read_map, 0x4000, 0x7fff, Pico.rom + (d << 14), 0);
+#ifdef _USE_CZ80
+      Cz80_Set_Fetch(&CZ80, 0x4000, 0x7fff, (UINT32)Pico.rom + (d << 14));
+#endif
+      break;
+    case 0x0f:
+      z80_map_set(z80_read_map, 0x8000, 0xbfff, Pico.rom + (d << 14), 0);
+#ifdef _USE_CZ80
+      Cz80_Set_Fetch(&CZ80, 0x8000, 0xbfff, (UINT32)Pico.rom + (d << 14));
+#endif
+      break;
+  }
 }
 
 static unsigned char MEMH_FUNC xread(unsigned short a)
 {
-  elprintf(EL_ANOMALY, "Z80 read  [%04x]", a);
-  return 0;
+  elprintf(EL_ANOMALY, "z80 read  [%04x]", a);
+  return Pico.zram[a & 0x1fff];
+}
+
+static void MEMH_FUNC xwrite(unsigned int a, unsigned char d)
+{
+  elprintf(EL_ANOMALY, "z80 write [%04x] %02x", a, d);
+  if (a >= 0xc000)
+    Pico.zram[a & 0x1fff] = d;
+  if (a >= 0xfff0)
+    write_bank(a, d);
 }
 
-static void MEMH_FUNC xwrite(unsigned int a, unsigned char data)
+void PicoResetMS(void)
 {
-  elprintf(EL_ANOMALY, "Z80 write [%04x] %02x", a, data);
+  z80_reset();
+  PsndReset(); // pal must be known here
 }
 
 void PicoPowerMS(void)
 {
+  memset(&Pico.ram,0,(unsigned int)&Pico.rom-(unsigned int)&Pico.ram);
+  memset(&Pico.video,0,sizeof(Pico.video));
+  memset(&Pico.m,0,sizeof(Pico.m));
+  Pico.m.pal = 0;
+
+  PicoReset();
 }
 
 void PicoMemSetupMS(void)
@@ -32,7 +188,7 @@ void PicoMemSetupMS(void)
   z80_map_set(z80_read_map, 0xc000, 0xdfff, Pico.zram, 0);
   z80_map_set(z80_read_map, 0xe000, 0xffff, xread, 1);
 
-  z80_map_set(z80_write_map, 0x0000, 0xbfff, Pico.rom, 0);
+  z80_map_set(z80_write_map, 0x0000, 0xbfff, xwrite, 1);
   z80_map_set(z80_write_map, 0xc000, 0xdfff, Pico.zram, 0);
   z80_map_set(z80_write_map, 0xe000, 0xffff, xwrite, 1);
  
@@ -43,6 +199,7 @@ void PicoMemSetupMS(void)
 #ifdef _USE_CZ80
   Cz80_Set_Fetch(&CZ80, 0x0000, 0xbfff, (UINT32)Pico.rom);
   Cz80_Set_Fetch(&CZ80, 0xc000, 0xdfff, (UINT32)Pico.zram);
+  Cz80_Set_Fetch(&CZ80, 0xe000, 0xffff, (UINT32)Pico.zram);
   Cz80_Set_INPort(&CZ80, z80_sms_in);
   Cz80_Set_OUTPort(&CZ80, z80_sms_out);
 #endif
@@ -50,6 +207,31 @@ void PicoMemSetupMS(void)
 
 void PicoFrameMS(void)
 {
-  z80_run(OSC_NTSC / 13 / 60);
+  struct PicoVideo *pv = &Pico.video;
+  int is_pal = Pico.m.pal;
+  int lines = is_pal ? 313 : 262;
+  int cycles_line = is_pal ? 58020 : 58293; /* (226.6 : 227.7) * 256 */
+  int cycles_done = 0, cycles_aim = 0;
+  int lines_vis = 192;
+  int y;
+
+  for (y = 0; y < lines; y++)
+  {
+    pv->v_counter = Pico.m.scanline = y;
+
+    if (y == lines_vis + 1) {
+      Pico.video.pending_ints |= 1;
+      if (Pico.video.reg[1] & 0x20) {
+        elprintf(EL_INTS, "vint");
+        z80_int();
+      }
+    }
+
+    cycles_aim += cycles_line;
+    cycles_done += z80_run((cycles_aim - cycles_done) >> 8) << 8;
+  }
+
+  PsndGetSamplesMS();
+  elprintf(EL_ANOMALY, "frame end");
 }