sprite binning finished
[picodrive.git] / Pico / VideoPort.c
index 997b938..7852b25 100644 (file)
@@ -1,7 +1,7 @@
-// This is part of Pico Library\r
+// PicoDrive\r
 \r
 // (c) Copyright 2004 Dave, All rights reserved.\r
-// (c) Copyright 2006 notaz, All rights reserved.\r
+// (c) Copyright 2006-2008, Grazvydas "notaz" Ignotas\r
 // Free for non-commercial use.\r
 \r
 // For commercial use, separate licencing terms must be obtained.\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,18 +35,19 @@ static void VideoWrite(u16 d)
   {\r
     case 1: if(a&1) d=(u16)((d<<8)|(d>>8)); // If address is odd, bytes are swapped (which game needs this?)\r
             Pico.vram [(a>>1)&0x7fff]=d;\r
-            rendstatus|=0x10; break;\r
+            if (a - ((unsigned)(Pico.video.reg[5]&0x7f) << 9) < 0x400)\r
+              rendstatus |= PDRAW_DIRTY_SPRITES;\r
+            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
@@ -54,13 +58,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
@@ -83,24 +88,21 @@ 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
-\r
-  if(Pico.m.scanline != -1) {\r
-    Pico.m.dma_bytes += len;\r
-    if ((PicoMCD&1) && (PicoOpt & 0x2000)) SekCycleCnt+=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
+    SekCyclesDone(), SekPc);\r
+\r
+  Pico.m.dma_xfers += len;\r
+  if ((PicoAHW & PAHW_MCD) && (PicoOpt & POPT_EN_MCD_PSYNC)) SekCyclesBurn(CheckDMA());\r
+  else SekSetCyclesLeftNoMCD(SekCyclesLeftNoMCD - CheckDMA());\r
 \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
-    dprintf("DmaSlow CD, r3=%02x", Pico_mcd->s68k_regs[3]);\r
+  }\r
+  else if (PicoAHW & PAHW_MCD)\r
+  {\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
@@ -114,25 +116,30 @@ static void DmaSlow(int len)
           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
+        } else {\r
           DmaSlowCell(source, a, len, inc);\r
           return;\r
-       }\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
-      dprintf("DmaSlow FIXME: unsupported src");\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) { // Rom\r
+  }\r
+  else\r
+  {\r
+    // if we have DmaHook, let it handle ROM because of possible DMA delay\r
+    if (PicoDmaHook && PicoDmaHook(source, len, &pd, &pdend));\r
+    else if (source<Pico.romsize) { // Rom\r
       pd=(u16 *)(Pico.rom+(source&~1));\r
       pdend=(u16 *)(Pico.rom+Pico.romsize);\r
-    } else {\r
-      dprintf("DmaSlow: invalid dma src");\r
+    }\r
+    else {\r
+      elprintf(EL_VDPDMA|EL_ANOMALY, "DmaSlow[%i] %06x->%04x: invalid src", Pico.video.type, source, a);\r
       return;\r
     }\r
   }\r
@@ -140,7 +147,7 @@ static void DmaSlow(int len)
   // overflow protection, might break something..\r
   if (len > pdend - pd) {\r
     len = pdend - pd;\r
-    dprintf("DmaSlow overflow");\r
+    elprintf(EL_VDPDMA|EL_ANOMALY, "DmaSlow overflow");\r
   }\r
 \r
   switch (Pico.video.type)\r
@@ -166,7 +173,7 @@ static void DmaSlow(int len)
           //if(pd >= pdend) pd-=0x8000; // should be good for RAM, bad for ROM\r
         }\r
       }\r
-      rendstatus|=0x10;\r
+      rendstatus |= PDRAW_DIRTY_SPRITES;\r
       break;\r
 \r
     case 3: // cram\r
@@ -199,6 +206,10 @@ static void DmaSlow(int len)
       }\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
