[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 (8bit mode only)\r
 * - accurate sprites (AS) [+ s/h]\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
 * since renderer always draws line in 8bit mode, there are 2 spare bits:\r
 * b \ mode: s/h             as        sonic\r
 * 00        normal          -         pal index\r
 * 01        shadow          -         pal index\r
 * 10        hilight+op spr  spr       pal index\r
 * 11        shadow +op spr  -         pal index\r
 *\r
 * not handled properly:\r
 * - hilight op on shadow tile\r
 * - AS + s/h (s/h sprite flag interferes with and cleared by AS code)\r
 */\r
\r
#include "pico_int.h"\r
\r
int (*PicoScanBegin)(unsigned int num) = NULL;\r
int (*PicoScanEnd)  (unsigned int num) = NULL;\r
\r
static unsigned char DefHighCol[8+320+8];\r
unsigned char *HighCol = DefHighCol;\r
static unsigned char *HighColBase = DefHighCol;\r
static int HighColIncrement;\r
\r
static unsigned int DefOutBuff[320*2/2];\r
void *DrawLineDest = DefOutBuff; // pointer to dest buffer where to draw this line to\r
void *DrawLineDestBase = DefOutBuff;\r
int DrawLineDestIncrement;\r
\r
static int  HighCacheA[41+1];   // caches for high layers\r
static int  HighCacheB[41+1];\r
int  HighPreSpr[80*2+1]; // slightly preprocessed sprites\r
\r
#define SPRL_HAVE_HI     0x80 // have hi priority sprites\r
#define SPRL_HAVE_LO     0x40 // *lo*\r
#define SPRL_MAY_HAVE_OP 0x20 // may have operator sprites on the line\r
#define SPRL_LO_ABOVE_HI 0x10 // low priority sprites may be on top of hi\r
unsigned char HighLnSpr[240][3 + MAX_LINE_SPRITES]; // sprite_count, ^flags, tile_count, [spritep]...\r
\r
int rendstatus, rendstatus_old;\r
int rendlines;\r
int DrawScanline;\r
int PicoDrawMask = -1;\r
\r
static int skip_next_line=0;\r
\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 DrawAllSprites(unsigned char *sprited, int prio, int sh);\r
void DrawTilesFromCache(int *hc, int sh, int rlim);\r
void DrawSpritesSHi(unsigned char *sprited);\r
void DrawLayer(int plane_sh, int *hcache, int cellskip, int maxcells);\r
void FinalizeLineBGR444(int sh, int line);\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
#ifndef _ASM_DRAW_C\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)|(t<<6); /* c0 shadow, 80 hilight */ \\r
  else pd[x]=pal|t\r
\r
TileNormMaker(TileNormSH, pix_sh)\r
TileFlipMaker(TileFlipSH, pix_sh)\r
\r
// draw a sprite pixel, mark operator colors\r
#define pix_sh_markop(x) \\r
  if (!t); \\r
  else if (t>=0xe) pd[x]|=0x80; \\r
  else pd[x]=pal|t\r
\r
TileNormMaker(TileNormSH_markop, pix_sh_markop)\r
TileFlipMaker(TileFlipSH_markop, pix_sh_markop)\r
\r
// process operator pixels only, apply only on low pri tiles and other op pixels\r
#define pix_sh_onlyop(x) \\r
  if (t>=0xe && (pd[x]&0xc0)) \\r
    pd[x]=(pd[x]&0x3f)|(t<<6); /* c0 shadow, 80 hilight */ \\r
\r
TileNormMaker(TileNormSH_onlyop_lp, pix_sh_onlyop)\r
TileFlipMaker(TileFlipSH_onlyop_lp, pix_sh_onlyop)\r
\r
#endif\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++ &= 0xbfbfbfbf;\r
        *zb   &= 0xbfbfbfbf;\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
  // but leave lo pri op sprite markers alone\r
  int c = 320/4, *zb = (int *)(HighCol+8);\r
  rendstatus |= PDRAW_SHHI_DONE;\r
  while (c--)\r
  {\r
    *zb++ &= 0xbfbfbfbf;\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++ &= 0xbf; *zb++ &= 0xbf; *zb++ &= 0xbf; *zb++ &= 0xbf;\r
      *zb++ &= 0xbf; *zb++ &= 0xbf; *zb++ &= 0xbf; *zb++ &= 0xbf;\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)\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
  delta<<=4; // Delta of address\r
\r
  pal=(code>>9)&0x30;\r
  pal|=sh<<6;\r
\r
  if (sh && (code&0x6000) == 0x6000) {\r
    if(code&0x0800) fTileFunc=TileFlipSH_markop;\r
    else            fTileFunc=TileNormSH_markop;\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 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 >= 328) 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
/*\r
 * s/h drawing: lo_layers|40, lo_sprites|40 && mark_op,\r
 *        hi_layers&=~40, hi_sprites\r
 *\r
 * Index + 0  :    hhhhvvvv ----hhvv yyyyyyyy yyyyyyyy // v, h: vert./horiz. size\r
 * Index + 4  :    xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
 */\r
static void DrawSpritesSHi(unsigned char *sprited)\r
{\r
  int (*fTileFunc)(int sx,int addr,int pal);\r
  unsigned char *p;\r
  int cnt;\r
\r
  cnt = sprited[0] & 0x7f;\r
  if (cnt == 0) return;\r
\r
  p = &sprited[3];\r
\r
  // Go through sprites backwards:\r
  for (cnt--; cnt >= 0; cnt--)\r
  {\r
    int *sprite, code, pal, tile, sx, sy;\r
    int offs, delta, width, height, row;\r
\r
    offs = (p[cnt] & 0x7f) * 2;\r
    sprite = HighPreSpr + offs;\r
    code = sprite[1];\r
    pal = (code>>9)&0x30;\r
\r
    if (pal == 0x30)\r
    {\r
      if (code & 0x8000) // hi priority\r
      {\r
        if (code&0x800) fTileFunc=TileFlipSH;\r
        else            fTileFunc=TileNormSH;\r
      } else {\r
        if (code&0x800) fTileFunc=TileFlipSH_onlyop_lp;\r
        else            fTileFunc=TileNormSH_onlyop_lp;\r
      }\r
    } else {\r
      if (!(code & 0x8000)) continue; // non-operator low sprite, already drawn\r
      if (code&0x800) fTileFunc=TileFlip;\r
      else            fTileFunc=TileNorm;\r
    }\r
\r
    // parse remaining sprite data\r
    sy=sprite[0];\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
    delta<<=4; // Delta of address\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 // !_ASM_DRAW_C\r
\r
static void DrawSpritesHiAS(unsigned char *sprited, int sh)\r
{\r
  int (*fTileFunc)(int sx,int addr,int pal);\r
  unsigned char *p;\r
  int entry, cnt, sh_cnt = 0;\r
\r
  cnt = sprited[0] & 0x7f;\r
  if (cnt == 0) return;\r
\r
  rendstatus |= PDRAW_SPR_LO_ON_HI;\r
\r
  p = &sprited[3];\r
\r
  // Go through sprites:\r
  for (entry = 0; entry < cnt; entry++)\r
  {\r
    int *sprite, code, pal, tile, sx, sy;\r
    int offs, delta, width, height, row;\r
\r
    offs = (p[entry] & 0x7f) * 2;\r
    sprite = HighPreSpr + offs;\r
    code = sprite[1];\r
    pal = (code>>9)&0x30;\r
\r
    if (code & 0x8000) // hi priority\r
    {\r
      if (sh && pal == 0x30)\r
      {\r
        if (code&0x800) fTileFunc=TileFlipAS_noop;\r
        else            fTileFunc=TileNormAS_noop;\r
      } else {\r
        if (code&0x800) fTileFunc=TileFlipAS;\r
        else            fTileFunc=TileNormAS;\r
      }\r
    } else {\r
      if (code&0x800) fTileFunc=TileFlipAS_onlymark;\r
      else            fTileFunc=TileNormAS_onlymark;\r
    }\r
    if (sh && pal == 0x30)\r
      p[sh_cnt++] = offs / 2; // re-save for sh/hi pass\r
\r
    // parse remaining sprite data\r
    sy=sprite[0];\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
    delta<<=4; // Delta of address\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 || !(sprited[1]&SPRL_MAY_HAVE_OP)) return;\r
\r
  /* nasty 1: remove 'sprite' flags */\r
  {\r
    int c = 320/4/4, *zb = (int *)(HighCol+8);\r
    while (c--)\r
    {\r
      *zb++ &= 0x7f7f7f7f; *zb++ &= 0x7f7f7f7f;\r
      *zb++ &= 0x7f7f7f7f; *zb++ &= 0x7f7f7f7f;\r
    }\r
  }\r
\r
  /* nasty 2: sh operator pass */\r
  sprited[0] = sh_cnt;\r
  DrawSpritesSHi(sprited);\r
}\r
\r
\r
// Index + 0  :    ----hhvv -lllllll -------y yyyyyyyy\r
// Index + 4  :    -------x xxxxxxxx pccvhnnn nnnnnnnn\r
// v\r
// Index + 0  :    hhhhvvvv ----hhvv yyyyyyyy yyyyyyyy // v, h: vert./horiz. size\r
// Index + 4  :    xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
\r
void PrepareSprites(int full)\r
{\r
  struct PicoVideo *pvid=&Pico.video;\r
  int u,link=0,sh;\r
  int table=0;\r
  int *pd = HighPreSpr;\r
  int max_lines = 224, max_sprites = 80, max_width = 328;\r
  int max_line_sprites = 20; // 20 sprites, 40 tiles\r
\r
  if (!(Pico.video.reg[12]&1))\r
    max_sprites = 64, max_line_sprites = 16, max_width = 264;\r
  if (PicoOpt & POPT_DIS_SPRITE_LIM)\r
    max_line_sprites = MAX_LINE_SPRITES;\r
\r
  if (pvid->reg[1]&8) max_lines = 240;\r
  sh = Pico.video.reg[0xC]&8; // shadow/hilight?\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 < max_sprites && (pack = *pd); u++, pd+=2)\r
    {\r
      unsigned int *sprite;\r
      int code2, sx, sy, height;\r
\r
      sprite=(unsigned int *)(Pico.vram+((table+(link<<2))&0x7ffc)); // Find sprite\r
\r
      // parse sprite info\r
      code2 = sprite[1];\r
      sx = (code2>>16)&0x1ff;\r
      sx -= 0x78; // Get X coordinate + 8\r
      sy = (pack << 16) >> 16;\r
      height = (pack >> 24) & 0xf;\r
\r
      if (sy < max_lines && sy + (height<<3) > DrawScanline && // sprite onscreen (y)?\r
          (sx > -24 || sx < max_width))                   // onscreen x\r
      {\r
        int y = (sy >= DrawScanline) ? sy : DrawScanline;\r
        int entry = ((pd - HighPreSpr) / 2) | ((code2>>8)&0x80);\r
        for (; y < sy + (height<<3) && y < max_lines; y++)\r
        {\r
          int i, cnt;\r
          cnt = HighLnSpr[y][0] & 0x7f;\r
          if (cnt >= max_line_sprites) continue;              // sprite limit?\r
\r
          for (i = 0; i < cnt; i++)\r
            if (((HighLnSpr[y][3+i] ^ entry) & 0x7f) == 0) goto found;\r
\r
          // this sprite was previously missing\r
          HighLnSpr[y][3+cnt] = entry;\r
          HighLnSpr[y][0] = cnt + 1;\r
found:;\r
          if (entry & 0x80)\r
               HighLnSpr[y][1] |= SPRL_HAVE_HI;\r
          else HighLnSpr[y][1] |= SPRL_HAVE_LO;\r
        }\r
      }\r
\r
      code2 &= ~0xfe000000;\r
      code2 -=  0x00780000; // Get X coordinate + 8 in upper 16 bits\r
      pd[1] = code2;\r
\r
      // Find next sprite\r
      link=(sprite[0]>>16)&0x7f;\r
      if (!link) break; // End of sprites\r
    }\r
  }\r
  else\r
  {\r
    for (u = 0; u < max_lines; u++)\r
      *((int *)&HighLnSpr[u][0]) = 0;\r
\r
    for (u = 0; u < max_sprites; u++)\r
    {\r
      unsigned int *sprite;\r
      int code, code2, sx, sy, hv, height, width;\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
      width  = (hv>>2)+1;\r
      code2 = sprite[1];\r
      sx = (code2>>16)&0x1ff;\r
      sx -= 0x78; // Get X coordinate + 8\r
\r
      if (sy < max_lines && sy + (height<<3) > DrawScanline) // sprite onscreen (y)?\r
      {\r
        int entry, y, sx_min, onscr_x, maybe_op = 0;\r
\r
        sx_min = 8-(width<<3);\r
        onscr_x = sx_min < sx && sx < max_width;\r
        if (sh && (code2 & 0x6000) == 0x6000)\r
          maybe_op = SPRL_MAY_HAVE_OP;\r
\r
        entry = ((pd - HighPreSpr) / 2) | ((code2>>8)&0x80);\r
        y = (sy >= DrawScanline) ? sy : DrawScanline;\r
        for (; y < sy + (height<<3) && y < max_lines; y++)\r
        {\r
	  unsigned char *p = &HighLnSpr[y][0];\r
          int cnt = p[0];\r
          if (cnt >= max_line_sprites) continue;              // sprite limit?\r
\r
          if (p[2] >= max_line_sprites*2) {        // tile limit?\r
            p[0] |= 0x80;\r
            continue;\r
          }\r
          p[2] += width;\r
\r
          if (sx == -0x78) {\r
            if (cnt > 0)\r
              p[0] |= 0x80; // masked, no more sprites for this line\r
            continue;\r
          }\r
          // must keep the first sprite even if it's offscreen, for masking\r
          if (cnt > 0 && !onscr_x) continue; // offscreen x\r
\r
          p[3+cnt] = entry;\r
          p[0] = cnt + 1;\r
          p[1] |= (entry & 0x80) ? SPRL_HAVE_HI : SPRL_HAVE_LO;\r
          p[1] |= maybe_op; // there might be op sprites on this line\r
          if (cnt > 0 && (code2 & 0x8000) && !(p[3+cnt-1]&0x80))\r
            p[1] |= SPRL_LO_ABOVE_HI;\r
        }\r
      }\r
\r
      *pd++ = (width<<28)|(height<<24)|(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
    *pd = 0;\r
\r
#if 0\r
    for (u = 0; u < max_lines; u++)\r
    {\r
      int y;\r
      printf("c%03i: %2i, %2i: ", u, HighLnSpr[u][0] & 0x7f, HighLnSpr[u][2]);\r
      for (y = 0; y < HighLnSpr[u][0] & 0x7f; y++)\r
        printf(" %i", HighLnSpr[u][y+3]);\r
      printf("\n");\r
    }\r
#endif\r
  }\r
}\r
\r
#ifndef _ASM_DRAW_C\r
static void DrawAllSprites(unsigned char *sprited, int prio, int sh)\r
{\r
  int rs = rendstatus;\r
  unsigned char *p;\r
  int cnt;\r
\r
  if (rs & (PDRAW_SPRITES_MOVED|PDRAW_DIRTY_SPRITES)) {\r
    //elprintf(EL_STATUS, "PrepareSprites(%i)", (rs>>4)&1);\r
    PrepareSprites(rs & PDRAW_DIRTY_SPRITES);\r
    rendstatus = rs & ~(PDRAW_SPRITES_MOVED|PDRAW_DIRTY_SPRITES);\r
  }\r
\r
  cnt = sprited[0] & 0x7f;\r
  if (cnt == 0) return;\r
\r
  p = &sprited[3];\r
\r
  // Go through sprites backwards:\r
  for (cnt--; cnt >= 0; cnt--)\r
  {\r
    int offs;\r
    if ((p[cnt] >> 7) != prio) continue;\r
    offs = (p[cnt]&0x7f) * 2;\r
    DrawSprite(HighPreSpr + offs, sh);\r
  }\r
}\r
\r
\r
// --------------------------------------------\r
\r
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
void PicoDoHighPal555(int sh)\r
{\r
  unsigned int *spal, *dpal;\r
  unsigned int t, i;\r
\r
  Pico.m.dirtyPal = 0;\r
\r
  spal = (void *)Pico.cram;\r
  dpal = (void *)HighPal;\r
\r
  for (i = 0; i < 0x40 / 2; i++) {\r
    t = spal[i];\r
#ifdef USE_BGR555\r
    t = ((t & 0x000e000e)<< 1) | ((t & 0x00e000e0)<<3) | ((t & 0x0e000e00)<<4);\r
#else\r
    t = ((t & 0x000e000e)<<12) | ((t & 0x00e000e0)<<3) | ((t & 0x0e000e00)>>7);\r
#endif\r
    // treat it like it was 4-bit per channel, since in s/h mode it somewhat is that.\r
    // otherwise intensity difference between this and s/h will be wrong\r
    t |= (t >> 4) & 0x08610861; // 0x18e318e3\r
    dpal[i] = t;\r
  }\r
\r
  // norm: xxx0, sh: 0xxx, hi: 0xxx + 7\r
  if (sh)\r
  {\r
    // shadowed pixels\r
    for (i = 0; i < 0x40 / 2; i++)\r
      dpal[0x40/2 | i] = dpal[0xc0/2 | i] = (dpal[i] >> 1) & 0x738e738e;\r
    // hilighted pixels\r
    for (i = 0; i < 0x40 / 2; i++) {\r
      t = ((dpal[i] >> 1) & 0x738e738e) + 0x738e738e; // 0x7bef7bef;\r
      t |= (t >> 4) & 0x08610861;\r
      dpal[0x80/2 | i] = t;\r
    }\r
  }\r
}\r
\r
#if 0\r
static void FinalizeLineBGR444(int sh, int line)\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_SPR_LO_ON_HI))\r
    mask=0x3f; // accurate sprites\r
\r
  for(i = 0; i < len; i++)\r
    pd[i] = pal[ps[i] & mask];\r
}\r
#endif\r
\r
\r
void FinalizeLine555(int sh, int line)\r
{\r
  unsigned short *pd=DrawLineDest;\r
  unsigned char  *ps=HighCol+8;\r
  unsigned short *pal=HighPal;\r
  int len;\r
\r
  if (Pico.m.dirtyPal)\r
    PicoDoHighPal555(sh);\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 i, mask=0xff;\r
    if (!sh && (rendstatus & PDRAW_SPR_LO_ON_HI))\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_SPR_LO_ON_HI))\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, int line)\r
{\r
  unsigned char *pd = DrawLineDest;\r
  int len, rs = rendstatus;\r
  static int dirty_count;\r
\r
  if (!sh && Pico.m.dirtyPal == 1)\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))\r
      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, int line);\r
