[picodrive.git] / Pico / Draw.c

// This is part of Pico Library\r
\r
// (c) Copyright 2004 Dave, All rights reserved.\r
// (c) Copyright 2006 notaz, All rights reserved.\r
// Free for non-commercial use.\r
\r
// For commercial use, separate licencing terms must be obtained.\r
\r
\r
#include "PicoInt.h"\r
\r
int (*PicoScan)(unsigned int num, void *data)=NULL;\r
\r
#if OVERRIDE_HIGHCOL\r
static unsigned char DefHighCol[8+320+8];\r
unsigned char *HighCol=DefHighCol;\r
#else\r
unsigned char  HighCol[8+320+8];\r
#endif\r
unsigned short DefOutBuff[320*2];\r
void *DrawLineDest=DefOutBuff; // pointer to dest buffer where to draw this line to\r
\r
static int  HighCacheA[41+1];   // caches for high layers\r
static int  HighCacheB[41+1];\r
static int  HighCacheS[80+1];   // and sprites\r
static int  HighPreSpr[80*2+1]; // slightly preprocessed sprites\r
char HighSprZ[320+8+8]; // Z-buffer for accurate sprites and shadow/hilight mode\r
                        // (if bit 7 == 0, sh caused by tile; if bit 6 == 0 pixel must be shadowed, else hilighted, if bit5 == 1)\r
// lsb->msb: moved sprites, not all window tiles use same priority, accurate sprites (copied from PicoOpt), interlace\r
//           dirty sprites, sonic mode, have layer with all hi prio tiles (mk3), layer sh/hi already processed\r
int rendstatus;\r
int Scanline=0; // Scanline\r
\r
static int SpriteBlocks;\r
//unsigned short ppt[] = { 0x0f11, 0x0ff1, 0x01f1, 0x011f, 0x01ff, 0x0f1f, 0x0f0e, 0x0e7c };\r
\r
struct TileStrip\r
{\r
  int nametab; // Position in VRAM of name table (for this tile line)\r
  int line;    // Line number in pixels 0x000-0x3ff within the virtual tilemap\r
  int hscroll; // Horizontal scroll value in pixels for the line\r
  int xmask;   // X-Mask (0x1f - 0x7f) for horizontal wraparound in the tilemap\r
  int *hc;     // cache for high tile codes and their positions\r
  int cells;   // cells (tiles) to draw (32 col mode doesn't need to update whole 320)\r
};\r
\r
// stuff available in asm:\r
#ifdef _ASM_DRAW_C\r
void DrawWindow(int tstart, int tend, int prio, int sh);\r
void BackFill(int reg7, int sh);\r
void DrawSprite(int *sprite, int **hc, int sh);\r
void DrawTilesFromCache(int *hc, int sh, int rlim);\r
void DrawSpritesFromCache(int *hc, int sh);\r
void DrawLayer(int plane_sh, int *hcache, int cellskip, int maxcells);\r
void FinalizeLineBGR444(int sh);\r
void FinalizeLineRGB555(int sh);\r
void blockcpy_or(void *dst, void *src, size_t n, int pat);\r
#else\r
// utility\r
void blockcpy_or(void *dst, void *src, size_t n, int pat)\r
{\r
  unsigned char *pd = dst, *ps = src;\r
  for (; n; n--)\r
    *pd++ = (unsigned char) (*ps++ | pat);\r
}\r
#endif\r
\r
\r
#ifdef _ASM_DRAW_C_MIPS\r
int TileNorm(int sx,int addr,int pal);\r
int TileFlip(int sx,int addr,int pal);\r
#else\r
static int TileNorm(int sx,int addr,int pal)\r
{\r
  unsigned char *pd = HighCol+sx;\r
  unsigned int pack=0; unsigned int t=0;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=pack&0x0000f000; if (t) pd[0]=(unsigned char)(pal|(t>>12));\r
    t=pack&0x00000f00; if (t) pd[1]=(unsigned char)(pal|(t>> 8));\r
    t=pack&0x000000f0; if (t) pd[2]=(unsigned char)(pal|(t>> 4));\r
    t=pack&0x0000000f; if (t) pd[3]=(unsigned char)(pal|(t    ));\r
    t=pack&0xf0000000; if (t) pd[4]=(unsigned char)(pal|(t>>28));\r
    t=pack&0x0f000000; if (t) pd[5]=(unsigned char)(pal|(t>>24));\r
    t=pack&0x00f00000; if (t) pd[6]=(unsigned char)(pal|(t>>20));\r
    t=pack&0x000f0000; if (t) pd[7]=(unsigned char)(pal|(t>>16));\r
    return 0;\r
  }\r
\r
  return 1; // Tile blank\r
}\r
\r
static int TileFlip(int sx,int addr,int pal)\r
{\r
  unsigned char *pd = HighCol+sx;\r
  unsigned int pack=0; unsigned int t=0;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=pack&0x000f0000; if (t) pd[0]=(unsigned char)(pal|(t>>16));\r
    t=pack&0x00f00000; if (t) pd[1]=(unsigned char)(pal|(t>>20));\r
    t=pack&0x0f000000; if (t) pd[2]=(unsigned char)(pal|(t>>24));\r
    t=pack&0xf0000000; if (t) pd[3]=(unsigned char)(pal|(t>>28));\r
    t=pack&0x0000000f; if (t) pd[4]=(unsigned char)(pal|(t    ));\r
    t=pack&0x000000f0; if (t) pd[5]=(unsigned char)(pal|(t>> 4));\r
    t=pack&0x00000f00; if (t) pd[6]=(unsigned char)(pal|(t>> 8));\r
    t=pack&0x0000f000; if (t) pd[7]=(unsigned char)(pal|(t>>12));\r
    return 0;\r
  }\r
  return 1; // Tile blank\r
}\r
#endif\r
\r
// tile renderers for hacky operator sprite support\r
#define sh_pix(x) \\r
  if(!t); \\r
  else if(t==0xe) pd[x]=(unsigned char)((pd[x]&0x3f)|0x80); /* hilight */ \\r
  else if(t==0xf) pd[x]=(unsigned char)((pd[x]&0x3f)|0xc0); /* shadow  */ \\r
  else pd[x]=(unsigned char)(pal|t)\r
\r
#ifndef _ASM_DRAW_C\r
static int TileNormSH(int sx,int addr,int pal)\r
{\r
  unsigned int pack=0; unsigned int t=0;\r
  unsigned char *pd = HighCol+sx;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=(pack&0x0000f000)>>12; sh_pix(0);\r
    t=(pack&0x00000f00)>> 8; sh_pix(1);\r
    t=(pack&0x000000f0)>> 4; sh_pix(2);\r
    t=(pack&0x0000000f)    ; sh_pix(3);\r
    t=(pack&0xf0000000)>>28; sh_pix(4);\r
    t=(pack&0x0f000000)>>24; sh_pix(5);\r
    t=(pack&0x00f00000)>>20; sh_pix(6);\r
    t=(pack&0x000f0000)>>16; sh_pix(7);\r
    return 0;\r
  }\r