@@ -211,19 +222,18 @@ 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
-  if(Pico.m.scanline != -1)\r
-    Pico.video.status|=2; // dma busy\r
+  Pico.m.dma_xfers += len;\r
+  Pico.video.status |= 2; // dma busy\r
 \r
   source =Pico.video.reg[0x15];\r
   source|=Pico.video.reg[0x16]<<8;\r
   vrs=vr+source;\r
 \r
-  if(source+len > 0x10000) len=0x10000-source; // clip??\r
+  if (source+len > 0x10000) len=0x10000-source; // clip??\r
 \r
-  for(;len;len--)\r
+  for (; len; len--)\r
   {\r
     vr[a] = *vrs++;\r
     // AutoIncrement\r
@@ -231,7 +241,7 @@ static void DmaCopy(int len)
   }\r
   // remember addr\r
   Pico.video.addr=a;\r
-  rendstatus|=0x10;\r
+  rendstatus |= PDRAW_DIRTY_SPRITES;\r
 }\r
 \r
 // check: Contra, Megaman\r
@@ -245,20 +255,19 @@ 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
-  if(Pico.m.scanline != -1)\r
-    Pico.video.status|=2; // dma busy (in accurate mode)\r
+  Pico.m.dma_xfers += len;\r
+  Pico.video.status |= 2; // dma busy\r
 \r
   // from Charles MacDonald's genvdp.txt:\r
   // Write lower byte to address specified\r
   vr[a] = (unsigned char) data;\r
   a=(u16)(a+inc);\r
 \r
-  if(!inc) len=1;\r
+  if (!inc) len=1;\r
 \r
