[picodrive.git] / Pico / VideoPort.c

// This is part of Pico Library\r
\r
// (c) Copyright 2004 Dave, 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(void)\r
{\r
  Pico.video.addr=(unsigned short)(Pico.video.addr+Pico.video.reg[0xf]);\r
}\r
\r
static void VideoWrite(u16 d)\r
{\r
  unsigned int a=Pico.video.addr;\r
\r
  switch (Pico.video.type)\r
  {\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
    case 3: Pico.m.dirtyPal = 1;\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(void)\r
{\r
  unsigned int a=0,d=0;\r
\r
  a=Pico.video.addr; a>>=1;\r
\r
  switch (Pico.video.type)\r
  {\r
    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(void)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int len=0;\r
  // 16-bit words to transfer:\r
  len =pvid->reg[0x13];\r
  len|=pvid->reg[0x14]<<8;\r
  // Charles MacDonald:\r
  if(!len) len = 0xffff;\r
  return len;\r
}\r
\r
static void DmaSlow(int len)\r
{\r
  u16 *pd=0, *pdend, *r;\r
  unsigned int a=Pico.video.addr, a2, d;\r
  unsigned char inc=Pico.video.reg[0xf];\r
  unsigned int source;\r
\r
  source =Pico.video.reg[0x15]<<1;\r
  source|=Pico.video.reg[0x16]<<9;\r
  source|=Pico.video.reg[0x17]<<17;\r
\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
    SekCyclesDone(), SekPc);\r
\r
  if(Pico.m.scanline != -1) {\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) { // 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) { // 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
      if (inc == 2 && !(a&1) && a+len*2 < 0x10000)\r
      {\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
\r
    case 3: // cram\r
      Pico.m.dirtyPal = 1;\r
      r = Pico.cram;\r
      for(a2=a&0x7f; len; len--)\r
      {\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
        // good dest?\r
        if(a2 >= 0x80) break; // Todds Adventures in Slime World / Andre Agassi tennis\r
      }\r
      a=(a&0xff00)|a2;\r
      break;\r
\r
    case 5: // vsram[a&0x003f]=d;\r
      r = Pico.vsram;\r
      for(a2=a&0x7f; len; len--)\r
      {\r
        r[a2>>1] = (u16)*pd++;\r
        // AutoIncrement\r
        a2+=inc;\r
        // didn't src overlap?\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
}\r
\r
static void DmaCopy(int len)\r
{\r
  u16 a=Pico.video.addr;\r
  unsigned char *vr = (unsigned char *) Pico.vram;\r
  unsigned char *vrs;\r
  unsigned char inc=Pico.video.reg[0xf];\r
  int source;\r
  elprintf(EL_VDPDMA, "DmaCopy len %i [%i]", len, SekCyclesDone());\r
\r
  Pico.m.dma_xfers += len;\r
  if(Pico.m.scanline != -1)\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
\r
  for(;len;len--)\r
  {\r
    vr[a] = *vrs++;\r
    // AutoIncrement\r
    a=(u16)(a+inc);\r
  }\r
  // remember addr\r
  Pico.video.addr=a;\r
  rendstatus|=0x10;\r
}\r
\r
// check: Contra, Megaman\r
// note: this is still inaccurate\r
static void DmaFill(int data)\r
{\r
  int len;\r
  unsigned short a=Pico.video.addr;\r
  unsigned char *vr=(unsigned char *) Pico.vram;\r
  unsigned char high = (unsigned char) (data >> 8);\r
  unsigned char inc=Pico.video.reg[0xf];\r
\r
  len=GetDmaLength();\r
  elprintf(EL_VDPDMA, "DmaFill len %i inc %i [%i]", len, inc, SekCyclesDone());\r
\r
  Pico.m.dma_xfers += len;\r
  if(Pico.m.scanline != -1)\r
    Pico.video.status|=2; // dma busy (in accurate mode)\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
\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
\r
    // Increment address register\r
    a=(u16)(a+inc);\r
  }\r
  // remember addr\r
  Pico.video.addr=a;\r
  // update length\r
  Pico.video.reg[0x13] = Pico.video.reg[0x14] = 0; // Dino Dini's Soccer (E) (by Haze)\r
\r
  rendstatus|=0x10;\r
}\r
\r
static void CommandDma(void)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int len=0,method=0;\r
\r
  if ((pvid->reg[1]&0x10)==0) return; // DMA not enabled\r
\r
  len=GetDmaLength();\r
\r
  method=pvid->reg[0x17]>>6;\r
  if (method< 2) DmaSlow(len); // 68000 to VDP\r
  if (method==3) DmaCopy(len); // VRAM Copy\r
}\r
\r
static void CommandChange(void)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  unsigned int cmd=0,addr=0;\r
\r
  cmd=pvid->command;\r
\r
  // Get type of transfer 0xc0000030 (v/c/vsram read/write)\r
  pvid->type=(unsigned char)(((cmd>>2)&0xc)|(cmd>>30));\r
\r
  // Get address 0x3fff0003\r
  addr =(cmd>>16)&0x3fff;\r
  addr|=(cmd<<14)&0xc000;\r
  pvid->addr=(unsigned short)addr;\r
\r
  // Check for dma:\r
  if (cmd&0x80) CommandDma();\r
}\r
\r
PICO_INTERNAL_ASM void PicoVideoWrite(unsigned int a,unsigned short d)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
\r
  a&=0x1c;\r
\r
  if (a==0x00) // Data port 0 or 2\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
    {\r
      DmaFill(d);\r
    }\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
  }\r
\r
  if (a==0x04) // Control (command) port 4 or 6\r
  {\r
    if(pvid->pending)\r
    {\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
        // Register write:\r
        int num=(d>>8)&0x1f;\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==10) dprintf("hint_set: %i @ %06x [%i|%i]", (unsigned char)d, SekPc, Pico.m.scanline, SekCyclesDone());\r
        pvid->reg[num]=(unsigned char)d;\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),\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) 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
        }\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
        // High word of command:\r
        pvid->command&=0x0000ffff;\r
        pvid->command|=d<<16;\r
        pvid->pending=1;\r
      }\r
    }\r
  }\r
}\r
\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
    goto end;\r
  }\r