\r
  return 1; // Tile blank\r
}\r
\r
static int TileFlipSH(int sx,int addr,int pal)\r
{\r
  unsigned int pack=0; unsigned int t=0;\r
  unsigned char *pd = HighCol+sx;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=(pack&0x000f0000)>>16; sh_pix(0);\r
    t=(pack&0x00f00000)>>20; sh_pix(1);\r
    t=(pack&0x0f000000)>>24; sh_pix(2);\r
    t=(pack&0xf0000000)>>28; sh_pix(3);\r
    t=(pack&0x0000000f)    ; sh_pix(4);\r
    t=(pack&0x000000f0)>> 4; sh_pix(5);\r
    t=(pack&0x00000f00)>> 8; sh_pix(6);\r
    t=(pack&0x0000f000)>>12; sh_pix(7);\r
    return 0;\r
  }\r
  return 1; // Tile blank\r
}\r
#endif\r
\r
static int TileNormZ(int sx,int addr,int pal,int zval)\r
{\r
  unsigned int pack=0; unsigned int t=0;\r
  unsigned char *pd = HighCol+sx;\r
  char *zb = HighSprZ+sx;\r
  int collision = 0, zb_s;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=pack&0x0000f000; if(t) { zb_s=zb[0]; if(zb_s) collision=1; if(zval>zb_s) { pd[0]=(unsigned char)(pal|(t>>12)); zb[0]=(char)zval; } }\r
    t=pack&0x00000f00; if(t) { zb_s=zb[1]; if(zb_s) collision=1; if(zval>zb_s) { pd[1]=(unsigned char)(pal|(t>> 8)); zb[1]=(char)zval; } }\r
    t=pack&0x000000f0; if(t) { zb_s=zb[2]; if(zb_s) collision=1; if(zval>zb_s) { pd[2]=(unsigned char)(pal|(t>> 4)); zb[2]=(char)zval; } }\r
    t=pack&0x0000000f; if(t) { zb_s=zb[3]; if(zb_s) collision=1; if(zval>zb_s) { pd[3]=(unsigned char)(pal|(t    )); zb[3]=(char)zval; } }\r
    t=pack&0xf0000000; if(t) { zb_s=zb[4]; if(zb_s) collision=1; if(zval>zb_s) { pd[4]=(unsigned char)(pal|(t>>28)); zb[4]=(char)zval; } }\r
    t=pack&0x0f000000; if(t) { zb_s=zb[5]; if(zb_s) collision=1; if(zval>zb_s) { pd[5]=(unsigned char)(pal|(t>>24)); zb[5]=(char)zval; } }\r
    t=pack&0x00f00000; if(t) { zb_s=zb[6]; if(zb_s) collision=1; if(zval>zb_s) { pd[6]=(unsigned char)(pal|(t>>20)); zb[6]=(char)zval; } }\r
    t=pack&0x000f0000; if(t) { zb_s=zb[7]; if(zb_s) collision=1; if(zval>zb_s) { pd[7]=(unsigned char)(pal|(t>>16)); zb[7]=(char)zval; } }\r
    if(collision) Pico.video.status|=0x20;\r
    return 0;\r
  }\r
\r
  return 1; // Tile blank\r
}\r
\r
static int TileFlipZ(int sx,int addr,int pal,int zval)\r
{\r
  unsigned int pack=0; unsigned int t=0;\r
  unsigned char *pd = HighCol+sx;\r
  char *zb = HighSprZ+sx;\r
  int collision = 0, zb_s;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=pack&0x000f0000; if(t) { zb_s=zb[0]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[0]=(unsigned char)(pal|(t>>16)); zb[0]=(char)zval; } }\r
    t=pack&0x00f00000; if(t) { zb_s=zb[1]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[1]=(unsigned char)(pal|(t>>20)); zb[1]=(char)zval; } }\r
    t=pack&0x0f000000; if(t) { zb_s=zb[2]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[2]=(unsigned char)(pal|(t>>24)); zb[2]=(char)zval; } }\r
    t=pack&0xf0000000; if(t) { zb_s=zb[3]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[3]=(unsigned char)(pal|(t>>28)); zb[3]=(char)zval; } }\r
    t=pack&0x0000000f; if(t) { zb_s=zb[4]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[4]=(unsigned char)(pal|(t    )); zb[4]=(char)zval; } }\r
    t=pack&0x000000f0; if(t) { zb_s=zb[5]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[5]=(unsigned char)(pal|(t>> 4)); zb[5]=(char)zval; } }\r
    t=pack&0x00000f00; if(t) { zb_s=zb[6]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[6]=(unsigned char)(pal|(t>> 8)); zb[6]=(char)zval; } }\r
    t=pack&0x0000f000; if(t) { zb_s=zb[7]&0x1f; if(zb_s) collision=1; if(zval>zb_s) { pd[7]=(unsigned char)(pal|(t>>12)); zb[7]=(char)zval; } }\r
    if(collision) Pico.video.status|=0x20;\r
    return 0;\r
  }\r
  return 1; // Tile blank\r
}\r
\r
\r
#define sh_pixZ(x) \\r
  if(t) { \\r
    if(zb[x]) collision=1; \\r
    if(zval>zb[x]) { \\r
      if     (t==0xe) { pd[x]=(unsigned char)((pd[x]&0x3f)|0x80); /* hilight */ } \\r
      else if(t==0xf) { pd[x]=(unsigned char)((pd[x]&0x3f)|0xc0); /* shadow  */ } \\r
      else            { zb[x]=(char)zval; pd[x]=(unsigned char)(pal|t); } \\r
    } \\r
  }\r
\r
static int TileNormZSH(int sx,int addr,int pal,int zval)\r
{\r
  unsigned int pack=0; unsigned int t=0;\r
  unsigned char *pd = HighCol+sx;\r
  char *zb = HighSprZ+sx;\r
  int collision = 0;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=(pack&0x0000f000)>>12; sh_pixZ(0);\r
    t=(pack&0x00000f00)>> 8; sh_pixZ(1);\r
    t=(pack&0x000000f0)>> 4; sh_pixZ(2);\r
    t=(pack&0x0000000f)    ; sh_pixZ(3);\r
    t=(pack&0xf0000000)>>28; sh_pixZ(4);\r
    t=(pack&0x0f000000)>>24; sh_pixZ(5);\r
    t=(pack&0x00f00000)>>20; sh_pixZ(6);\r
    t=(pack&0x000f0000)>>16; sh_pixZ(7);\r
    if(collision) Pico.video.status|=0x20;\r
    return 0;\r
  }\r
