svp. does some output now
[picodrive.git] / Pico / VideoPort.c
index 537e917..62f487a 100644 (file)
@@ -1,23 +1,30 @@
 // 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 2006-2007, Grazvydas "notaz" Ignotas\r
 // Free for non-commercial use.\r
 \r
 // For commercial use, separate licencing terms must be obtained.\r
 \r
 \r
 #include "PicoInt.h"\r
+#include "cd/gfx_cd.h"\r
 \r
 extern const unsigned char  hcounts_32[];\r
 extern const unsigned char  hcounts_40[];\r
 extern const unsigned short vcounts[];\r
 extern int rendstatus;\r
 \r
+#ifndef UTYPES_DEFINED\r
+typedef unsigned char  u8;\r
 typedef unsigned short u16;\r
+typedef unsigned int   u32;\r
+#define UTYPES_DEFINED\r
+#endif\r
 \r
+int (*PicoDmaHook)(unsigned int source, int len, unsigned short **srcp, unsigned short **limitp) = NULL;\r
 \r
-static __inline void AutoIncrement()\r
+static __inline void AutoIncrement(void)\r
 {\r
   Pico.video.addr=(unsigned short)(Pico.video.addr+Pico.video.reg[0xf]);\r
 }\r
@@ -32,16 +39,16 @@ static void VideoWrite(u16 d)
             Pico.vram [(a>>1)&0x7fff]=d;\r
             rendstatus|=0x10; break;\r
     case 3: Pico.m.dirtyPal = 1;\r
-            //dprintf("w[%i] @ %04x, inc=%i [%i|%i]", Pico.video.type, a, Pico.video.reg[0xf], Pico.m.scanline, SekCyclesDone());\r
             Pico.cram [(a>>1)&0x003f]=d; break; // wraps (Desert Strike)\r
     case 5: Pico.vsram[(a>>1)&0x003f]=d; break;\r
+    //default:elprintf(EL_ANOMALY, "VDP write %04x with bad type %i", d, Pico.video.type); break;\r
   }\r
 \r
   //dprintf("w[%i] @ %04x, inc=%i [%i|%i]", Pico.video.type, a, Pico.video.reg[0xf], Pico.m.scanline, SekCyclesDone());\r
   AutoIncrement();\r
 }\r
 \r
-static unsigned int VideoRead()\r
+static unsigned int VideoRead(void)\r
 {\r
   unsigned int a=0,d=0;\r
 \r
@@ -52,13 +59,14 @@ static unsigned int VideoRead()
     case 0: d=Pico.vram [a&0x7fff]; break;\r
     case 8: d=Pico.cram [a&0x003f]; break;\r
     case 4: d=Pico.vsram[a&0x003f]; break;\r
+    default:elprintf(EL_ANOMALY, "VDP read with bad type %i", Pico.video.type); break;\r
   }\r
 \r
   AutoIncrement();\r
   return d;\r
 }\r
 \r