\r
  if (a==0x04) // control port\r
  {\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
    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
  // H-counter info (based on Generator):\r
  // frame:\r
  //                       |       <- hblank? ->      |\r
  // start    <416>       hint  <36> hdisplay <38>  end // CPU cycles\r
  // |---------...---------|------------|-------------|\r
  // 0                   B6 E4                       FF // 40 cells\r
  // 0                   93 E8                       FF // 32 cells\r
\r
  // Gens (?)              v-render\r
  // start  <hblank=84>   hint    hdisplay <404>      |\r
  // |---------------------|--------------------------|\r
  // E4  (hc[0x43]==0)    07                         B1 // 40\r
  // E8  (hc[0x45]==0)    05                         91 // 32\r
\r
  // 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
\r
    if(Pico.m.scanline != -1) {\r
      int lineCycles=(488-SekCyclesLeft)&0x1ff;\r
      d=Pico.m.scanline; // V-Counter\r
\r
      if(Pico.video.reg[12]&1)\r
           hc=hcounts_40[lineCycles];\r
      else hc=hcounts_32[lineCycles];\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
\r
    if(Pico.m.pal) {\r
      if(d >= 0x103) d-=56; // based on Gens\r
    } else {\r
      if(d >= 0xEB)  d-=6;\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
\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
  }\r
\r
end:\r
\r
  return d;\r
}\r
Commit	Line	Data
cc68a136	1	// This is part of Pico Library\r
	2	\r
	3	// (c) Copyright 2004 Dave, All rights reserved.\r
6cadc2da	4	// (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas\r
cc68a136	5	// Free for non-commercial use.\r
	6	\r
	7	// For commercial use, separate licencing terms must be obtained.\r
	8	\r
	9	\r
	10	#include "PicoInt.h"\r
fa1e5e29	11	#include "cd/gfx_cd.h"\r
cc68a136	12	\r
	13	extern const unsigned char hcounts_32[];\r
	14	extern const unsigned char hcounts_40[];\r
	15	extern const unsigned short vcounts[];\r
	16	extern int rendstatus;\r
	17	\r
eff55556	18	#ifndef UTYPES_DEFINED\r
ab0607f7	19	typedef unsigned char u8;\r
cc68a136	20	typedef unsigned short u16;\r
eff55556	21	typedef unsigned int u32;\r
	22	#define UTYPES_DEFINED\r
	23	#endif\r
cc68a136	24	\r
5de27868	25	int (PicoDmaHook)(unsigned int source, int len, unsigned short srcp, unsigned short *limitp) = NULL;\r
cc68a136	26	\r
69996cb7	27	static __inline void AutoIncrement(void)\r
cc68a136	28	{\r
	29	Pico.video.addr=(unsigned short)(Pico.video.addr+Pico.video.reg[0xf]);\r
	30	}\r
	31	\r
	32	static void VideoWrite(u16 d)\r
	33	{\r
	34	unsigned int a=Pico.video.addr;\r
	35	\r
	36	switch (Pico.video.type)\r
	37	{\r
	38	case 1: if(a&1) d=(u16)((d<<8)\|(d>>8)); // If address is odd, bytes are swapped (which game needs this?)\r
	39	Pico.vram [(a>>1)&0x7fff]=d;\r
	40	rendstatus\|=0x10; break;\r
	41	case 3: Pico.m.dirtyPal = 1;\r
cc68a136	42	Pico.cram [(a>>1)&0x003f]=d; break; // wraps (Desert Strike)\r
cc68a136	43	case 5: Pico.vsram[(a>>1)&0x003f]=d; break;\r
69996cb7	44	default:elprintf(EL_ANOMALY, "VDP write %04x with bad type %i", d, Pico.video.type); break;\r
cc68a136	45	}\r
	46	\r
	47	//dprintf("w[%i] @ %04x, inc=%i [%i\|%i]", Pico.video.type, a, Pico.video.reg[0xf], Pico.m.scanline, SekCyclesDone());\r
	48	AutoIncrement();\r
	49	}\r
	50	\r
69996cb7	51	static unsigned int VideoRead(void)\r
cc68a136	52	{\r
	53	unsigned int a=0,d=0;\r
	54	\r
	55	a=Pico.video.addr; a>>=1;\r
	56	\r
	57	switch (Pico.video.type)\r
	58	{\r
	59	case 0: d=Pico.vram [a&0x7fff]; break;\r
	60	case 8: d=Pico.cram [a&0x003f]; break;\r
	61	case 4: d=Pico.vsram[a&0x003f]; break;\r
69996cb7	62	default:elprintf(EL_ANOMALY, "VDP read with bad type %i", Pico.video.type); break;\r
cc68a136	63	}\r
4f672280	64	\r
cc68a136	65	AutoIncrement();\r
	66	return d;\r
	67	}\r
	68	\r
69996cb7	69	static int GetDmaLength(void)\r
cc68a136	70	{\r
	71	struct PicoVideo *pvid=&Pico.video;\r
	72	int len=0;\r
	73	// 16-bit words to transfer:\r
	74	len =pvid->reg[0x13];\r
	75	len\|=pvid->reg[0x14]<<8;\r
	76	// Charles MacDonald:\r
	77	if(!len) len = 0xffff;\r
	78	return len;\r
	79	}\r
	80	\r
	81	static void DmaSlow(int len)\r
	82	{\r
	83	u16 pd=0, pdend, *r;\r
	84	unsigned int a=Pico.video.addr, a2, d;\r
	85	unsigned char inc=Pico.video.reg[0xf];\r
672ad671	86	unsigned int source;\r
cc68a136	87	\r
	88	source =Pico.video.reg[0x15]<<1;\r
	89	source\|=Pico.video.reg[0x16]<<9;\r
	90	source\|=Pico.video.reg[0x17]<<17;\r
	91	\r
69996cb7	92	elprintf(EL_VDPDMA, "DmaSlow[%i] %06x->%04x len %i inc=%i blank %i [%i] @ %06x",\r
312e9ce1	93	Pico.video.type, source, a, len, inc, (Pico.video.status&8)\|\|!(Pico.video.reg[1]&0x40),\r
69996cb7	94	SekCyclesDone(), SekPc);\r
cc68a136	95	\r
672ad671	96	if(Pico.m.scanline != -1) {\r
69996cb7	97	Pico.m.dma_xfers += len;\r
2d0b15bb	98	if ((PicoMCD&1) && (PicoOpt & 0x2000)) SekCyclesBurn(CheckDMA());\r
7336a99a	99	else SekSetCyclesLeftNoMCD(SekCyclesLeftNoMCD - CheckDMA());\r
672ad671	100	} else {\r
	101	// be approximate in non-accurate mode\r
	102	SekSetCyclesLeft(SekCyclesLeft - (len*(((488<<8)/167))>>8));\r
	103	}\r
	104	\r
ab0607f7	105	if ((source&0xe00000)==0xe00000) { // Ram\r
	106	pd=(u16 *)(Pico.ram+(source&0xfffe));\r
	107	pdend=(u16 *)(Pico.ram+0x10000);\r
f8ef8ff7	108	} else if (PicoMCD & 1) {\r
69996cb7	109	elprintf(EL_VDPDMA, "DmaSlow CD, r3=%02x", Pico_mcd->s68k_regs[3]);\r
ab0607f7	110	if(source<0x20000) { // Bios area\r
	111	pd=(u16 *)(Pico_mcd->bios+(source&~1));\r
	112	pdend=(u16 *)(Pico_mcd->bios+0x20000);\r
fa1e5e29	113	} else if ((source&0xfc0000)==0x200000) { // Word Ram\r
fa1e5e29	114	source -= 2;\r
ab0607f7	115	if (!(Pico_mcd->s68k_regs[3]&4)) { // 2M mode\r
fa1e5e29	116	pd=(u16 *)(Pico_mcd->word_ram2M+(source&0x3fffe));\r
fa1e5e29	117	pdend=(u16 *)(Pico_mcd->word_ram2M+0x40000);\r
ab0607f7	118	} else {\r
fa1e5e29	119	if (source < 0x220000) { // 1M mode\r
	120	int bank = Pico_mcd->s68k_regs[3]&1;\r
	121	pd=(u16 *)(Pico_mcd->word_ram1M[bank]+(source&0x1fffe));\r
	122	pdend=(u16 *)(Pico_mcd->word_ram1M[bank]+0x20000);\r
69996cb7	123	} else {\r
fa1e5e29	124	DmaSlowCell(source, a, len, inc);\r
fa1e5e29	125	return;\r
69996cb7	126	}\r
ab0607f7	127	}\r
	128	} else if ((source&0xfe0000)==0x020000) { // Prg Ram\r
	129	u8 *prg_ram = Pico_mcd->prg_ram_b[Pico_mcd->s68k_regs[3]>>6];\r
	130	pd=(u16 *)(prg_ram+(source&0x1fffe));\r
	131	pdend=(u16 *)(prg_ram+0x20000);\r
	132	} else {\r
03e4f2a3	133	elprintf(EL_VDPDMA\|EL_ANOMALY, "DmaSlow[%i] %06x->%04x: FIXME: unsupported src", Pico.video.type, source, a);\r
ab0607f7	134	return;\r
ab0607f7	135	}\r
672ad671	136	} else {\r
f8ef8ff7	137	if (source<Pico.romsize) { // Rom\r
ab0607f7	138	pd=(u16 *)(Pico.rom+(source&~1));\r
ab0607f7	139	pdend=(u16 *)(Pico.rom+Pico.romsize);\r
f8ef8ff7	140	}\r
5de27868	141	else if (PicoDmaHook && PicoDmaHook(source, len, &pd, &pdend));\r
f8ef8ff7	142	else {\r
03e4f2a3	143	elprintf(EL_VDPDMA\|EL_ANOMALY, "DmaSlow[%i] %06x->%04x: invalid src", Pico.video.type, source, a);\r
ab0607f7	144	return;\r
	145	}\r
	146	}\r
	147	\r
	148	// overflow protection, might break something..\r
	149	if (len > pdend - pd) {\r
	150	len = pdend - pd;\r
69996cb7	151	elprintf(EL_VDPDMA\|EL_ANOMALY, "DmaSlow overflow");\r
672ad671	152	}\r
cc68a136	153	\r
	154	switch (Pico.video.type)\r
	155	{\r
	156	case 1: // vram\r
	157	r = Pico.vram;\r
cea65903	158	if (inc == 2 && !(a&1) && a+len*2 < 0x10000)\r
cc68a136	159	{\r
cea65903	160	// most used DMA mode\r
fa1e5e29	161	memcpy16(r + (a>>1), pd, len);\r
fa1e5e29	162	a += len*2;\r
cea65903	163	}\r
	164	else\r
	165	{\r
	166	for(; len; len--)\r
	167	{\r
	168	d=*pd++;\r
	169	if(a&1) d=(d<<8)\|(d>>8);\r
	170	r[a>>1] = (u16)d; // will drop the upper bits\r
	171	// AutoIncrement\r
	172	a=(u16)(a+inc);\r
	173	// didn't src overlap?\r
	174	//if(pd >= pdend) pd-=0x8000; // should be good for RAM, bad for ROM\r
	175	}\r
cc68a136	176	}\r
	177	rendstatus\|=0x10;\r
	178	break;\r
4f672280	179	\r
cc68a136	180	case 3: // cram\r
cc68a136	181	Pico.m.dirtyPal = 1;\r
	182	r = Pico.cram;\r
	183	for(a2=a&0x7f; len; len--)\r
	184	{\r
0a051f55	185	r[a2>>1] = (u16)*pd++; // bit 0 is ignored\r
cc68a136	186	// AutoIncrement\r
	187	a2+=inc;\r
	188	// didn't src overlap?\r
ab0607f7	189	//if(pd >= pdend) pd-=0x8000;\r
cc68a136	190	// good dest?\r
	191	if(a2 >= 0x80) break; // Todds Adventures in Slime World / Andre Agassi tennis\r
	192	}\r
	193	a=(a&0xff00)\|a2;\r
	194	break;\r
	195	\r
	196	case 5: // vsram[a&0x003f]=d;\r
	197	r = Pico.vsram;\r
	198	for(a2=a&0x7f; len; len--)\r
	199	{\r
	200	r[a2>>1] = (u16)*pd++;\r
	201	// AutoIncrement\r
	202	a2+=inc;\r
	203	// didn't src overlap?\r
ab0607f7	204	//if(pd >= pdend) pd-=0x8000;\r
cc68a136	205	// good dest?\r
	206	if(a2 >= 0x80) break;\r
	207	}\r
	208	a=(a&0xff00)\|a2;\r
	209	break;\r
69996cb7	210	\r
	211	default:\r
	212	elprintf(EL_VDPDMA\|EL_ANOMALY, "DMA with bad type %i", Pico.video.type);\r
	213	break;\r
cc68a136	214	}\r
	215	// remember addr\r
	216	Pico.video.addr=(u16)a;\r
	217	}\r
	218	\r
	219	static void DmaCopy(int len)\r
	220	{\r
	221	u16 a=Pico.video.addr;\r
	222	unsigned char vr = (unsigned char ) Pico.vram;\r
	223	unsigned char *vrs;\r
	224	unsigned char inc=Pico.video.reg[0xf];\r
	225	int source;\r
69996cb7	226	elprintf(EL_VDPDMA, "DmaCopy len %i [%i]", len, SekCyclesDone());\r
4f672280	227	\r
69996cb7	228	Pico.m.dma_xfers += len;\r
8c1952f0	229	if(Pico.m.scanline != -1)\r
8c1952f0	230	Pico.video.status\|=2; // dma busy\r
cc68a136	231	\r
	232	source =Pico.video.reg[0x15];\r
	233	source\|=Pico.video.reg[0x16]<<8;\r
	234	vrs=vr+source;\r
	235	\r
	236	if(source+len > 0x10000) len=0x10000-source; // clip??\r
	237	\r
	238	for(;len;len--)\r
	239	{\r
	240	vr[a] = *vrs++;\r
	241	// AutoIncrement\r
	242	a=(u16)(a+inc);\r
	243	}\r
	244	// remember addr\r
	245	Pico.video.addr=a;\r
	246	rendstatus\|=0x10;\r
	247	}\r
	248	\r
	249	// check: Contra, Megaman\r
	250	// note: this is still inaccurate\r
	251	static void DmaFill(int data)\r
	252	{\r
	253	int len;\r
	254	unsigned short a=Pico.video.addr;\r
	255	unsigned char vr=(unsigned char ) Pico.vram;\r
	256	unsigned char high = (unsigned char) (data >> 8);\r
	257	unsigned char inc=Pico.video.reg[0xf];\r
4f672280	258	\r
cc68a136	259	len=GetDmaLength();\r
69996cb7	260	elprintf(EL_VDPDMA, "DmaFill len %i inc %i [%i]", len, inc, SekCyclesDone());\r
4f672280	261	\r
69996cb7	262	Pico.m.dma_xfers += len;\r
8c1952f0	263	if(Pico.m.scanline != -1)\r
8c1952f0	264	Pico.video.status\|=2; // dma busy (in accurate mode)\r
cc68a136	265	\r
	266	// from Charles MacDonald's genvdp.txt:\r
	267	// Write lower byte to address specified\r
	268	vr[a] = (unsigned char) data;\r
	269	a=(u16)(a+inc);\r
	270	\r
	271	if(!inc) len=1;\r
	272	\r
	273	for(;len;len--) {\r
	274	// Write upper byte to adjacent address\r
	275	// (here we are byteswapped, so address is already 'adjacent')\r
	276	vr[a] = high;\r
	277	\r
	278	// Increment address register\r
	279	a=(u16)(a+inc);\r
	280	}\r
	281	// remember addr\r
	282	Pico.video.addr=a;\r
	283	// update length\r
	284	Pico.video.reg[0x13] = Pico.video.reg[0x14] = 0; // Dino Dini's Soccer (E) (by Haze)\r
	285	\r
	286	rendstatus\|=0x10;\r
	287	}\r
	288	\r
69996cb7	289	static void CommandDma(void)\r
cc68a136	290	{\r
	291	struct PicoVideo *pvid=&Pico.video;\r
	292	int len=0,method=0;\r
	293	\r
	294	if ((pvid->reg[1]&0x10)==0) return; // DMA not enabled\r
	295	\r
	296	len=GetDmaLength();\r
	297	\r
	298	method=pvid->reg[0x17]>>6;\r
	299	if (method< 2) DmaSlow(len); // 68000 to VDP\r
	300	if (method==3) DmaCopy(len); // VRAM Copy\r
	301	}\r
	302	\r
69996cb7	303	static void CommandChange(void)\r
cc68a136	304	{\r
	305	struct PicoVideo *pvid=&Pico.video;\r
	306	unsigned int cmd=0,addr=0;\r
	307	\r
	308	cmd=pvid->command;\r
	309	\r
	310	// Get type of transfer 0xc0000030 (v/c/vsram read/write)\r
	311	pvid->type=(unsigned char)(((cmd>>2)&0xc)\|(cmd>>30));\r
	312	\r
	313	// Get address 0x3fff0003\r
	314	addr =(cmd>>16)&0x3fff;\r
	315	addr\|=(cmd<<14)&0xc000;\r
	316	pvid->addr=(unsigned short)addr;\r
cc68a136	317	\r
	318	// Check for dma:\r
	319	if (cmd&0x80) CommandDma();\r
	320	}\r
	321	\r
eff55556	322	PICO_INTERNAL_ASM void PicoVideoWrite(unsigned int a,unsigned short d)\r
cc68a136	323	{\r
	324	struct PicoVideo *pvid=&Pico.video;\r
	325	\r
	326	a&=0x1c;\r
	327	\r
	328	if (a==0x00) // Data port 0 or 2\r
4f672280	329	{\r
69996cb7	330	if (pvid->pending) {\r
	331	CommandChange();\r
	332	pvid->pending=0;\r
	333	}\r
cc68a136	334	\r
	335	// If a DMA fill has been set up, do it\r
	336	if ((pvid->command&0x80) && (pvid->reg[1]&0x10) && (pvid->reg[0x17]>>6)==2)\r
	337	{\r
	338	DmaFill(d);\r
	339	}\r
	340	else\r
	341	{\r
69996cb7	342	// preliminary FIFO emulation for Chaos Engine, The (E)\r
1dceadae	343	if(!(pvid->status&8) && (pvid->reg[1]&0x40) && Pico.m.scanline!=-1 && !(PicoOpt&0x10000)) // active display, accurate mode?\r
69996cb7	344	{\r
	345	pvid->status&=~0x200; // FIFO no longer empty\r
	346	pvid->lwrite_cnt++;\r
	347	if (pvid->lwrite_cnt >= 4) pvid->status\|=0x100; // FIFO full\r
	348	if (pvid->lwrite_cnt > 4) {\r
	349	SekCyclesBurn(32); // penalty // 488/12-8\r
	350	if (SekCycleCnt>=SekCycleAim) SekEndRun(0);\r
	351	}\r
	352	elprintf(EL_ASVDP, "VDP data write: %04x {%i} #%i @ %06x", d, Pico.video.type, pvid->lwrite_cnt, SekPc);\r
	353	}\r
cc68a136	354	VideoWrite(d);\r
	355	}\r
	356	return;\r
	357	}\r
	358	\r
	359	if (a==0x04) // Control (command) port 4 or 6\r
	360	{\r
cc68a136	361	if(pvid->pending)\r
	362	{\r
	363	// Low word of command:\r
	364	pvid->command&=0xffff0000;\r
	365	pvid->command\|=d;\r
	366	pvid->pending=0;\r
	367	CommandChange();\r
	368	} else {\r
	369	if((d&0xc000)==0x8000)\r
	370	{\r
	371	// Register write:\r
	372	int num=(d>>8)&0x1f;\r
69996cb7	373	if(num==00) elprintf(EL_INTSW, "hint_onoff: %i->%i [%i] pend=%i @ %06x", (pvid->reg[0]&0x10)>>4,\r
	374	(d&0x10)>>4, SekCyclesDone(), (pvid->pending_ints&0x10)>>4, SekPc);\r
	375	if(num==01) elprintf(EL_INTSW, "vint_onoff: %i->%i [%i] pend=%i @ %06x", (pvid->reg[1]&0x20)>>5,\r
	376	(d&0x20)>>5, SekCyclesDone(), (pvid->pending_ints&0x20)>>5, SekPc);\r
cc68a136	377	//if(num==01) dprintf("set_blank: %i @ %06x [%i\|%i]", !((d&0x40)>>6), SekPc, Pico.m.scanline, SekCyclesDone());\r
cc68a136	378	//if(num==10) dprintf("hint_set: %i @ %06x [%i\|%i]", (unsigned char)d, SekPc, Pico.m.scanline, SekCyclesDone());\r
cc68a136	379	pvid->reg[num]=(unsigned char)d;\r
03e4f2a3	380	#ifndef EMU_CORE_DEBUG\r
cc68a136	381	// update IRQ level (Lemmings, Wiz 'n' Liz intro, ... )\r
cc68a136	382	// may break if done improperly:\r
69996cb7	383	// International Superstar Soccer Deluxe (crash), Street Racer (logos), Burning Force (gfx),\r
03e4f2a3	384	// Fatal Rewind (crash), Sesame Street Counting Cafe\r
	385	if (num < 2)\r
	386	{\r
	387	if (!SekShouldInterrupt) // hack\r
	388	{\r
	389	int lines, pints, irq=0;\r
cc68a136	390	lines = (pvid->reg[1] & 0x20) \| (pvid->reg[0] & 0x10);\r
cc68a136	391	pints = (pvid->pending_ints&lines);\r
03e4f2a3	392	if(pints & 0x20) irq = 6;\r
	393	else if(pints & 0x10) irq = 4;\r
	394	SekInterrupt(irq); // update line\r
	395	\r
	396	if (irq) SekEndRun(24); // make it delayed\r
cc68a136	397	}\r
cc68a136	398	}\r
	399	else\r
	400	#endif\r
	401	if(num == 5) rendstatus\|=1;\r
	402	else if(num == 0xc) Pico.m.dirtyPal = 2; // renderers should update their palettes if sh/hi mode is changed\r
	403	pvid->type=0; // register writes clear command (else no Sega logo in Golden Axe II)\r
	404	} else {\r
	405	// High word of command:\r
	406	pvid->command&=0x0000ffff;\r
	407	pvid->command\|=d<<16;\r
	408	pvid->pending=1;\r
	409	}\r
	410	}\r
	411	}\r
	412	}\r
	413	\r
eff55556	414	PICO_INTERNAL_ASM unsigned int PicoVideoRead(unsigned int a)\r
cc68a136	415	{\r
cc68a136	416	unsigned int d=0;\r
4f672280	417	\r
cc68a136	418	a&=0x1c;\r
cc68a136	419	\r
69996cb7	420	\r
cc68a136	421	if (a==0x00) // data port\r
	422	{\r
	423	d=VideoRead();\r
	424	goto end;\r
	425	}\r
	426	\r
	427	if (a==0x04) // control port\r
	428	{\r
69996cb7	429	struct PicoVideo *pv=&Pico.video;\r
	430	d=pv->status;\r
	431	if (PicoOpt&0x10) d\|=0x0020; // sprite collision (Shadow of the Beast)\r
	432	if (!(pv->reg[1]&0x40)) d\|=0x0008; // set V-Blank if display is disabled\r
	433	if (SekCyclesLeft < 84+4) d\|=0x0004; // H-Blank (Sonic3 vs)\r
	434	\r
	435	d\|=(pv->pending_ints&0x20)<<2; // V-int pending?\r
	436	if (d&0x100) pv->status&=~0x100; // FIFO no longer full\r
cc68a136	437	\r
69996cb7	438	pv->pending=0; // ctrl port reads clear write-pending flag (Charles MacDonald)\r
cc68a136	439	\r
69996cb7	440	elprintf(EL_SR, "SR read: %04x @ %06x", d, SekPc);\r
cc68a136	441	goto end;\r
	442	}\r
	443	\r
	444	// H-counter info (based on Generator):\r
	445	// frame:\r
	446	// \| <- hblank? -> \|\r
	447	// start <416> hint <36> hdisplay <38> end // CPU cycles\r
	448	// \|---------...---------\|------------\|-------------\|\r
	449	// 0 B6 E4 FF // 40 cells\r
	450	// 0 93 E8 FF // 32 cells\r
	451	\r
	452	// Gens (?) v-render\r
	453	// start <hblank=84> hint hdisplay <404> \|\r
	454	// \|---------------------\|--------------------------\|\r
	455	// E4 (hc[0x43]==0) 07 B1 // 40\r
	456	// E8 (hc[0x45]==0) 05 91 // 32\r
4f672280	457	\r
cc68a136	458	// check: Sonic 3D Blast bonus, Cannon Fodder, Chase HQ II, 3 Ninjas kick back, Road Rash 3, Skitchin', Wheel of Fortune\r
	459	if ((a&0x1c)==0x08)\r
	460	{\r
	461	unsigned int hc;\r
	462	\r
	463	if(Pico.m.scanline != -1) {\r
	464	int lineCycles=(488-SekCyclesLeft)&0x1ff;\r
	465	d=Pico.m.scanline; // V-Counter\r
	466	\r
	467	if(Pico.video.reg[12]&1)\r
	468	hc=hcounts_40[lineCycles];\r
	469	else hc=hcounts_32[lineCycles];\r
	470	\r
8c1952f0	471	//if(lineCycles > 488-12) d++; // Wheel of Fortune\r
cc68a136	472	} else {\r
	473	// get approximate V-Counter\r
	474	d=vcounts[SekCyclesDone()>>8];\r
	475	hc = Pico.m.rotate&0xff;\r
	476	}\r
	477	\r
	478	if(Pico.m.pal) {\r
	479	if(d >= 0x103) d-=56; // based on Gens\r
	480	} else {\r
	481	if(d >= 0xEB) d-=6;\r
	482	}\r
	483	\r
	484	if((Pico.video.reg[12]&6) == 6) {\r
	485	// interlace mode 2 (Combat Cars (UE) [!])\r
	486	d <<= 1;\r
	487	if (d&0xf00) d\|= 1;\r
	488	}\r
	489	\r
69996cb7	490	elprintf(EL_HVCNT, "hv: %02x %02x (%i) @ %06x", hc, d, SekCyclesDone(), SekPc);\r
cc68a136	491	d&=0xff; d<<=8;\r
	492	d\|=hc;\r
	493	goto end;\r
	494	}\r
	495	\r
	496	end:\r
	497	\r
	498	return d;\r
	499	}\r