\r
  return 1; // Tile blank\r
}\r
\r
static int TileFlipZSH(int sx,int addr,int pal,int zval)\r
{\r
  unsigned int pack=0; unsigned int t=0;\r
  unsigned char *pd = HighCol+sx;\r
  char *zb = HighSprZ+sx;\r
  int collision = 0;\r
\r
  pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
  if (pack)\r
  {\r
    t=(pack&0x000f0000)>>16; sh_pixZ(0);\r
    t=(pack&0x00f00000)>>20; sh_pixZ(1);\r
    t=(pack&0x0f000000)>>24; sh_pixZ(2);\r
    t=(pack&0xf0000000)>>28; sh_pixZ(3);\r
    t=(pack&0x0000000f)    ; sh_pixZ(4);\r
    t=(pack&0x000000f0)>> 4; sh_pixZ(5);\r
    t=(pack&0x00000f00)>> 8; sh_pixZ(6);\r
    t=(pack&0x0000f000)>>12; sh_pixZ(7);\r
    if(collision) Pico.video.status|=0x20;\r
    return 0;\r
  }\r
  return 1; // Tile blank\r
}\r
\r
// --------------------------------------------\r
\r
#ifndef _ASM_DRAW_C\r
static void DrawStrip(struct TileStrip *ts, int plane_sh, int cellskip)\r
{\r
  int tilex,dx,ty,code=0,addr=0,cells;\r
  int oldcode=-1,blank=-1; // The tile we know is blank\r
  int pal=0,sh;\r
\r
  // Draw tiles across screen:\r
  sh=(plane_sh<<5)&0x40;\r
  tilex=((-ts->hscroll)>>3)+cellskip;\r
  ty=(ts->line&7)<<1; // Y-Offset into tile\r
  dx=((ts->hscroll-1)&7)+1;\r
  cells = ts->cells - cellskip;\r
  if(dx != 8) cells++; // have hscroll, need to draw 1 cell more\r
  dx+=cellskip<<3;\r
\r
  for (; cells > 0; dx+=8,tilex++,cells--)\r
  {\r
    int zero=0;\r
\r
    code=Pico.vram[ts->nametab+(tilex&ts->xmask)];\r
    if (code==blank) continue;\r
    if (code>>15) { // high priority tile\r
      int cval = code | (dx<<16) | (ty<<25);\r
      if(code&0x1000) cval^=7<<26;\r
      *ts->hc++ = cval; // cache it\r
      continue;\r
    }\r
\r
    if (code!=oldcode) {\r
      oldcode = code;\r
      // Get tile address/2:\r
      addr=(code&0x7ff)<<4;\r
      addr+=ty;\r
      if (code&0x1000) addr^=0xe; // Y-flip\r
\r
      pal=((code>>9)&0x30)|sh;\r
    }\r
\r
    if (code&0x0800) zero=TileFlip(dx,addr,pal);\r
    else             zero=TileNorm(dx,addr,pal);\r
\r
    if (zero) blank=code; // We know this tile is blank now\r
  }\r
\r
  // terminate the cache list\r
  *ts->hc = 0;\r
  // if oldcode wasn't changed, it means all layer is hi priority\r
  if (oldcode == -1) rendstatus|=0x40;\r
}\r
\r
// this is messy\r
void DrawStripVSRam(struct TileStrip *ts, int plane_sh, int cellskip)\r
{\r
  int tilex,dx,code=0,addr=0,cell=0;\r
  int oldcode=-1,blank=-1; // The tile we know is blank\r
  int pal=0,scan=Scanline;\r
\r
  // Draw tiles across screen:\r
  tilex=(-ts->hscroll)>>3;\r
  dx=((ts->hscroll-1)&7)+1;\r
  if(dx != 8) cell--; // have hscroll, start with negative cell\r
  cell+=cellskip;\r
  tilex+=cellskip;\r
  dx+=cellskip<<3;\r
\r
  for (; cell < ts->cells; dx+=8,tilex++,cell++)\r
  {\r
    int zero=0,nametabadd,ty;\r
\r
    //if((cell&1)==0)\r
    {\r
      int line,vscroll;\r
      vscroll=Pico.vsram[(plane_sh&1)+(cell&~1)];\r
\r
      // Find the line in the name table\r
      line=(vscroll+scan)&ts->line&0xffff; // ts->line is really ymask ..\r
      nametabadd=(line>>3)<<(ts->line>>24);    // .. and shift[width]\r
      ty=(line&7)<<1; // Y-Offset into tile\r
    }\r
\r
    code=Pico.vram[ts->nametab+nametabadd+(tilex&ts->xmask)];\r
    if (code==blank) continue;\r
    if (code>>15) { // high priority tile\r
      int cval = code | (dx<<16) | (ty<<25);\r
      if(code&0x1000) cval^=7<<26;\r
      *ts->hc++ = cval; // cache it\r
      continue;\r
    }\r
\r
    if (code!=oldcode) {\r
      oldcode = code;\r
      // Get tile address/2:\r
      addr=(code&0x7ff)<<4;\r
      if (code&0x1000) addr+=14-ty; else addr+=ty; // Y-flip\r
\r
      pal=((code>>9)&0x30)|((plane_sh<<5)&0x40);\r
    }\r
\r
    if (code&0x0800) zero=TileFlip(dx,addr,pal);\r
    else             zero=TileNorm(dx,addr,pal);\r
\r
    if (zero) blank=code; // We know this tile is blank now\r
  }\r
\r
  // terminate the cache list\r
  *ts->hc = 0;\r
  if (oldcode == -1) rendstatus|=0x40;\r
}\r
#endif\r
\r
#ifndef _ASM_DRAW_C\r
static\r
#endif\r
void DrawStripInterlace(struct TileStrip *ts)\r
{\r
  int tilex=0,dx=0,ty=0,code=0,addr=0,cells;\r
  int oldcode=-1,blank=-1; // The tile we know is blank\r
  int pal=0;\r
\r
  // Draw tiles across screen:\r
  tilex=(-ts->hscroll)>>3;\r
  ty=(ts->line&15)<<1; // Y-Offset into tile\r
  dx=((ts->hscroll-1)&7)+1;\r
  cells = ts->cells;\r
  if(dx != 8) cells++; // have hscroll, need to draw 1 cell more\r
\r
  for (; cells; dx+=8,tilex++,cells--)\r
  {\r
    int zero=0;\r
\r
    code=Pico.vram[ts->nametab+(tilex&ts->xmask)];\r
    if (code==blank) continue;\r
    if (code>>15) { // high priority tile\r
      int cval = (code&0xfc00) | (dx<<16) | (ty<<25);\r
      cval|=(code&0x3ff)<<1;\r
      if(code&0x1000) cval^=0xf<<26;\r
      *ts->hc++ = cval; // cache it\r
      continue;\r
    }\r
\r
    if (code!=oldcode) {\r
      oldcode = code;\r
      // Get tile address/2:\r
      addr=(code&0x7ff)<<5;\r
      if (code&0x1000) addr+=30-ty; else addr+=ty; // Y-flip\r
\r
//      pal=Pico.cram+((code>>9)&0x30);\r
      pal=((code>>9)&0x30);\r
    }\r
\r
    if (code&0x0800) zero=TileFlip(dx,addr,pal);\r
    else             zero=TileNorm(dx,addr,pal);\r
\r
    if (zero) blank=code; // We know this tile is blank now\r
  }\r
\r
  // terminate the cache list\r
  *ts->hc = 0;\r
}\r
\r
// --------------------------------------------\r
\r
#ifndef _ASM_DRAW_C\r
static void DrawLayer(int plane_sh, int *hcache, int cellskip, int maxcells)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  const char shift[4]={5,6,5,7}; // 32,64 or 128 sized tilemaps (2 is invalid)\r
  struct TileStrip ts;\r
  int width, height, ymask;\r
  int vscroll, htab;\r
\r
  ts.hc=hcache;\r
  ts.cells=maxcells;\r
\r
  // Work out the TileStrip to draw\r
\r
  // Work out the name table size: 32 64 or 128 tiles (0-3)\r
  width=pvid->reg[16];\r
  height=(width>>4)&3; width&=3;\r
\r
  ts.xmask=(1<<shift[width])-1; // X Mask in tiles (0x1f-0x7f)\r
  ymask=(height<<8)|0xff;       // Y Mask in pixels\r
  if(width == 1)   ymask&=0x1ff;\r
  else if(width>1) ymask =0x0ff;\r
\r
  // Find name table:\r
  if (plane_sh&1) ts.nametab=(pvid->reg[4]&0x07)<<12; // B\r
  else            ts.nametab=(pvid->reg[2]&0x38)<< 9; // A\r