-  for(;len;len--) {\r
+  for (; len; len--) {\r
     // Write upper byte to adjacent address\r
     // (here we are byteswapped, so address is already 'adjacent')\r
     vr[a] = high;\r
@@ -271,10 +280,10 @@ static void DmaFill(int data)
   // update length\r
   Pico.video.reg[0x13] = Pico.video.reg[0x14] = 0; // Dino Dini's Soccer (E) (by Haze)\r
 \r
-  rendstatus|=0x10;\r
+  rendstatus |= PDRAW_DIRTY_SPRITES;\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
@@ -288,7 +297,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
@@ -302,22 +311,41 @@ 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
+static __inline void DrawSync(int blank_on)\r
+{\r
+  if (Pico.m.scanline < 224 && !(PicoOpt & POPT_ALT_RENDERER) &&\r
+      !PicoSkipFrame && DrawScanline <= Pico.m.scanline) {\r
+    //elprintf(EL_ANOMALY, "sync");\r
+    PicoDrawSync(Pico.m.scanline, blank_on);\r
+  }\r
+}\r
+\r
+PICO_INTERNAL_ASM void PicoVideoWrite(unsigned int a,unsigned short d)\r
 {\r
   struct PicoVideo *pvid=&Pico.video;\r
 \r
+  //if (Pico.m.scanline < 224)\r
+  //  elprintf(EL_STATUS, "PicoVideoWrite [%06x] %04x", a, d);\r
   a&=0x1c;\r
 \r
   if (a==0x00) // Data port 0 or 2\r
   {\r
-    if (pvid->pending) CommandChange();\r
-    pvid->pending=0;\r
+    // try avoiding the sync..\r
+    if (Pico.m.scanline < 224 && (pvid->reg[1]&0x40) &&\r
+        !(!pvid->pending &&\r
+          ((pvid->command & 0xc00000f0) == 0x40000010 && Pico.vsram[pvid->addr>>1] == d))\r
+       )\r
+      DrawSync(0);\r
+\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
@@ -326,6 +354,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) && !(PicoOpt&POPT_DIS_VDP_FIFO)) // active display?\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
@@ -333,54 +373,71 @@ 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
+    if (pvid->pending)\r
     {\r
+      if (d & 0x80) DrawSync(0); // only need sync for DMA\r
       // Low word of command:\r
       pvid->command&=0xffff0000;\r
       pvid->command|=d;\r
       pvid->pending=0;\r
       CommandChange();\r
-    } else {\r
-      if((d&0xc000)==0x8000)\r
+    }\r
+    else\r
+    {\r
+      if ((d&0xc000)==0x8000)\r
       {\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==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
+        int dold=pvid->reg[num];\r
+        int update_irq = 0, blank_on = 0;\r
+        pvid->type=0; // register writes clear command (else no Sega logo in Golden Axe II)\r
+        if (num > 0x0a && !(pvid->reg[1]&4)) {\r
+          elprintf(EL_ANOMALY, "%02x written to reg %02x in SMS mode @ %06x", d, num, SekPc);\r
+          return;\r
+        }\r
+\r
+        switch (num)\r
+        {\r
+          case 0x00:\r
+            elprintf(EL_INTSW, "hint_onoff: %i->%i [%i] pend=%i @ %06x", (dold&0x10)>>4,\r
+                    (d&0x10)>>4, SekCyclesDone(), (pvid->pending_ints&0x10)>>4, SekPc);\r
+            update_irq = 1;\r
+            break;\r
+          case 0x01:\r
+            elprintf(EL_INTSW, "vint_onoff: %i->%i [%i] pend=%i @ %06x", (dold&0x20)>>5,\r
+                    (d&0x20)>>5, SekCyclesDone(), (pvid->pending_ints&0x20)>>5, SekPc);\r
+            if (!(d&0x40) && SekCyclesLeft > 390) blank_on = 1;\r
+            update_irq = 1;\r
+            break;\r
+          case 0x05:\r
+            if (d^dold) rendstatus |= PDRAW_SPRITES_MOVED;\r
+            break;\r
+          case 0x0c:\r
+            // renderers should update their palettes if sh/hi mode is changed\r
+            if ((d^dold)&8) Pico.m.dirtyPal = 2;\r
+            break;\r
+        }\r
+        DrawSync(blank_on);\r
         pvid->reg[num]=(unsigned char)d;\r
-#if !(defined(EMU_C68K) && defined(EMU_M68K)) // not debugging Cyclone\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
-            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
-          }\r
-#endif\r
+        if (!update_irq) return;\r
+\r
+#ifndef EMU_CORE_DEBUG\r
+        // update IRQ level\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) 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
-        else\r
 #endif\r
-        if(num == 5) rendstatus|=1;\r
-        else if(num == 0xc) Pico.m.dirtyPal = 2; // renderers should update their palettes if sh/hi mode is changed\r
-        pvid->type=0; // register writes clear command (else no Sega logo in Golden Axe II)\r
-      } else {\r
+      }\r
+      else\r
+      {\r
         // High word of command:\r
         pvid->command&=0x0000ffff;\r
         pvid->command|=d<<16;\r
@@ -390,30 +447,26 @@ 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
-  if (a==0x00) // data port\r
-  {\r
-    d=VideoRead();\r
-    goto end;\r
-  }\r
-\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
+    unsigned int d;\r
+    d=pv->status;\r
+    //if (PicoOpt&POPT_ALT_RENDERER) d|=0x0020; // sprite collision (Shadow of the Beast)\r
+    if (SekCyclesLeft < 84+4)      d|=0x0004; // H-Blank (Sonic3 vs)\r
 \r
-    Pico.video.pending=0; // ctrl port reads clear write-pending flag (Charles MacDonald)\r
+    d |= ((pv->reg[1]&0x40)^0x40) >> 3;  // set V-Blank if display is disabled\r
+    d |= (pv->pending_ints&0x20)<<2;     // V-int pending?\r
+    if (d&0x100) pv->status&=~0x100; // FIFO no longer full\r
 \r
-    goto end;\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
+    return d;\r
   }\r
 \r
   // H-counter info (based on Generator):\r
@@ -433,42 +486,61 @@ unsigned int PicoVideoRead(unsigned int a)
   // check: Sonic 3D Blast bonus, Cannon Fodder, Chase HQ II, 3 Ninjas kick back, Road Rash 3, Skitchin', Wheel of Fortune\r
   if ((a&0x1c)==0x08)\r
   {\r
-    unsigned int hc;\r
+    unsigned int d;\r
+    int lineCycles;\r
 \r
-    if(Pico.m.scanline != -1) {\r
-      int lineCycles=(488-SekCyclesLeft)&0x1ff;\r
-      d=Pico.m.scanline; // V-Counter\r
+    lineCycles = (488-SekCyclesLeft)&0x1ff;\r
+    if (Pico.video.reg[12]&1)\r
+         d = hcounts_40[lineCycles];\r
+    else d = hcounts_32[lineCycles];\r
 \r
-      if(Pico.video.reg[12]&1)\r
-           hc=hcounts_40[lineCycles];\r
-      else hc=hcounts_32[lineCycles];\r
+    elprintf(EL_HVCNT, "hv: %02x %02x (%i) @ %06x", d, Pico.video.v_counter, SekCyclesDone(), SekPc);\r
+    return d | (Pico.video.v_counter << 8);\r
+  }\r
 \r
-      //if(lineCycles > 488-12) d++; // Wheel of Fortune\r
-    } else {\r
-      // get approximate V-Counter\r
-      d=vcounts[SekCyclesDone()>>8];\r
-      hc = Pico.m.rotate&0xff;\r
-    }\r
+  if (a==0x00) // data port\r
+  {\r
+    return VideoRead();\r
+  }\r
 \r
-    if(Pico.m.pal) {\r
-      if(d >= 0x103) d-=56; // based on Gens\r
-    } else {\r
-      if(d >= 0xEB)  d-=6;\r
-    }\r
+  return 0;\r
+}\r
 \r
-    if((Pico.video.reg[12]&6) == 6) {\r
-      // interlace mode 2 (Combat Cars (UE) [!])\r
-      d <<= 1;\r
-      if (d&0xf00) d|= 1;\r
-    }\r
+unsigned int PicoVideoRead8(unsigned int a)\r
+{\r
+  unsigned int d;\r
+  a&=0x1d;\r
 \r
-    dprintf("hv: %02x %02x (%i) @ %06x", hc, d, SekCyclesDone(), SekPc);\r
-    d&=0xff; d<<=8;\r
-    d|=hc;\r
-    goto end;\r
+  switch (a)\r
+  {\r
+    case 0: return VideoRead() >> 8;\r
+    case 1: return VideoRead() & 0xff;\r
+    case 4: // control port/status reg\r
+      d = Pico.video.status >> 8;\r
+      if (d&1) Pico.video.status&=~0x100; // FIFO no longer full\r
+      Pico.video.pending = 0;\r
+      elprintf(EL_SR, "SR read (h): %02x @ %06x", d, SekPc);\r
+      return d;\r
+    case 5:\r
+      d = Pico.video.status & 0xff;\r
+      //if (PicoOpt&POPT_ALT_RENDERER) d|=0x0020; // sprite collision (Shadow of the Beast)\r
+      d |= ((Pico.video.reg[1]&0x40)^0x40) >> 3;  // set V-Blank if display is disabled\r
+      d |= (Pico.video.pending_ints&0x20)<<2;     // V-int pending?\r
+      if (SekCyclesLeft < 84+4) d |= 4;    // H-Blank\r
+      Pico.video.pending = 0;\r
+      elprintf(EL_SR, "SR read (l): %02x @ %06x", d, SekPc);\r
+      return d;\r
+    case 8: // hv counter\r
+      elprintf(EL_HVCNT, "vcounter: %02x (%i) @ %06x", Pico.video.v_counter, SekCyclesDone(), SekPc);\r
+      return Pico.video.v_counter;\r
+    case 9:\r
+      d = (488-SekCyclesLeft)&0x1ff;\r
+      if (Pico.video.reg[12]&1)\r
+           d = hcounts_40[d];\r
+      else d = hcounts_32[d];\r
+      elprintf(EL_HVCNT, "hcounter: %02x (%i) @ %06x", d, SekCyclesDone(), SekPc);\r
+      return d;\r
   }\r
 \r
-end:\r
-\r
-  return d;\r
+  return 0;\r
 }\r