[picodrive.git] / Pico / Draw.c

// This is part of Pico Library\r
\r
// (c) Copyright 2004 Dave, All rights reserved.\r
// (c) Copyright 2006-2008 notaz, All rights reserved.\r
// Free for non-commercial use.\r
\r
// For commercial use, separate licencing terms must be obtained.\r
\r
/*\r
 * The renderer has 4 modes now:\r
 * - normal\r
 * - shadow/hilight (s/h)\r
 * - "sonic mode" for midline palette changes\r
 * - accurate sprites (AS)\r
 *\r
 * AS and s/h both use upper bits for both priority and shadow/hilight flags.\r
 * "sonic mode" is autodetected, shadow/hilight is enabled by emulated game.\r
 * AS is enabled by user and takes priority over "sonic mode".\r
 */\r
\r
#include "PicoInt.h"\r
\r
int (*PicoScanBegin)(unsigned int num) = NULL;\r
int (*PicoScanEnd)  (unsigned int num) = 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
int *HighCacheS_ptr;\r
\r
int rendstatus = 0;\r
int DrawScanline = 0;\r
\r
static int SpriteBlocks;\r
static int skip_next_line=0;\r
\r
//unsigned short ppt[] = { 0x0f11, 0x0ff1, 0x01f1, 0x011f, 0x01ff, 0x0f1f, 0x0f0e, 0x0e7c };\r
\r
static void (*DrawAllSpritesLoPri)(int *hcache, int maxwidth, int prio, int sh) = NULL;\r
static void (*DrawAllSpritesHiPri)(int *hcache, int maxwidth, int prio, int sh) = NULL;\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 sh, int as);\r
void DrawTilesFromCache(int *hc, int sh, int rlim);\r
void DrawSpritesFromCache(int *hc, int maxwidth, int prio, 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(void *dst, const void *src, size_t n);\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
#define blockcpy memcpy\r
#endif\r
\r
\r
#define TileNormMaker(funcname,pix_func)                     \\r
static int funcname(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)>>12; pix_func(0);                    \\r
    t=(pack&0x00000f00)>> 8; pix_func(1);                    \\r
    t=(pack&0x000000f0)>> 4; pix_func(2);                    \\r
    t=(pack&0x0000000f)    ; pix_func(3);                    \\r
    t=(pack&0xf0000000)>>28; pix_func(4);                    \\r
    t=(pack&0x0f000000)>>24; pix_func(5);                    \\r
    t=(pack&0x00f00000)>>20; pix_func(6);                    \\r
    t=(pack&0x000f0000)>>16; pix_func(7);                    \\r
    return 0;                                                \\r
  }                                                          \\r
                                                             \\r
  return 1; /* Tile blank */                                 \\r
}\r
\r
\r
#define TileFlipMaker(funcname,pix_func)                     \\r
static int funcname(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)>>16; pix_func(0);                    \\r
    t=(pack&0x00f00000)>>20; pix_func(1);                    \\r
    t=(pack&0x0f000000)>>24; pix_func(2);                    \\r
    t=(pack&0xf0000000)>>28; pix_func(3);                    \\r
    t=(pack&0x0000000f)    ; pix_func(4);                    \\r
    t=(pack&0x000000f0)>> 4; pix_func(5);                    \\r
    t=(pack&0x00000f00)>> 8; pix_func(6);                    \\r
    t=(pack&0x0000f000)>>12; pix_func(7);                    \\r
    return 0;                                                \\r
  }                                                          \\r
                                                             \\r
  return 1; /* Tile blank */                                 \\r
}\r
\r
\r
#ifdef _ASM_DRAW_C_AMIPS\r
int TileNorm(int sx,int addr,int pal);\r
int TileFlip(int sx,int addr,int pal);\r
#else\r
\r
#define pix_just_write(x) \\r
  if (t) pd[x]=pal|t\r
\r
TileNormMaker(TileNorm,pix_just_write)\r
TileFlipMaker(TileFlip,pix_just_write)\r
\r
#endif\r
\r
// draw a sprite pixel, process operator colors\r
#define pix_sh(x) \\r
  if (!t); \\r
  else if (t==0xe) pd[x]=(pd[x]&0x3f)|0x80; /* hilight */ \\r
  else if (t==0xf) pd[x]= pd[x]      |0xc0; /* shadow  */ \\r
  else pd[x]=pal|t\r