\r
  htab=pvid->reg[13]<<9; // Horizontal scroll table address\r
  if ( pvid->reg[11]&2)     htab+=Scanline<<1; // Offset by line\r
  if ((pvid->reg[11]&1)==0) htab&=~0xf; // Offset by tile\r
  htab+=plane_sh&1; // A or B\r
\r
  // Get horizontal scroll value, will be masked later\r
  ts.hscroll=Pico.vram[htab&0x7fff];\r
\r
  if((pvid->reg[12]&6) == 6) {\r
    // interlace mode 2\r
    vscroll=Pico.vsram[plane_sh&1]; // Get vertical scroll value\r
\r
    // Find the line in the name table\r
    ts.line=(vscroll+(Scanline<<1))&((ymask<<1)|1);\r
    ts.nametab+=(ts.line>>4)<<shift[width];\r
\r
    DrawStripInterlace(&ts);\r
  } else if( pvid->reg[11]&4) {\r
    // shit, we have 2-cell column based vscroll\r
    // luckily this doesn't happen too often\r
    ts.line=ymask|(shift[width]<<24); // save some stuff instead of line\r
    DrawStripVSRam(&ts, plane_sh, cellskip);\r
  } else {\r
    vscroll=Pico.vsram[plane_sh&1]; // Get vertical scroll value\r
\r
    // Find the line in the name table\r
    ts.line=(vscroll+Scanline)&ymask;\r
    ts.nametab+=(ts.line>>3)<<shift[width];\r
\r
    DrawStrip(&ts, plane_sh, cellskip);\r
  }\r
}\r
\r
\r
// --------------------------------------------\r
\r
// tstart & tend are tile pair numbers\r
static void DrawWindow(int tstart, int tend, int prio, int sh) // int *hcache\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int tilex=0,ty=0,nametab,code=0;\r
  int blank=-1; // The tile we know is blank\r
\r
  // Find name table line:\r
  if (pvid->reg[12]&1)\r
  {\r
    nametab=(pvid->reg[3]&0x3c)<<9; // 40-cell mode\r
    nametab+=(Scanline>>3)<<6;\r
  }\r
  else\r
  {\r
    nametab=(pvid->reg[3]&0x3e)<<9; // 32-cell mode\r
    nametab+=(Scanline>>3)<<5;\r
  }\r
\r
  tilex=tstart<<1;\r
  tend<<=1;\r
\r
  ty=(Scanline&7)<<1; // Y-Offset into tile\r
\r
  if(!(rendstatus&2)) {\r
    // check the first tile code\r
    code=Pico.vram[nametab+tilex];\r
    // if the whole window uses same priority (what is often the case), we may be able to skip this field\r
    if((code>>15) != prio) return;\r
  }\r
\r
  // Draw tiles across screen:\r
  for (; tilex < tend; tilex++)\r
  {\r
    int addr=0,zero=0;\r
    int pal;\r
\r
    code=Pico.vram[nametab+tilex];\r
    if(code==blank) continue;\r
    if((code>>15) != prio) {\r
      rendstatus|=2;\r
      continue;\r
    }\r
\r
    pal=((code>>9)&0x30);\r
\r
    if(sh) {\r
      int tmp, *zb = (int *)(HighCol+8+(tilex<<3));\r
      if(prio) {\r
        tmp = *zb;\r
        if(!(tmp&0x00000080)) tmp&=~0x000000c0; if(!(tmp&0x00008000)) tmp&=~0x0000c000;\r
        if(!(tmp&0x00800000)) tmp&=~0x00c00000; if(!(tmp&0x80000000)) tmp&=~0xc0000000;\r
        *zb++=tmp; tmp = *zb;\r
        if(!(tmp&0x00000080)) tmp&=~0x000000c0; if(!(tmp&0x00008000)) tmp&=~0x0000c000;\r
        if(!(tmp&0x00800000)) tmp&=~0x00c00000; if(!(tmp&0x80000000)) tmp&=~0xc0000000;\r
        *zb++=tmp;\r
      } else {\r
        pal |= 0x40;\r
      }\r
    }\r
\r
    // Get tile address/2:\r
    addr=(code&0x7ff)<<4;\r
    if (code&0x1000) addr+=14-ty; else addr+=ty; // Y-flip\r
\r
    if (code&0x0800) zero=TileFlip(8+(tilex<<3),addr,pal);\r
    else             zero=TileNorm(8+(tilex<<3),addr,pal);\r
\r
    if (zero) blank=code; // We know this tile is blank now\r
  }\r