-static int GetDmaLength()\r
+static int GetDmaLength(void)\r
 {\r
   struct PicoVideo *pvid=&Pico.video;\r
   int len=0;\r
@@ -81,40 +89,90 @@ static void DmaSlow(int len)
   source|=Pico.video.reg[0x16]<<9;\r
   source|=Pico.video.reg[0x17]<<17;\r
 \r
-  dprintf("DmaSlow[%i] %06x->%04x len %i inc=%i blank %i [%i|%i] @ %x",\r
+  elprintf(EL_VDPDMA, "DmaSlow[%i] %06x->%04x len %i inc=%i blank %i [%i] @ %06x",\r
     Pico.video.type, source, a, len, inc, (Pico.video.status&8)||!(Pico.video.reg[1]&0x40),\r
-    Pico.m.scanline, SekCyclesDone(), SekPc);\r
+    SekCyclesDone(), SekPc);\r
 \r
   if(Pico.m.scanline != -1) {\r
-    Pico.m.dma_bytes += len;\r
-    SekSetCyclesLeft(SekCyclesLeft - CheckDMA());\r
+    Pico.m.dma_xfers += len;\r
+    if ((PicoMCD&1) && (PicoOpt & 0x2000)) SekCyclesBurn(CheckDMA());\r
+    else SekSetCyclesLeftNoMCD(SekCyclesLeftNoMCD - CheckDMA());\r
   } else {\r
     // be approximate in non-accurate mode\r
     SekSetCyclesLeft(SekCyclesLeft - (len*(((488<<8)/167))>>8));\r
   }\r
 \r
-  if ((source&0xe00000)==0xe00000) { pd=(u16 *)(Pico.ram+(source&0xfffe)); pdend=(u16 *)(Pico.ram+0x10000); } // Ram\r
-  else if(PicoMCD & 1) {\r
-    if(source<0x20000) { pd=(u16 *)(Pico_mcd->bios+(source&~1)); pdend=(u16 *)(Pico_mcd->bios+0x20000); } // Bios area\r
-    else { dprintf("unsupported src"); return; } // Invalid source address\r
+  if ((source&0xe00000)==0xe00000) { // Ram\r
+    pd=(u16 *)(Pico.ram+(source&0xfffe));\r
+    pdend=(u16 *)(Pico.ram+0x10000);\r
+  } else if (PicoMCD & 1) {\r
+    elprintf(EL_VDPDMA, "DmaSlow CD, r3=%02x", Pico_mcd->s68k_regs[3]);\r
+    if(source<0x20000) { // Bios area\r
+      pd=(u16 *)(Pico_mcd->bios+(source&~1));\r
+      pdend=(u16 *)(Pico_mcd->bios+0x20000);\r
+    } else if ((source&0xfc0000)==0x200000) { // Word Ram\r
+      source -= 2;\r
+      if (!(Pico_mcd->s68k_regs[3]&4)) { // 2M mode\r
+        pd=(u16 *)(Pico_mcd->word_ram2M+(source&0x3fffe));\r
+        pdend=(u16 *)(Pico_mcd->word_ram2M+0x40000);\r
+      } else {\r
+        if (source < 0x220000) { // 1M mode\r
+          int bank = Pico_mcd->s68k_regs[3]&1;\r
+          pd=(u16 *)(Pico_mcd->word_ram1M[bank]+(source&0x1fffe));\r
+          pdend=(u16 *)(Pico_mcd->word_ram1M[bank]+0x20000);\r
+        } else {\r
+          DmaSlowCell(source, a, len, inc);\r
+          return;\r
+        }\r
+      }\r
+    } else if ((source&0xfe0000)==0x020000) { // Prg Ram\r
+      u8 *prg_ram = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
+      pd=(u16 *)(prg_ram+(source&0x1fffe));\r
+      pdend=(u16 *)(prg_ram+0x20000);\r
+    } else {\r
+      elprintf(EL_VDPDMA|EL_ANOMALY, "DmaSlow[%i] %06x->%04x: FIXME: unsupported src", Pico.video.type, source, a);\r
+      return;\r
+    }\r
   } else {\r
-    if(source<Pico.romsize) { pd=(u16 *)(Pico.rom+(source&~1)); pdend=(u16 *)(Pico.rom+Pico.romsize); } // Rom\r
-    else { dprintf("invalid dma src"); return; } // Invalid source address\r
+    if (source<Pico.romsize) { // Rom\r
+      pd=(u16 *)(Pico.rom+(source&~1));\r
+      pdend=(u16 *)(Pico.rom+Pico.romsize);\r
+    }\r
+    else if (PicoDmaHook && PicoDmaHook(source, len, &pd, &pdend));\r
+    else {\r
+      elprintf(EL_VDPDMA|EL_ANOMALY, "DmaSlow[%i] %06x->%04x: invalid src", Pico.video.type, source, a);\r
+      return;\r
+    }\r
+  }\r
+\r
+  // overflow protection, might break something..\r
+  if (len > pdend - pd) {\r
+    len = pdend - pd;\r
+    elprintf(EL_VDPDMA|EL_ANOMALY, "DmaSlow overflow");\r
   }\r
 \r
   switch (Pico.video.type)\r
   {\r
     case 1: // vram\r
       r = Pico.vram;\r
-      for(; len; len--)\r
+      if (inc == 2 && !(a&1) && a+len*2 < 0x10000)\r
       {\r
-        d=*pd++;\r
-        if(a&1) d=(d<<8)|(d>>8);\r
-        r[a>>1] = (u16)d; // will drop the upper bits\r
-        // AutoIncrement\r
-        a=(u16)(a+inc);\r
-        // didn't src overlap?\r
-        if(pd >= pdend) pd-=0x8000; // should be good for RAM, bad for ROM\r
+        // most used DMA mode\r
+        memcpy16(r + (a>>1), pd, len);\r
+        a += len*2;\r
+      }\r
+      else\r
+      {\r
+        for(; len; len--)\r
+        {\r
+          d=*pd++;\r
+          if(a&1) d=(d<<8)|(d>>8);\r
+          r[a>>1] = (u16)d; // will drop the upper bits\r
+          // AutoIncrement\r
+          a=(u16)(a+inc);\r
+          // didn't src overlap?\r
+          //if(pd >= pdend) pd-=0x8000; // should be good for RAM, bad for ROM\r
+        }\r
       }\r
       rendstatus|=0x10;\r
       break;\r
@@ -124,11 +182,11 @@ static void DmaSlow(int len)
       r = Pico.cram;\r
       for(a2=a&0x7f; len; len--)\r
       {\r
-        r[a2>>1] = (u16)*pd++;; // bit 0 is ignored\r
+        r[a2>>1] = (u16)*pd++; // bit 0 is ignored\r
         // AutoIncrement\r
         a2+=inc;\r
         // didn't src overlap?\r
-        if(pd >= pdend) pd-=0x8000;\r
+        //if(pd >= pdend) pd-=0x8000;\r
         // good dest?\r
         if(a2 >= 0x80) break; // Todds Adventures in Slime World / Andre Agassi tennis\r
       }\r
@@ -143,12 +201,16 @@ static void DmaSlow(int len)
         // AutoIncrement\r
         a2+=inc;\r
         // didn't src overlap?\r
-        if(pd >= pdend) pd-=0x8000;\r
+        //if(pd >= pdend) pd-=0x8000;\r
         // good dest?\r
         if(a2 >= 0x80) break;\r
       }\r
       a=(a&0xff00)|a2;\r
       break;\r
+\r
+    default:\r
+      elprintf(EL_VDPDMA|EL_ANOMALY, "DMA with bad type %i", Pico.video.type);\r
+      break;\r
   }\r
   // remember addr\r
   Pico.video.addr=(u16)a;\r
@@ -161,9 +223,9 @@ static void DmaCopy(int len)
   unsigned char *vrs;\r
   unsigned char inc=Pico.video.reg[0xf];\r
   int source;\r
-  dprintf("DmaCopy len %i [%i|%i]", len, Pico.m.scanline, SekCyclesDone());\r
+  elprintf(EL_VDPDMA, "DmaCopy len %i [%i]", len, SekCyclesDone());\r
 \r
-  Pico.m.dma_bytes += len;\r
+  Pico.m.dma_xfers += len;\r
   if(Pico.m.scanline != -1)\r
     Pico.video.status|=2; // dma busy\r
 \r
@@ -195,9 +257,9 @@ static void DmaFill(int data)
   unsigned char inc=Pico.video.reg[0xf];\r
 \r
   len=GetDmaLength();\r
-  dprintf("DmaFill len %i inc %i [%i|%i]", len, inc, Pico.m.scanline, SekCyclesDone());\r
+  elprintf(EL_VDPDMA, "DmaFill len %i inc %i [%i]", len, inc, SekCyclesDone());\r
 \r
-  Pico.m.dma_bytes += len;\r
+  Pico.m.dma_xfers += len;\r
   if(Pico.m.scanline != -1)\r
     Pico.video.status|=2; // dma busy (in accurate mode)\r
 \r
@@ -224,7 +286,7 @@ static void DmaFill(int data)
   rendstatus|=0x10;\r
 }\r
 \r