\r
// --------------------------------------------\r
\r
static int DrawDisplay(int sh)\r
{\r
  unsigned char *sprited = &HighLnSpr[DrawScanline][0];\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
  {\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
  /* - layer B low - */\r
  if (PicoDrawMask & PDRAW_LAYERB_ON)\r
    DrawLayer(1|(sh<<1), HighCacheB, 0, maxcells);\r
  /* - layer A low - */\r
  if (!(PicoDrawMask & PDRAW_LAYERA_ON));\r
  else if (hvwind == 1)\r
    DrawWindow(0, maxcells>>1, 0, sh);\r
  else if (hvwind == 2) {\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
  /* - sprites low - */\r
  if (!(PicoDrawMask & PDRAW_SPRITES_LOW_ON));\r
  else if (rendstatus & PDRAW_INTERLACE)\r
    DrawAllSpritesInterlace(0, sh);\r
  else if (sprited[1] & SPRL_HAVE_LO)\r
    DrawAllSprites(sprited, 0, sh);\r
\r
  /* - layer B hi - */\r
  if ((PicoDrawMask & PDRAW_LAYERB_ON) && HighCacheB[0])\r
    DrawTilesFromCache(HighCacheB, sh, maxw);\r
  /* - layer A hi - */\r
  if (!(PicoDrawMask & PDRAW_LAYERA_ON));\r
  else 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 : maxw);\r
    DrawWindow((win&0x80) ? edge : 0, (win&0x80) ? maxcells>>1 : edge, 1, sh);\r
  } else\r
    if (HighCacheA[0]) DrawTilesFromCache(HighCacheA, sh, maxw);\r
  /* - sprites hi - */\r
  if (!(PicoDrawMask & PDRAW_SPRITES_HI_ON));\r
  else if (rendstatus & PDRAW_INTERLACE)\r
    DrawAllSpritesInterlace(1, sh);\r
  // have sprites without layer pri bit ontop of sprites with that bit\r
  else if ((sprited[1] & 0xd0) == 0xd0 && (PicoOpt & POPT_ACC_SPRITES))\r
    DrawSpritesHiAS(sprited, sh);\r
  else if (sh && (sprited[1] & SPRL_MAY_HAVE_OP))\r
    DrawSpritesSHi(sprited);\r
  else if (sprited[1] & SPRL_HAVE_HI)\r
    DrawAllSprites(sprited, 1, 0);\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
// MUST be called every frame\r
PICO_INTERNAL void PicoFrameStart(void)\r
{\r
  int offs = 8, lines = 224;\r
\r
  // prepare to do this frame\r
  rendstatus = 0;\r
  if ((Pico.video.reg[12] & 6) == 6)\r
    rendstatus |= PDRAW_INTERLACE; // interlace mode\r
  if (!(Pico.video.reg[12] & 1))\r
    rendstatus |= PDRAW_32_COLS;\r
  if (Pico.video.reg[1] & 8) {\r
    offs = 0;\r
    lines = 240;\r
  }\r
\r
  HighCol = HighColBase + offs * HighColIncrement;\r
  DrawLineDest = (char *)DrawLineDestBase + offs * DrawLineDestIncrement;\r
  DrawScanline = 0;\r
  skip_next_line = 0;\r
\r
  if (rendstatus != rendstatus_old || lines != rendlines) {\r
    rendlines = lines;\r
    // mode_change() might reset rendstatus_old by calling SetColorFormat\r
    emu_video_mode_change((lines == 240) ? 0 : 8,\r
      lines, (Pico.video.reg[12] & 1) ? 0 : 1);\r
    rendstatus_old = rendstatus;\r
  }\r
\r
  if (PicoOpt & POPT_ALT_RENDERER)\r
    return;\r
\r
  if (Pico.m.dirtyPal)\r
    Pico.m.dirtyPal = 2; // reset dirty if needed\r
  PrepareSprites(1);\r
}\r
\r
static void DrawBlankedLine(int line, int offs, int sh, int bgc)\r
{\r
  if (PicoScanBegin != NULL)\r
    PicoScanBegin(line + offs);\r
\r
  BackFill(bgc, sh);\r
\r
  if (FinalizeLine != NULL)\r
    FinalizeLine(sh, line);\r
\r
  if (PicoScanEnd != NULL)\r
    PicoScanEnd(line + offs);\r
}\r
\r
static void PicoLine(int line, int offs, int sh, int bgc)\r
{\r
  int skip = 0;\r
\r
  if (skip_next_line > 0) {\r
    skip_next_line--;\r
    return;\r
  }\r
\r
  DrawScanline = line;\r
  if (PicoScanBegin != NULL)\r
    skip = PicoScanBegin(line + offs);\r
\r
  if (skip) {\r
    skip_next_line = skip - 1;\r
    return;\r
  }\r
\r
  // Draw screen:\r
  BackFill(bgc, sh);\r
  if (Pico.video.reg[1]&0x40)\r
    DrawDisplay(sh);\r
\r
  if (FinalizeLine != NULL)\r
    FinalizeLine(sh, line);\r
\r
  if (PicoScanEnd != NULL)\r
    skip_next_line = PicoScanEnd(line + offs);\r
\r
  HighCol += HighColIncrement;\r
  DrawLineDest = (char *)DrawLineDest + DrawLineDestIncrement;\r
}\r
\r
void PicoDrawSync(int to, int blank_last_line)\r
{\r
  int line, offs = 0;\r
  int sh = (Pico.video.reg[0xC] & 8) >> 3; // shadow/hilight?\r
  int bgc = Pico.video.reg[7];\r
\r
  pprof_start(draw);\r
\r
  if (rendlines != 240)\r
    offs = 8;\r
\r
  for (line = DrawScanline; line < to; line++)\r
  {\r
#if !CAN_HANDLE_240_LINES\r
    if (line >= 224) break;\r
#endif\r
    PicoLine(line, offs, sh, bgc);\r
  }\r
\r
#if !CAN_HANDLE_240_LINES\r
  if (line >= 224) {\r
    DrawScanline = 240;\r
    return;\r
  }\r
#endif\r
\r
  // last line\r
  if (line <= to)\r
  {\r
    if (blank_last_line)\r
         DrawBlankedLine(line, offs, sh, bgc);\r
    else PicoLine(line, offs, sh, bgc);\r
    line++;\r
  }\r
  DrawScanline = line;\r
\r
  pprof_end(draw);\r
}\r
\r
// also works for fast renderer\r
void PicoDrawUpdateHighPal(void)\r
{\r
  int sh = (Pico.video.reg[0xC] & 8) >> 3; // shadow/hilight?\r
  if (PicoOpt & POPT_ALT_RENDERER)\r
    sh = 0; // no s/h support\r
\r
  PicoDoHighPal555(sh);\r
  if (rendstatus & PDRAW_SONIC_MODE) {\r
    // FIXME?\r
    memcpy(HighPal + 0x40, HighPal, 0x40*2);\r
    memcpy(HighPal + 0x80, HighPal, 0x40*2);\r
  }\r
}\r
\r
void PicoDrawSetOutFormat(pdso_t which, int allow_32x)\r
{\r
  switch (which)\r
  {\r
    case PDF_8BIT:\r
      FinalizeLine = FinalizeLine8bit;\r
      break;\r
\r
    case PDF_RGB555:\r
      if ((PicoAHW & PAHW_32X) && allow_32x)\r
        FinalizeLine = FinalizeLine32xRGB555;\r
      else\r
        FinalizeLine = FinalizeLine555;\r
      break;\r
\r
    default:\r
      FinalizeLine = NULL;\r
      break;\r
  }\r
  PicoDrawSetOutputMode4(which);\r
  rendstatus_old = -1;\r
}\r
\r
// note: may be called on the middle of frame\r
void PicoDrawSetOutBuf(void *dest, int increment)\r
{\r
  DrawLineDestBase = dest;\r
  DrawLineDestIncrement = increment;\r
  DrawLineDest = DrawLineDestBase + DrawScanline * increment;\r
}\r
\r
void PicoDrawSetInternalBuf(void *dest, int increment)\r
{\r
  if (dest != NULL) {\r
    HighColBase = dest;\r
    HighColIncrement = increment;\r
    HighCol = HighColBase + DrawScanline * increment;\r
  }\r
  else {\r
    HighColBase = DefHighCol;\r
    HighColIncrement = 0;\r
  }\r
}\r
\r