\r
  // terminate the cache list\r
  //*hcache = 0;\r
}\r
\r
// --------------------------------------------\r
\r
static void DrawTilesFromCache(int *hc, int sh, int rlim)\r
{\r
  int code, addr, dx;\r
  int pal;\r
\r
  // *ts->hc++ = code | (dx<<16) | (ty<<25); // cache it\r
\r
  if (sh && (rendstatus&0xc0))\r
  {\r
    if (!(rendstatus&0x80))\r
    {\r
      // as some layer has covered whole line with hi priority tiles,\r
      // we can process whole line and then act as if sh/hi mode was off.\r
      rendstatus|=0x80;\r
      int c = 320/4, *zb = (int *)(HighCol+8);\r
      while (c--)\r
      {\r
        int tmp = *zb;\r
        if (!(tmp & 0x80808080)) *zb=tmp&0x3f3f3f3f;\r
        else {\r
          if(!(tmp&0x00000080)) tmp&=~0x000000c0; if(!(tmp&0x00008000)) tmp&=~0x0000c000;\r
          if(!(tmp&0x00800000)) tmp&=~0x00c00000; if(!(tmp&0x80000000)) tmp&=~0xc0000000;\r
          *zb=tmp;\r
        }\r
        zb++;\r
      }\r
    }\r
    sh = 0;\r
  }\r
\r
  if (sh)\r
  {\r
    while ((code=*hc++)) {\r
      unsigned char *zb;\r
      // Get tile address/2:\r
      addr=(code&0x7ff)<<4;\r
      addr+=(unsigned int)code>>25; // y offset into tile\r
      dx=(code>>16)&0x1ff;\r
      zb = HighCol+dx;\r
      if(!(*zb&0x80)) *zb&=0x3f; zb++; if(!(*zb&0x80)) *zb&=0x3f; zb++;\r
      if(!(*zb&0x80)) *zb&=0x3f; zb++; if(!(*zb&0x80)) *zb&=0x3f; zb++;\r
      if(!(*zb&0x80)) *zb&=0x3f; zb++; if(!(*zb&0x80)) *zb&=0x3f; zb++;\r
      if(!(*zb&0x80)) *zb&=0x3f; zb++; if(!(*zb&0x80)) *zb&=0x3f; zb++;\r
\r
      pal=((code>>9)&0x30);\r
      if (rlim-dx < 0) goto last_cut_tile;\r
\r
      if (code&0x0800) TileFlip(dx,addr,pal);\r
      else             TileNorm(dx,addr,pal);\r
    }\r
  }\r
  else\r
  {\r
    short blank=-1; // The tile we know is blank\r
    while ((code=*hc++)) {\r
      int zero;\r
      if((short)code == blank) continue;\r
      // Get tile address/2:\r
      addr=(code&0x7ff)<<4;\r
      addr+=(unsigned int)code>>25; // y offset into tile\r
      dx=(code>>16)&0x1ff;\r
\r
      pal=((code>>9)&0x30);\r
      if (rlim-dx < 0) goto last_cut_tile;\r
\r
      if (code&0x0800) zero=TileFlip(dx,addr,pal);\r
      else             zero=TileNorm(dx,addr,pal);\r
\r
      if (zero) blank=(short)code;\r
    }\r
  }\r
  return;\r
\r
last_cut_tile:\r
  {\r
    unsigned int t, pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
    unsigned char *pd = HighCol+dx;\r
    if (!pack) return;\r
    if (code&0x0800)\r
    {\r
      switch (rlim-dx+8)\r
      {\r
        case 7: t=pack&0x00000f00; if (t) pd[6]=(unsigned char)(pal|(t>> 8)); // "break" is left out intentionally\r
        case 6: t=pack&0x000000f0; if (t) pd[5]=(unsigned char)(pal|(t>> 4));\r
        case 5: t=pack&0x0000000f; if (t) pd[4]=(unsigned char)(pal|(t    ));\r
        case 4: t=pack&0xf0000000; if (t) pd[3]=(unsigned char)(pal|(t>>28));\r
        case 3: t=pack&0x0f000000; if (t) pd[2]=(unsigned char)(pal|(t>>24));\r
        case 2: t=pack&0x00f00000; if (t) pd[1]=(unsigned char)(pal|(t>>20));\r
        case 1: t=pack&0x000f0000; if (t) pd[0]=(unsigned char)(pal|(t>>16));\r
        default: break;\r
      }\r
    }\r
    else\r
    {\r
      switch (rlim-dx+8)\r
      {\r
        case 7: t=pack&0x00f00000; if (t) pd[6]=(unsigned char)(pal|(t>>20));\r
	case 6: t=pack&0x0f000000; if (t) pd[5]=(unsigned char)(pal|(t>>24));\r
	case 5: t=pack&0xf0000000; if (t) pd[4]=(unsigned char)(pal|(t>>28));\r
	case 4: t=pack&0x0000000f; if (t) pd[3]=(unsigned char)(pal|(t    ));\r
	case 3: t=pack&0x000000f0; if (t) pd[2]=(unsigned char)(pal|(t>> 4));\r
	case 2: t=pack&0x00000f00; if (t) pd[1]=(unsigned char)(pal|(t>> 8));\r
	case 1: t=pack&0x0000f000; if (t) pd[0]=(unsigned char)(pal|(t>>12));\r
	default: break;\r
      }\r
    }\r
  }\r
}\r
\r
// --------------------------------------------\r
\r
// Index + 0  :    hhhhvvvv ab--hhvv yyyyyyyy yyyyyyyy // a: offscreen h, b: offs. v, h: horiz. size\r
// Index + 4  :    xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
\r
static void DrawSprite(int *sprite, int **hc, int sh)\r
{\r
  int width=0,height=0;\r
  int row=0,code=0;\r
  int pal;\r
  int tile=0,delta=0;\r
  int sx, sy;\r
  int (*fTileFunc)(int sx,int addr,int pal);\r
\r
  // parse the sprite data\r
  sy=sprite[0];\r
  code=sprite[1];\r
  sx=code>>16; // X\r
  width=sy>>28;\r
  height=(sy>>24)&7; // Width and height in tiles\r
  sy=(sy<<16)>>16; // Y\r
\r
  row=Scanline-sy; // Row of the sprite we are on\r
\r
  if (code&0x1000) row=(height<<3)-1-row; // Flip Y\r
\r
  tile=code&0x7ff; // Tile number\r
  tile+=row>>3; // Tile number increases going down\r
  delta=height; // Delta to increase tile by going right\r
  if (code&0x0800) { tile+=delta*(width-1); delta=-delta; } // Flip X\r
\r
  tile<<=4; tile+=(row&7)<<1; // Tile address\r
\r
  if(code&0x8000) { // high priority - cache it\r
    *(*hc)++ = (tile<<16)|((code&0x0800)<<5)|((sx<<6)&0x0000ffc0)|((code>>9)&0x30)|((sprite[0]>>16)&0xf);\r
  } else {\r
    delta<<=4; // Delta of address\r
    pal=((code>>9)&0x30)|(sh<<6);\r
\r
    if(sh && (code&0x6000) == 0x6000) {\r
      if(code&0x0800) fTileFunc=TileFlipSH;\r
      else            fTileFunc=TileNormSH;\r
    } else {\r
      if(code&0x0800) fTileFunc=TileFlip;\r
      else            fTileFunc=TileNorm;\r
    }\r
\r
    for (; width; width--,sx+=8,tile+=delta)\r
    {\r
      if(sx<=0)   continue;\r
      if(sx>=328) break; // Offscreen\r
\r
      tile&=0x7fff; // Clip tile address\r
      fTileFunc(sx,tile,pal);\r
    }\r
  }\r
}\r
#endif\r
\r
\r
// Index + 0  :    hhhhvvvv s---hhvv yyyyyyyy yyyyyyyy // s: skip flag, h: horiz. size\r
// Index + 4  :    xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
\r
static void DrawSpriteZ(int pack, int pack2, int shpri, int sprio)\r
{\r
  int width=0,height=0;\r
  int row=0;\r
  int pal;\r
  int tile=0,delta=0;\r
  int sx, sy;\r
  int (*fTileFunc)(int sx,int addr,int pal,int zval);\r
\r
  // parse the sprite data\r
  sx=pack2>>16; // X\r
  sy=(pack <<16)>>16; // Y\r
  width=pack>>28;\r
  height=(pack>>24)&7; // Width and height in tiles\r
\r
  row=Scanline-sy; // Row of the sprite we are on\r
\r
  if (pack2&0x1000) row=(height<<3)-1-row; // Flip Y\r
\r
  tile=pack2&0x7ff; // Tile number\r
  tile+=row>>3; // Tile number increases going down\r
  delta=height; // Delta to increase tile by going right\r
  if (pack2&0x0800) { tile+=delta*(width-1); delta=-delta; } // Flip X\r
\r
  tile<<=4; tile+=(row&7)<<1; // Tile address\r
  delta<<=4; // Delta of address\r
  pal=((pack2>>9)&0x30);\r
  if((shpri&1)&&!(shpri&2)) pal|=0x40;\r
\r
  shpri&=1;\r
  if((pack2&0x6000) != 0x6000) shpri = 0;\r
  shpri |= (pack2&0x0800)>>10;\r
  switch(shpri) {\r
    default:\r
    case 0: fTileFunc=TileNormZ;   break;\r
    case 1: fTileFunc=TileNormZSH; break;\r
    case 2: fTileFunc=TileFlipZ;   break;\r
    case 3: fTileFunc=TileFlipZSH; break;\r
  }\r
\r
  for (; width; width--,sx+=8,tile+=delta)\r
  {\r
    if(sx<=0)   continue;\r
    if(sx>=328) break; // Offscreen\r
\r
    tile&=0x7fff; // Clip tile address\r
    fTileFunc(sx,tile,pal,sprio);\r
  }\r
}\r
\r
static void DrawSpriteInterlace(unsigned int *sprite)\r
{\r
  int width=0,height=0;\r
  int row=0,code=0;\r
  int pal;\r
  int tile=0,delta=0;\r
  int sx, sy;\r
\r
  // parse the sprite data\r
  sy=sprite[0];\r
  height=sy>>24;\r
  sy=(sy&0x3ff)-0x100; // Y\r
  width=(height>>2)&3; height&=3;\r
  width++; height++; // Width and height in tiles\r
\r
  row=(Scanline<<1)-sy; // Row of the sprite we are on\r
\r
  code=sprite[1];\r
  sx=((code>>16)&0x1ff)-0x78; // X\r
\r
  if (code&0x1000) row^=(16<<height)-1; // Flip Y\r
\r
  tile=code&0x3ff; // Tile number\r
  tile+=row>>4; // Tile number increases going down\r
  delta=height; // Delta to increase tile by going right\r
  if (code&0x0800) { tile+=delta*(width-1); delta=-delta; } // Flip X\r
\r
  tile<<=5; tile+=(row&15)<<1; // Tile address\r
\r
  delta<<=5; // Delta of address\r
  pal=((code>>9)&0x30); // Get palette pointer\r
\r
  for (; width; width--,sx+=8,tile+=delta)\r
  {\r
    if(sx<=0)   continue;\r
    if(sx>=328) break; // Offscreen\r
\r
    tile&=0x7fff; // Clip tile address\r
    if (code&0x0800) TileFlip(sx,tile,pal);\r
    else             TileNorm(sx,tile,pal);\r
  }\r
}\r
\r
\r
static void DrawAllSpritesInterlace(int pri, int maxwidth)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int i,u,table,link=0,sline=Scanline<<1;\r
  unsigned int *sprites[80]; // Sprite index\r
