pico/32x/draw.c

   1 #include "../pico_int.h"
   2
   3 int (*PicoScan32xBegin)(unsigned int num);
   4 int (*PicoScan32xEnd)(unsigned int num);
   5 int Pico32xDrawMode;
   6
   7 static void convert_pal555(int invert_prio)
   8 {
   9   unsigned int *ps = (void *)Pico32xMem->pal;
  10   unsigned int *pd = (void *)Pico32xMem->pal_native;
  11   unsigned int m1 = 0x001f001f;
  12   unsigned int m2 = 0x03e003e0;
  13   unsigned int m3 = 0xfc00fc00;
  14   unsigned int inv = 0;
  15   int i;
  16
  17   if (invert_prio)
  18     inv = 0x00200020;
  19
  20   // place prio to LS green bit
  21   for (i = 0x100/2; i > 0; i--, ps++, pd++) {
  22     unsigned int t = *ps;
  23     *pd = (((t & m1) << 11) | ((t & m2) << 1) | ((t & m3) >> 10)) ^ inv;
  24   }
  25
  26   Pico32x.dirty_pal = 0;
  27 }
  28
  29 // direct color mode
  30 #define do_line_dc(pd, p32x, pmd, inv, pmd_draw_code)             \
  31 {                                                                 \
  32   const unsigned int m1 = 0x001f;                                 \
  33   const unsigned int m2 = 0x03e0;                                 \
  34   const unsigned int m3 = 0x7c00;                                 \
  35   int i;                                                          \
  36                                                                   \
  37   for (i = 320; i > 0; i--, pd++, p32x++, pmd++) {                \
  38     unsigned short t = *p32x;                                     \
  39     if (*pmd != mdbg && !((t ^ inv) & 0x8000)) {                  \
  40       pmd_draw_code;                                              \
  41       continue;                                                   \
  42     }                                                             \
  43                                                                   \
  44     *pd = ((t & m1) << 11) | ((t & m2) << 1) | ((t & m3) >> 10);  \
  45   }                                                               \
  46 }
  47
  48 // packed pixel mode
  49 #define do_line_pp(pd, p32x, pmd, pmd_draw_code)                  \
  50 {                                                                 \
  51   unsigned short t;                                               \
  52   int i;                                                          \
  53   for (i = 320/2; i > 0; i--, p32x++) {                           \
  54     t = pal[*p32x >> 8];                                          \
  55     if (*pmd == mdbg || (t & 0x20))                               \
  56       *pd = t;                                                    \
  57     else                                                          \
  58       pmd_draw_code;                                              \
  59     pd++; pmd++;                                                  \
  60     t = pal[*p32x & 0xff];                                        \
  61     if (*pmd == mdbg || (t & 0x20))                               \
  62       *pd = t;                                                    \
  63     else                                                          \
  64       pmd_draw_code;                                              \
  65     pd++; pmd++;                                                  \
  66   }                                                               \
  67 }
  68
  69 // run length mode
  70 #define do_line_rl(pd, p32x, pmd, pmd_draw_code)                  \
  71 {                                                                 \
  72   unsigned short len, t;                                          \
  73   int i;                                                          \
  74   for (i = 320; i > 0; p32x++) {                                  \
  75     t = pal[*p32x & 0xff];                                        \
  76     for (len = (*p32x >> 8) + 1; len > 0 && i > 0; len--, i--, pd++, pmd++) { \
  77       if (*pmd == mdbg || (t & 0x20))                             \
  78         *pd = t;                                                  \
  79       else                                                        \
  80         pmd_draw_code;                                            \
  81     }                                                             \
  82   }                                                               \
  83 }
  84
  85 void FinalizeLine32xRGB555(int sh, int line)
  86 {
  87   unsigned short *pd = DrawLineDest;
  88   unsigned short *pal = Pico32xMem->pal_native;
  89   unsigned char  *pmd = HighCol + 8;
  90   unsigned short *dram, *p32x;
  91   unsigned char   mdbg;
  92
  93   FinalizeLine555(sh, line);
  94
  95   if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 0 || // 32x blanking
  96       // XXX: how is 32col mode hadled by real hardware?
  97       !(Pico.video.reg[12] & 1) || // 32col mode
  98       !(PicoDrawMask & PDRAW_32X_ON))
  99   {
 100     return;
 101   }
 102
 103   dram = (void *)Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS];
 104   p32x = dram + dram[line];
 105   mdbg = Pico.video.reg[7] & 0x3f;
 106
 107   if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 2) { // Direct Color Mode
 108     int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0;
 109     do_line_dc(pd, p32x, pmd, inv_bit,);
 110     return;
 111   }
 112
 113   if (Pico32x.dirty_pal)
 114     convert_pal555(Pico32x.vdp_regs[0] & P32XV_PRI);
 115
 116   if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 1) { // Packed Pixel Mode
 117     do_line_pp(pd, p32x, pmd,);
 118   }
 119   else { // Run Length Mode
 120     do_line_rl(pd, p32x, pmd,);
 121   }
 122 }
 123
 124 #define MD_LAYER_CODE \
 125   *dst = palmd[*pmd]
 126
 127 #define PICOSCAN_PRE \
 128   PicoScan32xBegin(l + (lines_offs & 0xff)); \
 129   dst = DrawLineDest; \
 130
 131 #define PICOSCAN_POST \
 132   PicoScan32xEnd(l + (lines_offs & 0xff)); \
 133
 134 #define make_do_loop(name, pre_code, post_code, md_code)        \
 135 /* Direct Color Mode */                                         \
 136 static void do_loop_dc##name(unsigned short *dst,               \
 137     unsigned short *dram, int lines_offs, int mdbg)             \
 138 {                                                               \
 139   int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0; \
 140   unsigned char  *pmd = PicoDraw2FB + 328 * 8 + 8;              \
 141   unsigned short *palmd = HighPal;                              \
 142   unsigned short *p32x;                                         \
 143   int lines = lines_offs >> 16;                                 \
 144   int l;                                                        \
 145   (void)palmd;                                                  \
 146   for (l = 0; l < lines; l++, pmd += 8) {                       \
 147     pre_code;                                                   \
 148     p32x = dram + dram[l];                                      \
 149     do_line_dc(dst, p32x, pmd, inv_bit, md_code);               \
 150     post_code;                                                  \
 151   }                                                             \
 152 }                                                               \
 153                                                                 \
 154 /* Packed Pixel Mode */                                         \
 155 static void do_loop_pp##name(unsigned short *dst,               \
 156     unsigned short *dram, int lines_offs, int mdbg)             \
 157 {                                                               \
 158   unsigned short *pal = Pico32xMem->pal_native;                 \
 159   unsigned char  *pmd = PicoDraw2FB + 328 * 8 + 8;              \
 160   unsigned short *palmd = HighPal;                              \
 161   unsigned short *p32x;                                         \
 162   int lines = lines_offs >> 16;                                 \
 163   int l;                                                        \
 164   (void)palmd;                                                  \
 165   for (l = 0; l < lines; l++, pmd += 8) {                       \
 166     pre_code;                                                   \
 167     p32x = dram + dram[l];                                      \
 168     do_line_pp(dst, p32x, pmd, md_code);                        \
 169     post_code;                                                  \
 170   }                                                             \
 171 }                                                               \
 172                                                                 \
 173 /* Run Length Mode */                                           \
 174 static void do_loop_rl##name(unsigned short *dst,               \
 175     unsigned short *dram, int lines_offs, int mdbg)             \
 176 {                                                               \
 177   unsigned short *pal = Pico32xMem->pal_native;                 \
 178   unsigned char  *pmd = PicoDraw2FB + 328 * 8 + 8;              \
 179   unsigned short *palmd = HighPal;                              \
 180   unsigned short *p32x;                                         \
 181   int lines = lines_offs >> 16;                                 \
 182   int l;                                                        \
 183   (void)palmd;                                                  \
 184   for (l = 0; l < lines; l++, pmd += 8) {                       \
 185     pre_code;                                                   \
 186     p32x = dram + dram[l];                                      \
 187     do_line_rl(dst, p32x, pmd, md_code);                        \
 188     post_code;                                                  \
 189   }                                                             \
 190 }
 191
 192 #ifdef _ASM_32X_DRAW
 193 #undef make_do_loop
 194 #define make_do_loop(name, pre_code, post_code, md_code) \
 195 extern void do_loop_dc##name(unsigned short *dst,        \
 196     unsigned short *dram, int lines_offs, int mdbg);     \
 197 extern void do_loop_pp##name(unsigned short *dst,        \
 198     unsigned short *dram, int lines_offs, int mdbg);     \
 199 extern void do_loop_rl##name(unsigned short *dst,        \
 200     unsigned short *dram, int lines_offs, int mdbg);
 201 #endif
 202
 203 make_do_loop(,,,)
 204 make_do_loop(_md, , , MD_LAYER_CODE)
 205 make_do_loop(_scan, PICOSCAN_PRE, PICOSCAN_POST, )
 206 make_do_loop(_scan_md, PICOSCAN_PRE, PICOSCAN_POST, MD_LAYER_CODE)
 207
 208 typedef void (*do_loop_func)(unsigned short *dst, unsigned short *dram, int lines, int mdbg);
 209 enum { DO_LOOP, DO_LOOP_MD, DO_LOOP_SCAN, DO_LOOP_MD_SCAN };
 210
 211 static const do_loop_func do_loop_dc_f[] = { do_loop_dc, do_loop_dc_md, do_loop_dc_scan, do_loop_dc_scan_md };
 212 static const do_loop_func do_loop_pp_f[] = { do_loop_pp, do_loop_pp_md, do_loop_pp_scan, do_loop_pp_scan_md };
 213 static const do_loop_func do_loop_rl_f[] = { do_loop_rl, do_loop_rl_md, do_loop_rl_scan, do_loop_rl_scan_md };
 214
 215 void PicoDraw32xLayer(int offs, int lines, int md_bg)
 216 {
 217   int have_scan = PicoScan32xBegin != NULL && PicoScan32xEnd != NULL;
 218   const do_loop_func *do_loop;
 219   unsigned short *dram;
 220   int which_func;
 221
 222   DrawLineDest = DrawLineDestBase + offs * DrawLineDestIncrement;
 223   dram = Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS];
 224
 225   if (Pico32xDrawMode == 2) {
 226     if (Pico.m.dirtyPal)
 227       PicoDrawUpdateHighPal();
 228   }
 229
 230   if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 2)
 231   {
 232     // Direct Color Mode
 233     do_loop = do_loop_dc_f;
 234     goto do_it;
 235   }
 236
 237   if (Pico32x.dirty_pal)
 238     convert_pal555(Pico32x.vdp_regs[0] & P32XV_PRI);
 239
 240   if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 1)
 241   {
 242     // Packed Pixel Mode
 243     do_loop = do_loop_pp_f;
 244   }
 245   else
 246   {
 247     // Run Length Mode
 248     do_loop = do_loop_rl_f;
 249   }
 250
 251 do_it:
 252   if (Pico32xDrawMode == 2)
 253     which_func = have_scan ? DO_LOOP_MD_SCAN : DO_LOOP_MD;
 254   else
 255     which_func = have_scan ? DO_LOOP_SCAN : DO_LOOP;
 256
 257   do_loop[which_func](DrawLineDest, dram, (lines << 16) | offs, md_bg);
 258 }
 259
 260 void PicoDraw32xSetFrameMode(int is_on, int only_32x)
 261 {
 262 #ifdef _ASM_32X_DRAW
 263   extern void *Pico32xNativePal;
 264   Pico32xNativePal = Pico32xMem->pal_native;
 265 #endif
 266
 267   if (is_on) {
 268     // use the same layout as alt renderer
 269     PicoDrawSetInternalBuf(PicoDraw2FB + 328*8, 328);
 270     Pico32xDrawMode = only_32x ? 1 : 2;
 271   } else {
 272     PicoDrawSetInternalBuf(NULL, 0);
 273     Pico32xDrawMode = 0;
 274   }
 275 }
 276