\r
TileNormMaker(TileNormSH, pix_sh)\r
TileFlipMaker(TileFlipSH, pix_sh)\r
\r
#ifndef _ASM_DRAW_C\r
// draw a sprite pixel ignoring operator colors\r
#define pix_sh_noop(x) \\r
  if (t && t < 0xe) \\r
    pd[x]=pal|t\r
\r
TileNormMaker(TileNormSH_noop, pix_sh_noop)\r
TileFlipMaker(TileFlipSH_noop, pix_sh_noop)\r
#endif\r
\r
// process operator pixels only, apply only on low pri tiles\r
#define pix_sh_onlyop(x) \\r
  if      (t==0xe && (pd[x]&0x40)) pd[x]=(pd[x]&0x3f)|0x80; /* hilight */ \\r
  else if (t==0xf && (pd[x]&0x40)) pd[x]= pd[x]      |0xc0; /* shadow  */\r
\r
TileNormMaker(TileNormSH_onlyop_lp, pix_sh_onlyop)\r
TileFlipMaker(TileFlipSH_onlyop_lp, pix_sh_onlyop)\r
\r
// draw a sprite pixel (AS)\r
#define pix_as(x) \\r
  if (t && !(pd[x]&0x80)) pd[x]=pal|t\r
\r
TileNormMaker(TileNormAS, pix_as)\r
TileFlipMaker(TileFlipAS, pix_as)\r
\r
// draw a sprite pixel, skip operator colors (AS)\r
#define pix_sh_as_noop(x) \\r
  if (t && t < 0xe && !(pd[x]&0x80)) pd[x]=pal|t\r
\r
TileNormMaker(TileNormAS_noop, pix_sh_as_noop)\r
TileFlipMaker(TileFlipAS_noop, pix_sh_as_noop)\r
\r
// mark pixel as sprite pixel (AS)\r
#define pix_sh_as_onlymark(x) \\r
  if (t) pd[x]|=0x80\r
\r
TileNormMaker(TileNormAS_onlymark, pix_sh_as_onlymark)\r
TileFlipMaker(TileFlipAS_onlymark, pix_sh_as_onlymark)\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 |= PDRAW_PLANE_HI_PRIO;\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=DrawScanline;\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 |= PDRAW_PLANE_HI_PRIO;\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+=DrawScanline<<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+(DrawScanline<<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+DrawScanline)&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,ty,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+=(DrawScanline>>3)<<6;\r
  }\r
  else\r
  {\r
    nametab=(pvid->reg[3]&0x3e)<<9; // 32-cell mode\r
    nametab+=(DrawScanline>>3)<<5;\r
  }\r
\r
  tilex=tstart<<1;\r
\r
  if (!(rendstatus & PDRAW_WND_DIFF_PRIO)) {\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
  tend<<=1;\r
  ty=(DrawScanline&7)<<1; // Y-Offset into tile\r
\r
  // Draw tiles across screen:\r
  if (!sh)\r
  {\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 |= PDRAW_WND_DIFF_PRIO;\r
        continue;\r
      }\r
\r
      pal=((code>>9)&0x30);\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
  else\r
  {\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 |= PDRAW_WND_DIFF_PRIO;\r
        continue;\r
      }\r
\r
      pal=((code>>9)&0x30);\r
\r
      if (prio) {\r
        int *zb = (int *)(HighCol+8+(tilex<<3));\r
        *zb++ &= 0x3f3f3f3f;\r
        *zb   &= 0x3f3f3f3f;\r
      } else {\r
        pal |= 0x40;\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
}\r
\r
// --------------------------------------------\r
\r
static void DrawTilesFromCacheShPrep(void)\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
  int c = 320/4, *zb = (int *)(HighCol+8);\r
  rendstatus |= PDRAW_SHHI_DONE;\r
  while (c--)\r
  {\r
    *zb++ &= 0x3f3f3f3f;\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 & (PDRAW_SHHI_DONE|PDRAW_PLANE_HI_PRIO)))\r
  {\r
    if (!(rendstatus & PDRAW_SHHI_DONE))\r
      DrawTilesFromCacheShPrep();\r
    sh = 0;\r
  }\r
\r
  if (!sh)\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
  else\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
      *zb++ &= 0x3f; *zb++ &= 0x3f; *zb++ &= 0x3f; *zb++ &= 0x3f;\r
      *zb++ &= 0x3f; *zb++ &= 0x3f; *zb++ &= 0x3f; *zb++ &= 0x3f;\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
  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 sh, int as)\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=DrawScanline-sy; // Row of the sprite we are on\r