\r
  table=pvid->reg[5]&0x7f;\r
  if (pvid->reg[12]&1) table&=0x7e; // Lowest bit 0 in 40-cell mode\r
  table<<=8; // Get sprite table address/2\r
\r
  for (i=u=0; u < 80 && i < 21; u++)\r
  {\r
    unsigned int *sprite;\r
    int code, sx, sy, height;\r
\r
    sprite=(unsigned int *)(Pico.vram+((table+(link<<2))&0x7ffc)); // Find sprite\r
\r
    // get sprite info\r
    code = sprite[0];\r
    sx = sprite[1];\r
    if(((sx>>15)&1) != pri) goto nextsprite; // wrong priority sprite\r
\r
    // check if it is on this line\r
    sy = (code&0x3ff)-0x100;\r
    height = (((code>>24)&3)+1)<<4;\r
    if(sline < sy || sline >= sy+height) goto nextsprite; // no\r
\r
    // check if sprite is not hidden offscreen\r
    sx = (sx>>16)&0x1ff;\r
    sx -= 0x78; // Get X coordinate + 8\r
    if(sx <= -8*3 || sx >= maxwidth) goto nextsprite;\r
\r
    // sprite is good, save it's pointer\r
    sprites[i++]=sprite;\r
\r
    nextsprite:\r
    // Find next sprite\r
    link=(code>>16)&0x7f;\r
    if(!link) break; // End of sprites\r
  }\r
\r
  // Go through sprites backwards:\r
  for (i-- ;i>=0; i--)\r
    DrawSpriteInterlace(sprites[i]);\r
}\r
\r
\r
#ifndef _ASM_DRAW_C\r
static void DrawSpritesFromCache(int *hc, int sh)\r
{\r
  int code, tile, sx, delta, width;\r
  int pal;\r
  int (*fTileFunc)(int sx,int addr,int pal);\r
\r
  // *(*hc)++ = (tile<<16)|((code&0x0800)<<5)|((sx<<6)&0x0000ffc0)|((code>>9)&0x30)|((sprite[0]>>24)&0xf);\r
\r
  while((code=*hc++)) {\r
    pal=(code&0x30);\r
    delta=code&0xf;\r
    width=delta>>2; delta&=3;\r
    width++; delta++; // Width and height in tiles\r
    if (code&0x10000) delta=-delta; // Flip X\r
    delta<<=4;\r
    tile=((unsigned int)code>>17)<<1;\r
    sx=(code<<16)>>22; // sx can be negative (start offscreen), so sign extend\r
\r
    if(sh && pal == 0x30) { //\r
      if(code&0x10000) fTileFunc=TileFlipSH;\r
      else             fTileFunc=TileNormSH;\r
    } else {\r
      if(code&0x10000) fTileFunc=TileFlip;\r
      else             fTileFunc=TileNorm;\r
    }\r
\r
    for (; width; width--,sx+=8,tile+=delta)\r
    {\r
      if(sx<=0)   continue;\r
      if(sx>=328) break; // Offscreen\r
\r
      tile&=0x7fff; // Clip tile address\r
      fTileFunc(sx,tile,pal);\r
    }\r
  }\r
}\r
#endif\r
\r
\r
// Index + 0  :    ----hhvv -lllllll -------y yyyyyyyy\r
// Index + 4  :    -------x xxxxxxxx pccvhnnn nnnnnnnn\r
// v\r
// Index + 0  :    hhhhvvvv ab--hhvv yyyyyyyy yyyyyyyy // a: offscreen h, b: offs. v, h: horiz. size\r
// Index + 4  :    xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
\r
static void PrepareSprites(int full)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int u=0,link=0,sblocks=0;\r
  int table=0;\r
  int *pd = HighPreSpr;\r
\r
  table=pvid->reg[5]&0x7f;\r
  if (pvid->reg[12]&1) table&=0x7e; // Lowest bit 0 in 40-cell mode\r
  table<<=8; // Get sprite table address/2\r