-static void CommandDma()\r
+static void CommandDma(void)\r
 {\r
   struct PicoVideo *pvid=&Pico.video;\r
   int len=0,method=0;\r
@@ -238,7 +300,7 @@ static void CommandDma()
   if (method==3) DmaCopy(len); // VRAM Copy\r
 }\r
 \r
-static void CommandChange()\r
+static void CommandChange(void)\r
 {\r
   struct PicoVideo *pvid=&Pico.video;\r
   unsigned int cmd=0,addr=0;\r
@@ -252,13 +314,12 @@ static void CommandChange()
   addr =(cmd>>16)&0x3fff;\r
   addr|=(cmd<<14)&0xc000;\r
   pvid->addr=(unsigned short)addr;\r
-  //dprintf("addr set: %04x", addr);\r
 \r
   // Check for dma:\r
   if (cmd&0x80) CommandDma();\r
 }\r
 \r
-void PicoVideoWrite(unsigned int a,unsigned short d)\r
+PICO_INTERNAL_ASM void PicoVideoWrite(unsigned int a,unsigned short d)\r
 {\r
   struct PicoVideo *pvid=&Pico.video;\r
 \r
@@ -266,8 +327,10 @@ void PicoVideoWrite(unsigned int a,unsigned short d)
 \r
   if (a==0x00) // Data port 0 or 2\r
   {\r
-    if (pvid->pending) CommandChange();\r
-    pvid->pending=0;\r
+    if (pvid->pending) {\r
+      CommandChange();\r
+      pvid->pending=0;\r
+    }\r
 \r
     // If a DMA fill has been set up, do it\r
     if ((pvid->command&0x80) && (pvid->reg[1]&0x10) && (pvid->reg[0x17]>>6)==2)\r
@@ -276,6 +339,18 @@ void PicoVideoWrite(unsigned int a,unsigned short d)
     }\r
     else\r
     {\r
+      // preliminary FIFO emulation for Chaos Engine, The (E)\r
+      if(!(pvid->status&8) && (pvid->reg[1]&0x40) && Pico.m.scanline!=-1 && !(PicoOpt&0x10000)) // active display, accurate mode?\r
+      {\r
+        pvid->status&=~0x200; // FIFO no longer empty\r
+        pvid->lwrite_cnt++;\r
+        if (pvid->lwrite_cnt >= 4) pvid->status|=0x100; // FIFO full\r
+        if (pvid->lwrite_cnt >  4) {\r
+          SekCyclesBurn(32); // penalty // 488/12-8\r
+          if (SekCycleCnt>=SekCycleAim) SekEndRun(0);\r
+        }\r
+        elprintf(EL_ASVDP, "VDP data write: %04x {%i} #%i @ %06x", d, Pico.video.type, pvid->lwrite_cnt, SekPc);\r
+      }\r
       VideoWrite(d);\r
     }\r
     return;\r
@@ -283,7 +358,6 @@ void PicoVideoWrite(unsigned int a,unsigned short d)
 \r
   if (a==0x04) // Control (command) port 4 or 6\r
   {\r
-    //dprintf("vdp cw(%04x), p=%i @ %06x [%i]", d, pvid->pending, SekPc, SekCyclesDone());\r
     if(pvid->pending)\r
     {\r
       // Low word of command:\r
@@ -296,34 +370,31 @@ void PicoVideoWrite(unsigned int a,unsigned short d)
       {\r
         // Register write:\r
         int num=(d>>8)&0x1f;\r
-        if(num==00) dprintf("hint_onoff: %i->%i [%i|%i] pend=%i @ %06x", (pvid->reg[0]&0x10)>>4, (d&0x10)>>4, Pico.m.scanline, SekCyclesDone(), (pvid->pending_ints&0x10)>>4, SekPc);\r
-        if(num==01) dprintf("vint_onoff: %i->%i [%i|%i] pend=%i @ %06x", (pvid->reg[1]&0x20)>>5, (d&0x20)>>5, Pico.m.scanline, SekCyclesDone(), (pvid->pending_ints&0x20)>>5, SekPc);\r
+        if(num==00) elprintf(EL_INTSW, "hint_onoff: %i->%i [%i] pend=%i @ %06x", (pvid->reg[0]&0x10)>>4,\r
+                        (d&0x10)>>4, SekCyclesDone(), (pvid->pending_ints&0x10)>>4, SekPc);\r
+        if(num==01) elprintf(EL_INTSW, "vint_onoff: %i->%i [%i] pend=%i @ %06x", (pvid->reg[1]&0x20)>>5,\r
+                        (d&0x20)>>5, SekCyclesDone(), (pvid->pending_ints&0x20)>>5, SekPc);\r
         //if(num==01) dprintf("set_blank: %i @ %06x [%i|%i]", !((d&0x40)>>6), SekPc, Pico.m.scanline, SekCyclesDone());\r
-        //if(num==05) dprintf("spr_set: %i @ %06x [%i|%i]", (unsigned char)d, SekPc, Pico.m.scanline, SekCyclesDone());\r
         //if(num==10) dprintf("hint_set: %i @ %06x [%i|%i]", (unsigned char)d, SekPc, Pico.m.scanline, SekCyclesDone());\r
         pvid->reg[num]=(unsigned char)d;\r
-#if !(defined(EMU_C68K) && defined(EMU_M68K)) // not debugging Cyclone\r
+#ifndef EMU_CORE_DEBUG\r
         // update IRQ level (Lemmings, Wiz 'n' Liz intro, ... )\r
         // may break if done improperly:\r
-        // International Superstar Soccer Deluxe (crash), Street Racer (logos), Burning Force (gfx), Fatal Rewind (hang), Sesame Street Counting Cafe\r
-        if(num < 2) {\r
-#ifdef EMU_C68K\r
-          // hack: make sure we do not touch the irq line if Cyclone is just about to take the IRQ\r
-          if (PicoCpu.irq <= (PicoCpu.srh&7)) {\r
-#endif\r
-            int lines, pints;\r
+        // International Superstar Soccer Deluxe (crash), Street Racer (logos), Burning Force (gfx),\r
+        // Fatal Rewind (crash), Sesame Street Counting Cafe\r
+        if (num < 2)\r
+        {\r
+          if (!SekShouldInterrupt) // hack\r
+          {\r
+            int lines, pints, irq=0;\r
             lines = (pvid->reg[1] & 0x20) | (pvid->reg[0] & 0x10);\r
             pints = (pvid->pending_ints&lines);\r
-                 if(pints & 0x20) SekInterrupt(6);\r
-            else if(pints & 0x10) SekInterrupt(4);\r
-            else SekInterrupt(0);\r
-#ifdef EMU_C68K\r
-            // adjust cycles for Cyclone so it would take the int "in time"\r
-            if(PicoCpu.irq) {\r
-              SekEndRun(24);\r
-            }\r
+                 if(pints & 0x20) irq = 6;\r
+            else if(pints & 0x10) irq = 4;\r
+            SekInterrupt(irq); // update line\r
+\r
+            if (irq) SekEndRun(24); // make it delayed\r
           }\r
-#endif\r
         }\r
         else\r
 #endif\r
@@ -340,12 +411,13 @@ void PicoVideoWrite(unsigned int a,unsigned short d)
   }\r
 }\r
 \r
-unsigned int PicoVideoRead(unsigned int a)\r
+PICO_INTERNAL_ASM unsigned int PicoVideoRead(unsigned int a)\r
 {\r
   unsigned int d=0;\r
 \r
   a&=0x1c;\r
 \r
+\r
   if (a==0x00) // data port\r
   {\r
     d=VideoRead();\r
@@ -354,15 +426,18 @@ unsigned int PicoVideoRead(unsigned int a)
 \r
   if (a==0x04) // control port\r
   {\r
-    d=Pico.video.status;\r
-    if(PicoOpt&0x10) d|=0x0020; // sprite collision (Shadow of the Beast)\r
-    if(Pico.m.rotate++&8) d|=0x0100; else d|=0x0200; // Toggle fifo full empty (who uses that stuff?)\r
-    if(!(Pico.video.reg[1]&0x40)) d|=0x0008; // set V-Blank if display is disabled\r
-    if(SekCyclesLeft < 84+4)      d|=0x0004; // H-Blank (Sonic3 vs)\r
-    // dprintf("sr_read %04x @ %06x [%i|%i]", d, SekPc, Pico.m.scanline, SekCyclesDone());\r
+    struct PicoVideo *pv=&Pico.video;\r
+    d=pv->status;\r
+    if (PicoOpt&0x10)         d|=0x0020; // sprite collision (Shadow of the Beast)\r
+    if (!(pv->reg[1]&0x40))   d|=0x0008; // set V-Blank if display is disabled\r
+    if (SekCyclesLeft < 84+4) d|=0x0004; // H-Blank (Sonic3 vs)\r
+\r
+    d|=(pv->pending_ints&0x20)<<2; // V-int pending?\r
+    if (d&0x100) pv->status&=~0x100; // FIFO no longer full\r
 \r
-    Pico.video.pending=0; // ctrl port reads clear write-pending flag (Charles MacDonald)\r
+    pv->pending=0; // ctrl port reads clear write-pending flag (Charles MacDonald)\r
 \r
+    elprintf(EL_SR, "SR read: %04x @ %06x", d, SekPc);\r
     goto end;\r
   }\r
 \r
@@ -412,7 +487,7 @@ unsigned int PicoVideoRead(unsigned int a)
       if (d&0xf00) d|= 1;\r
     }\r
 \r
-    dprintf("hv: %02x %02x (%i) @ %06x", hc, d, SekCyclesDone(), SekPc);\r
+    elprintf(EL_HVCNT, "hv: %02x %02x (%i) @ %06x", hc, d, SekCyclesDone(), SekPc);\r
     d&=0xff; d<<=8;\r
     d|=hc;\r
     goto end;\r