\r
  if (code&0x1000) row=(height<<3)-1-row; // Flip Y\r
\r
  tile=code + (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 &= 0x7ff; tile<<=4; tile+=(row&7)<<1; // Tile address\r
\r
  pal=(code>>9)&0x30;\r
\r
  // assume there will be no sprites with both normal and operator pixels..\r
  if ((code&0x8000) || (sh && pal == 0x30) || as) {\r
    *HighCacheS_ptr++ = ((code&0x8000)<<16)|(tile<<16)|((code&0x0800)<<5)|((sx<<6)&0x0000ffc0)|pal|((sprite[0]>>16)&0xf);\r
    // we need all for accurate sprites, cached will be used to do proper priorities\r
    if (!as && (code&0x8000)) return;\r
  }\r
\r
  delta<<=4; // Delta of address\r
  pal|=((sh|as)<<6);\r
\r
  if (sh && (code&0x6000) == 0x6000) {\r
    if(code&0x0800) fTileFunc=TileFlipSH_noop;\r
    else            fTileFunc=TileNormSH_noop;\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
#endif\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=(DrawScanline<<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 *hcache, int maxwidth, int pri, int sh)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int i,u,table,link=0,sline=DrawScanline<<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
  HighCacheS[0] = 1; // just to fool main code\r
}\r
\r
\r
#ifndef _ASM_DRAW_C\r
static void DrawSpritesFromCache(int *hc, int maxwidth, int prio, int sh)\r
{\r
  int code, tile, sx, delta, width;\r
  int pal;\r
  int (*fTileFunc)(int sx,int addr,int pal);\r
\r
  // prio[31]:tile[30:17]:flipx[16]:sx[15:6]:pal[5:4]:delta_width[3:0]\r
\r
  while ((code=*hc++))\r
  {\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; // also has prio\r
    sx=(code<<16)>>22; // sx can be negative (start offscreen), so sign extend\r
\r
    if (sh && pal == 0x30)\r
    {\r
      if (code & 0x80000000) // hi priority\r
      {\r
        if(code&0x10000) fTileFunc=TileFlipSH;\r
        else             fTileFunc=TileNormSH;\r
      } else {\r
        if(code&0x10000) fTileFunc=TileFlipSH_onlyop_lp;\r
        else             fTileFunc=TileNormSH_onlyop_lp;\r
      }\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
static void DrawSpritesFromCacheAS(int *hc, int maxwidth, int prio, int sh)\r
{\r
  int code, tile, sx, delta, width;\r
  int pal, *hce, *hco;\r
  int (*fTileFunc)(int sx,int addr,int pal);\r
\r
  // prio[31]:tile[30:17]:flipx[16]:sx[15:6]:pal[5:4]:delta_width[3:0]\r
\r
  /* walk the sprite cache backwards.. */\r
  hco = hce = HighCacheS_ptr;\r
  while (hce > hc)\r
  {\r
    code=*(--hce);\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 (code & 0x80000000) // hi priority\r
    {\r
      if (sh && pal == 0x30)\r
      {\r
        if(code&0x10000) fTileFunc=TileFlipAS_noop;\r
        else             fTileFunc=TileNormAS_noop;\r
        *(--hco) = code; /* save for later */\r
      } else {\r
        if(code&0x10000) fTileFunc=TileFlipAS;\r
        else             fTileFunc=TileNormAS;\r
      }\r
    } else {\r
      if(code&0x10000) fTileFunc=TileFlipAS_onlymark;\r
      else             fTileFunc=TileNormAS_onlymark;\r
    }\r
\r
    pal |= 0x80;\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
  if (!sh) return;\r
\r
  /* nasty 1: remove 'sprite' flags */\r
  {\r
    int c = 320/4, *zb = (int *)(HighCol+8);\r
    while (c--)\r
    {\r
      *zb++ &= 0x7f7f7f7f;\r
    }\r
  }\r
\r
  /* nasty 2: loop once more and do operator colors */\r
  while ((code=*hco++))\r
  {\r
    pal=(code&0x30);\r
    if (pal != 0x30) continue;\r
    delta=code&0xf;\r
    width=delta>>2; delta&=3;\r
    width++; delta++;\r
    if (code&0x10000) delta=-delta; // Flip X\r
    delta<<=4;\r
    tile=((unsigned int)code>>17)<<1;\r
    sx=(code<<16)>>22;\r
\r
    if (code & 0x80000000)\r
    {\r
      if(code&0x10000) fTileFunc=TileFlipSH;\r
      else             fTileFunc=TileNormSH;\r
    } else {\r
      if(code&0x10000) fTileFunc=TileFlipSH_onlyop_lp;\r
      else             fTileFunc=TileNormSH_onlyop_lp;\r
    }\r
\r
    pal |= 0x80;\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
\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; // sprite offscreen (completely, y)\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; // offscreen x\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 max_line_sprites = 20; // 20 sprites, 40 tiles\r
  int *ps, pack, rs = rendstatus, scan = DrawScanline;\r
\r
  if (rs & (PDRAW_SPRITES_MOVED|PDRAW_DIRTY_SPRITES)) {\r
    //dprintf("PrepareSprites(%i) [%i]", (rs>>4)&1, scan);\r
    PrepareSprites(rs & PDRAW_DIRTY_SPRITES);\r
    rendstatus = rs & ~(PDRAW_SPRITES_MOVED|PDRAW_DIRTY_SPRITES);\r
  }\r
  if (!(SpriteBlocks & (1<<(scan>>3)))) { *hcache = 0; return; }\r
\r
  if (PicoOpt & POPT_DIS_SPRITE_LIM)\r
    max_line_sprites = 80;\r
\r
  HighCacheS_ptr = hcache;\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 < max_line_sprites; 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
    // elprintf(EL_ANOMALY, "x: %4i y: %4i p %i %ix%i", sx, sy, (pack2>>15)&1, (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
\r
    // masking sprite?\r
    if (sx == -0x78) {\r
      if (n > 0) break; // masked\r
      continue;\r
    }\r
\r
    n++; // number of sprites on this line (both visible and hidden, except of x=0)\r
\r
    // sprite limit\r
    ntiles += pack>>28;\r
    if (ntiles > max_line_sprites*2) break;\r
\r
    if (pack & 0x00800000) continue;\r
\r
    // sprite is good, save it's pointer\r
    sprites[i++]=ps;\r
  }\r
\r
  n = (rs & PDRAW_ACC_SPRITES) ? 1 : 0;\r
\r
  // Go through sprites backwards:\r
  for (i--; i>=0; i--)\r
    DrawSprite(sprites[i],sh,n);\r
\r
  // terminate cache list\r
  *HighCacheS_ptr = 0;\r
}\r
\r
\r
// --------------------------------------------\r
\r
#ifndef _ASM_DRAW_C\r
static void BackFill(int reg7, int sh)\r
{\r
  unsigned int back;\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
  memset32((int *)(HighCol+8), back, 320/4);\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, mask=0xff;\r
\r
  if (Pico.video.reg[12]&1) {\r
    len = 320;\r
  } else {\r
    if(!(PicoOpt&POPT_DIS_32C_BORDER)) 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
  if (!sh && (rendstatus & PDRAW_ACC_SPRITES))\r
    mask=0x3f; // accurate sprites\r
\r
  for(i = 0; i < len; i++)\r
    pd[i] = pal[ps[i] & mask];\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&POPT_DIS_32C_BORDER)) pd+=32;\r
    len = 256;\r
  }\r
\r
  {\r
#ifndef PSP\r
    int mask=0xff;\r
    if (!sh && (rendstatus & PDRAW_ACC_SPRITES))\r
      mask=0x3f; // accurate sprites, upper bits are priority stuff\r
\r
    for (i = 0; i < len; i++)\r
      pd[i] = pal[ps[i] & mask];\r
#else\r
    extern void amips_clut(unsigned short *dst, unsigned char *src, unsigned short *pal, int count);\r
    extern void amips_clut_6bit(unsigned short *dst, unsigned char *src, unsigned short *pal, int count);\r
    if (!sh && (rendstatus & PDRAW_ACC_SPRITES))\r
         amips_clut_6bit(pd, ps, pal, len);\r
    else amips_clut(pd, ps, pal, len);\r
#endif\r
  }\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 && !(rs & PDRAW_ACC_SPRITES) && Pico.m.dirtyPal == 1 && DrawScanline < 222)\r
  {\r
    // a hack for mid-frame palette changes\r
    if (!(rs & PDRAW_SONIC_MODE))\r
         dirty_count = 1;\r
    else dirty_count++;\r
    rs |= PDRAW_SONIC_MODE;\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&POPT_DIS_32C_BORDER)) pd+=32;\r
    len = 256;\r
  }\r
\r
  if (!sh && (rs & PDRAW_SONIC_MODE)) {\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 void DrawBlankedLine(void)\r
{\r
  int sh=(Pico.video.reg[0xC]&8)>>3; // shadow/hilight?\r
\r
  if (PicoScanBegin != NULL)\r
    PicoScanBegin(DrawScanline);\r
\r
  BackFill(Pico.video.reg[7], sh);\r
\r
  if (FinalizeLine != NULL)\r
    FinalizeLine(sh);\r
\r
  if (PicoScanEnd != NULL)\r
    PicoScanEnd(DrawScanline);\r
}\r
\r
static int DrawDisplay(int sh, int as)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int win=0,edge=0,hvwind=0;\r
  int maxw, maxcells;\r
\r
  rendstatus &= ~(PDRAW_SHHI_DONE|PDRAW_PLANE_HI_PRIO);\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 (DrawScanline>=edge) hvwind=1; }\r
  else          { if (DrawScanline< 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|as)<<1), HighCacheB, 0, maxcells);\r
  if (hvwind == 1)\r
    DrawWindow(0, maxcells>>1, 0, sh|as);\r
  else if (hvwind == 2) {\r
    // ahh, we have vertical window\r
    DrawLayer(0|((sh|as)<<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|as);\r
  } else\r
    DrawLayer(0|((sh|as)<<1), HighCacheA, 0, maxcells);\r
  DrawAllSpritesLoPri(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
  if (HighCacheS[0]) DrawAllSpritesHiPri(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, DrawScanline, a, b);\r
  }\r
#endif\r
\r
  return 0;\r
}\r
\r
\r
PICO_INTERNAL void PicoFrameStart(void)\r
{\r
  // prepare to do this frame\r
  rendstatus = (PicoOpt&0x80)>>5;    // accurate sprites, clear everything else\r
  if ((Pico.video.reg[12]&6) == 6) {\r
    rendstatus |= PDRAW_INTERLACE; // interlace mode\r
    DrawAllSpritesLoPri = DrawAllSpritesInterlace;\r
    DrawAllSpritesHiPri = DrawAllSpritesInterlace;\r
  }\r
  else\r
  {\r
    DrawAllSpritesLoPri = DrawAllSprites;\r
    DrawAllSpritesHiPri = rendstatus ? DrawSpritesFromCacheAS : DrawSpritesFromCache;\r
  }\r
\r
  if (Pico.m.dirtyPal) Pico.m.dirtyPal = 2; // reset dirty if needed\r
\r
  PrepareSprites(1);\r
  skip_next_line=0;\r
  DrawScanline=0;\r
}\r
\r
static void PicoLine(void)\r
{\r
  int sh, as = 0;\r
  if (skip_next_line>0) { skip_next_line--; return; } // skip rendering lines\r
\r
  sh=(Pico.video.reg[0xC]&8)>>3; // shadow/hilight?\r
  if (rendstatus & PDRAW_ACC_SPRITES) as|=1; // accurate sprites\r
\r
  if (PicoScanBegin != NULL)\r
    skip_next_line = PicoScanBegin(DrawScanline);\r
\r
  // Draw screen:\r
  BackFill(Pico.video.reg[7], sh|as);\r
  if (Pico.video.reg[1]&0x40)\r
    DrawDisplay(sh, as);\r
\r
  if (FinalizeLine != NULL)\r
    FinalizeLine(sh);\r
\r
  if (PicoScanEnd != NULL)\r
    PicoScanEnd(DrawScanline);\r
}\r
\r
void PicoDrawSync(int to, int blank_last_line)\r
{\r
  for (; DrawScanline < to; DrawScanline++)\r
  {\r
#if !CAN_HANDLE_240_LINES\r
    if (DrawScanline >= 224) break;\r
#endif\r
    PicoLine();\r
  }\r
\r
#if !CAN_HANDLE_240_LINES\r
  if (DrawScanline >= 224) DrawScanline = 240, return;\r
#endif\r
\r
  // last line\r
  if (DrawScanline <= to)\r
  {\r
    if (blank_last_line)\r
         DrawBlankedLine();\r
    else PicoLine();\r
    DrawScanline++;\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