\r
  if (!full)\r
  {\r
    int pack;\r
    // updates: tilecode, sx\r
    for (u=0; u < 80 && (pack = *pd); u++, pd+=2)\r
    {\r
      unsigned int *sprite;\r
      int code, code2, sx, sy, skip=0;\r
\r
      sprite=(unsigned int *)(Pico.vram+((table+(link<<2))&0x7ffc)); // Find sprite\r
\r
      // parse sprite info\r
      code  = sprite[0];\r
      code2 = sprite[1];\r
      code2 &= ~0xfe000000;\r
      code2 -=  0x00780000; // Get X coordinate + 8 in upper 16 bits\r
      sx = code2>>16;\r
\r
      if((sx <= 8-((pack>>28)<<3) && sx >= -0x76) || sx >= 328) skip=1<<23;\r
      else if ((sy = (pack<<16)>>16) < 240 && sy > -32) {\r
        int sbl = (2<<(pack>>28))-1;\r
        sblocks |= sbl<<(sy>>3);\r
      }\r
\r
      *pd = (pack&~(1<<23))|skip;\r
      *(pd+1) = code2;\r
\r
      // Find next sprite\r
      link=(code>>16)&0x7f;\r
      if(!link) break; // End of sprites\r
    }\r
    SpriteBlocks |= sblocks;\r
  }\r
  else\r
  {\r
    for (; u < 80; u++)\r
    {\r
      unsigned int *sprite;\r
      int code, code2, sx, sy, hv, height, width, skip=0, sx_min;\r
\r
      sprite=(unsigned int *)(Pico.vram+((table+(link<<2))&0x7ffc)); // Find sprite\r
\r
      // parse sprite info\r
      code = sprite[0];\r
      sy = (code&0x1ff)-0x80;\r
      hv = (code>>24)&0xf;\r
      height = (hv&3)+1;\r
\r
      if(sy > 240 || sy + (height<<3) <= 0) skip|=1<<22;\r
\r
      width  = (hv>>2)+1;\r
      code2 = sprite[1];\r
      sx = (code2>>16)&0x1ff;\r
      sx -= 0x78; // Get X coordinate + 8\r
      sx_min = 8-(width<<3);\r
\r
      if((sx <= sx_min && sx >= -0x76) || sx >= 328) skip|=1<<23;\r
      else if (sx > sx_min && !skip) {\r
        int sbl = (2<<height)-1;\r
        int shi = sy>>3;\r
        if(shi < 0) shi=0; // negative sy\r
        sblocks |= sbl<<shi;\r
      }\r
\r
      *pd++ = (width<<28)|(height<<24)|skip|(hv<<16)|((unsigned short)sy);\r
      *pd++ = (sx<<16)|((unsigned short)code2);\r
\r
      // Find next sprite\r
      link=(code>>16)&0x7f;\r
      if(!link) break; // End of sprites\r
    }\r
    SpriteBlocks = sblocks;\r
    *pd = 0; // terminate\r
  }\r
}\r
\r
static void DrawAllSprites(int *hcache, int maxwidth, int prio, int sh)\r
{\r
  int i,u,n;\r
  int sx1seen=0; // sprite with x coord 1 or 0 seen\r
  int ntiles = 0; // tile counter for sprite limit emulation\r
  int *sprites[40]; // Sprites to draw in fast mode\r
  int *ps, pack, rs = rendstatus, scan=Scanline;\r
\r
  if(rs&8) {\r
    DrawAllSpritesInterlace(prio, maxwidth);\r
    return;\r
  }\r
  if(rs&0x11) {\r
    //dprintf("PrepareSprites(%i) [%i]", (rs>>4)&1, scan);\r
    PrepareSprites(rs&0x10);\r
    rendstatus=rs&~0x11;\r
  }\r
  if (!(SpriteBlocks & (1<<(scan>>3)))) return;\r
\r
  if(((rs&4)||sh)&&prio==0)\r
    memset(HighSprZ, 0, 328);\r
  if(!(rs&4)&&prio) {\r
    if(hcache[0]) DrawSpritesFromCache(hcache, sh);\r
    return;\r
  }\r
\r
  ps = HighPreSpr;\r
\r
  // Index + 0  :    hhhhvvvv ab--hhvv yyyyyyyy yyyyyyyy // a: offscreen h, b: offs. v, h: horiz. size\r
  // Index + 4  :    xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
\r
  for(i=u=n=0; (pack = *ps) && n < 20; ps+=2, u++)\r
  {\r
    int sx, sy, row, pack2;\r
\r
    if(pack & 0x00400000) continue;\r
\r
    // get sprite info\r
    pack2 = *(ps+1);\r
    sx =  pack2>>16;\r
    sy = (pack <<16)>>16;\r
    row = scan-sy;\r
\r
    //dprintf("x: %i y: %i %ix%i", sx, sy, (pack>>28)<<3, (pack>>21)&0x38);\r
\r
    if(sx == -0x77) sx1seen|=1; // for masking mode 2\r
\r
    // check if it is on this line\r
    if(row < 0 || row >= ((pack>>21)&0x38)) continue; // no\r
    n++; // number of sprites on this line (both visible and hidden, max is 20) [broken]\r
\r
    // sprite limit\r
    ntiles += pack>>28;\r
    if(ntiles > 40) break;\r
\r
    if(pack & 0x00800000) continue;\r
\r
    // masking sprite?\r
    if(sx == -0x78) {\r
      if(!(sx1seen&1) || sx1seen==3) {\r
        break; // this sprite is not drawn and remaining sprites are masked\r
      }\r
      if((sx1seen>>8) == 0) sx1seen=(i+1)<<8;\r
      continue;\r
    }\r
    else if(sx == -0x77) {\r
      // masking mode2 (Outrun, Galaxy Force II, Shadow of the beast)\r
      if(sx1seen>>8) { i=(sx1seen>>8)-1; break; } // seen both 0 and 1\r
      sx1seen |= 2;\r
      continue;\r
    }\r
\r
    // accurate sprites\r
    //dprintf("P:%i",((sx>>15)&1));\r
    if(rs&4) {\r
      // might need to skip this sprite\r
      if((pack2&0x8000) ^ (prio<<15)) continue;\r
      DrawSpriteZ(pack,pack2,sh|(prio<<1),(char)(0x1f-n));\r
      continue;\r
    }\r
\r
    // sprite is good, save it's pointer\r
    sprites[i++]=ps;\r
  }\r
\r
  // Go through sprites backwards:\r
  if(!(rs&4)) {\r
    for (i--; i>=0; i--)\r
      DrawSprite(sprites[i],&hcache,sh);\r
\r
    // terminate cache list\r
    *hcache = 0;\r
  }\r
}\r
\r
\r
// --------------------------------------------\r
\r
#ifndef _ASM_DRAW_C\r
static void BackFill(int reg7, int sh)\r
{\r
  unsigned int back=0;\r
  unsigned int *pd=NULL,*end=NULL;\r
\r
  // Start with a blank scanline (background colour):\r
  back=reg7&0x3f;\r
  back|=sh<<6;\r
  back|=back<<8;\r
  back|=back<<16;\r
\r
  pd= (unsigned int *)(HighCol+8);\r
  end=(unsigned int *)(HighCol+8+320);\r
\r
  do { pd[0]=pd[1]=pd[2]=pd[3]=back; pd+=4; } while (pd<end);\r
}\r
#endif\r
\r
// --------------------------------------------\r
\r
unsigned short HighPal[0x100];\r
\r
#ifndef _ASM_DRAW_C\r
static void FinalizeLineBGR444(int sh)\r
{\r
  unsigned short *pd=DrawLineDest;\r
  unsigned char  *ps=HighCol+8;\r
  unsigned short *pal=Pico.cram;\r
  int len, i, t;\r
\r
  if (Pico.video.reg[12]&1) {\r
    len = 320;\r
  } else {\r
    if(!(PicoOpt&0x100)) pd+=32;\r
    len = 256;\r
  }\r
\r
  if(sh) {\r
    pal=HighPal;\r
    if(Pico.m.dirtyPal) {\r
      blockcpy(pal, Pico.cram, 0x40*2);\r
      // shadowed pixels\r
      for(i = 0x3f; i >= 0; i--)\r
        pal[0x40|i] = pal[0xc0|i] = (unsigned short)((pal[i]>>1)&0x0777);\r
      // hilighted pixels\r
      for(i = 0x3f; i >= 0; i--) {\r
        t=pal[i]&0xeee;t+=0x444;if(t&0x10)t|=0xe;if(t&0x100)t|=0xe0;if(t&0x1000)t|=0xe00;t&=0xeee;\r
        pal[0x80|i]=(unsigned short)t;\r
      }\r
      Pico.m.dirtyPal = 0;\r
    }\r
  }\r
\r
  for(i = 0; i < len; i++)\r
    pd[i] = pal[ps[i]];\r
}\r
\r
\r
static void FinalizeLineRGB555(int sh)\r
{\r
  unsigned short *pd=DrawLineDest;\r
  unsigned char  *ps=HighCol+8;\r
  unsigned short *pal=HighPal;\r
  int len, i, t, dirtyPal = Pico.m.dirtyPal;\r
\r
  if (dirtyPal)\r
  {\r
    unsigned int *spal=(void *)Pico.cram;\r
    unsigned int *dpal=(void *)HighPal;\r
    for (i = 0x3f/2; i >= 0; i--)\r
#ifdef USE_BGR555\r
      dpal[i] = ((spal[i]&0x000f000f)<< 1)|((spal[i]&0x00f000f0)<<3)|((spal[i]&0x0f000f00)<<4);\r
#else\r
      dpal[i] = ((spal[i]&0x000f000f)<<12)|((spal[i]&0x00f000f0)<<3)|((spal[i]&0x0f000f00)>>7);\r
#endif\r
    Pico.m.dirtyPal = 0;\r
  }\r
\r
  if (sh)\r
  {\r
    if (dirtyPal) {\r
      // shadowed pixels\r
      for (i = 0x3f; i >= 0; i--)\r
        pal[0x40|i] = pal[0xc0|i] = (unsigned short)((pal[i]>>1)&0x738e);\r
      // hilighted pixels\r
      for (i = 0x3f; i >= 0; i--) {\r
        t=pal[i]&0xe71c;t+=0x4208;if(t&0x20)t|=0x1c;if(t&0x800)t|=0x700;if(t&0x10000)t|=0xe000;t&=0xe71c;\r
        pal[0x80|i]=(unsigned short)t;\r
      }\r
    }\r
  }\r
\r
  if (Pico.video.reg[12]&1) {\r
    len = 320;\r
  } else {\r
    if (!(PicoOpt&0x100)) pd+=32;\r
    len = 256;\r
  }\r
\r
#ifndef PSP\r
  for (i = 0; i < len; i++)\r
    pd[i] = pal[ps[i]];\r
#else\r
  {\r
    extern void amips_clut(unsigned short *dst, unsigned char *src, unsigned short *pal, int count);\r
    amips_clut(pd, ps, pal, len);\r
  }\r
#endif\r
}\r
#endif\r
\r
static void FinalizeLine8bit(int sh)\r
{\r
  unsigned char *pd=DrawLineDest;\r
  int len, rs = rendstatus;\r
  static int dirty_count;\r
\r
  if (!sh && Pico.m.dirtyPal == 1 && Scanline < 222) {\r
    // a hack for mid-frame palette changes\r
    if (!(rs & 0x20))\r
         dirty_count = 1;\r
    else dirty_count++;\r
    rs |= 0x20;\r
    rendstatus = rs;\r
    if (dirty_count == 3) {\r
      blockcpy(HighPal, Pico.cram, 0x40*2);\r
    } else if (dirty_count == 11) {\r
      blockcpy(HighPal+0x40, Pico.cram, 0x40*2);\r
    }\r
  }\r
\r
  if (Pico.video.reg[12]&1) {\r
    len = 320;\r
  } else {\r
    if(!(PicoOpt&0x100)) pd+=32;\r
    len = 256;\r
  }\r
\r
  if (!sh && rs & 0x20) {\r
    if (dirty_count >= 11) {\r
      blockcpy_or(pd, HighCol+8, len, 0x80);\r
    } else {\r
      blockcpy_or(pd, HighCol+8, len, 0x40);\r
    }\r
  } else {\r
    blockcpy(pd, HighCol+8, len);\r
  }\r
}\r
\r
static void (*FinalizeLine)(int sh) = FinalizeLineBGR444;\r
\r
// --------------------------------------------\r
\r
static int DrawDisplay(int sh)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int win=0,edge=0,hvwind=0;\r
  int maxw, maxcells;\r
\r
  rendstatus&=~0xc0;\r
\r
  if(pvid->reg[12]&1) {\r
    maxw = 328; maxcells = 40;\r
  } else {\r
    maxw = 264; maxcells = 32;\r
  }\r
\r
  // Find out if the window is on this line:\r
  win=pvid->reg[0x12];\r
  edge=(win&0x1f)<<3;\r
\r
  if (win&0x80) { if (Scanline>=edge) hvwind=1; }\r
  else          { if (Scanline< edge) hvwind=1; }\r
\r
  if (!hvwind) { // we might have a vertical window here\r
    win=pvid->reg[0x11];\r
    edge=win&0x1f;\r
    if (win&0x80) {\r
      if (!edge) hvwind=1;\r
      else if(edge < (maxcells>>1)) hvwind=2;\r
    } else {\r
      if (!edge);\r
      else if(edge < (maxcells>>1)) hvwind=2;\r
      else hvwind=1;\r
    }\r
  }\r
\r
  DrawLayer(1|(sh<<1), HighCacheB, 0, maxcells);\r
  if (hvwind == 1)\r
    DrawWindow(0, maxcells>>1, 0, sh);\r
  else if (hvwind == 2) {\r
    // ahh, we have vertical window\r
    DrawLayer(0|(sh<<1), HighCacheA, (win&0x80) ?    0 : edge<<1, (win&0x80) ?     edge<<1 : maxcells);\r
    DrawWindow(                      (win&0x80) ? edge :       0, (win&0x80) ? maxcells>>1 : edge, 0, sh);\r
  } else\r
    DrawLayer(0|(sh<<1), HighCacheA, 0, maxcells);\r
  DrawAllSprites(HighCacheS, maxw, 0, sh);\r
\r
  if (HighCacheB[0]) DrawTilesFromCache(HighCacheB, sh, 328);\r
  if (hvwind == 1)\r
    DrawWindow(0, maxcells>>1, 1, sh);\r
  else if (hvwind == 2) {\r
    if(HighCacheA[0]) DrawTilesFromCache(HighCacheA, sh, (win&0x80) ? edge<<4 : 328);\r
    DrawWindow((win&0x80) ? edge : 0, (win&0x80) ? maxcells>>1 : edge, 1, sh);\r
  } else\r
    if (HighCacheA[0]) DrawTilesFromCache(HighCacheA, sh, 328);\r
  DrawAllSprites(HighCacheS, maxw, 1, sh);\r
\r
#if 0\r
  {\r
    int *c, a, b;\r
    for (a = 0, c = HighCacheA; *c; c++, a++);\r
    for (b = 0, c = HighCacheB; *c; c++, b++);\r
    printf("%i:%03i: a=%i, b=%i\n", Pico.m.frame_count, Scanline, a, b);\r
  }\r
#endif\r
\r
  return 0;\r
}\r
\r
\r
static int Skip=0;\r
\r
PICO_INTERNAL void PicoFrameStart(void)\r
{\r
  // prepare to do this frame\r
  rendstatus = (PicoOpt&0x80)>>5;    // accurate sprites\r
  if(rendstatus)\r
       Pico.video.status &= ~0x0020;\r
  else Pico.video.status |=  0x0020; // sprite collision\r
  if((Pico.video.reg[12]&6) == 6) rendstatus |= 8; // interlace mode\r
  if(Pico.m.dirtyPal) Pico.m.dirtyPal = 2; // reset dirty if needed\r
\r
  PrepareSprites(1);\r
  Skip=0;\r
}\r
\r
PICO_INTERNAL int PicoLine(int scan)\r
{\r
  int sh;\r
  if (Skip>0) { Skip--; return 0; } // Skip rendering lines\r
\r
  Scanline=scan;\r
  sh=(Pico.video.reg[0xC]&8)>>3; // shadow/hilight?\r
\r
  // Draw screen:\r
  BackFill(Pico.video.reg[7], sh);\r
  if (Pico.video.reg[1]&0x40)\r
    DrawDisplay(sh);\r
\r
  if (FinalizeLine != NULL)\r
    FinalizeLine(sh);\r
\r
  Skip=PicoScan(Scanline,DrawLineDest);\r
\r
  return 0;\r
}\r
\r
\r
void PicoDrawSetColorFormat(int which)\r
{\r
  switch (which)\r
  {\r
    case 2: FinalizeLine = FinalizeLine8bit;   break;\r
    case 1: FinalizeLine = FinalizeLineRGB555; break;\r
    case 0: FinalizeLine = FinalizeLineBGR444; break;\r
    default:FinalizeLine = NULL; break;\r
  }\r
#if OVERRIDE_HIGHCOL\r
  if (which) HighCol=DefHighCol;\r
#endif\r
}\r
\r