| 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; i > 0; i--, pd++, p32x++, pmd++) { \ |
| 54 | t = pal[*(unsigned char *)((long)p32x ^ 1)]; \ |
| 55 | if ((t & 0x20) || *pmd == mdbg) \ |
| 56 | *pd = t; \ |
| 57 | else \ |
| 58 | pmd_draw_code; \ |
| 59 | } \ |
| 60 | } |
| 61 | |
| 62 | // run length mode |
| 63 | #define do_line_rl(pd, p32x, pmd, pmd_draw_code) \ |
| 64 | { \ |
| 65 | unsigned short len, t; \ |
| 66 | int i; \ |
| 67 | for (i = 320; i > 0; p32x++) { \ |
| 68 | t = pal[*p32x & 0xff]; \ |
| 69 | for (len = (*p32x >> 8) + 1; len > 0 && i > 0; len--, i--, pd++, pmd++) { \ |
| 70 | if (*pmd == mdbg || (t & 0x20)) \ |
| 71 | *pd = t; \ |
| 72 | else \ |
| 73 | pmd_draw_code; \ |
| 74 | } \ |
| 75 | } \ |
| 76 | } |
| 77 | |
| 78 | void FinalizeLine32xRGB555(int sh, int line) |
| 79 | { |
| 80 | unsigned short *pd = DrawLineDest; |
| 81 | unsigned short *pal = Pico32xMem->pal_native; |
| 82 | unsigned char *pmd = HighCol + 8; |
| 83 | unsigned short *dram, *p32x; |
| 84 | unsigned char mdbg; |
| 85 | |
| 86 | FinalizeLine555(sh, line); |
| 87 | |
| 88 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 0 || // 32x blanking |
| 89 | // XXX: how is 32col mode hadled by real hardware? |
| 90 | !(Pico.video.reg[12] & 1) || // 32col mode |
| 91 | !(PicoDrawMask & PDRAW_32X_ON)) |
| 92 | { |
| 93 | return; |
| 94 | } |
| 95 | |
| 96 | dram = (void *)Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS]; |
| 97 | p32x = dram + dram[line]; |
| 98 | mdbg = Pico.video.reg[7] & 0x3f; |
| 99 | |
| 100 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 2) { // Direct Color Mode |
| 101 | int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0; |
| 102 | do_line_dc(pd, p32x, pmd, inv_bit,); |
| 103 | return; |
| 104 | } |
| 105 | |
| 106 | if (Pico32x.dirty_pal) |
| 107 | convert_pal555(Pico32x.vdp_regs[0] & P32XV_PRI); |
| 108 | |
| 109 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 1) { // Packed Pixel Mode |
| 110 | unsigned char *p32xb = (void *)p32x; |
| 111 | if (Pico32x.vdp_regs[2 / 2] & P32XV_SFT) |
| 112 | p32xb++; |
| 113 | do_line_pp(pd, p32xb, pmd,); |
| 114 | } |
| 115 | else { // Run Length Mode |
| 116 | do_line_rl(pd, p32x, pmd,); |
| 117 | } |
| 118 | } |
| 119 | |
| 120 | #define MD_LAYER_CODE \ |
| 121 | *dst = palmd[*pmd] |
| 122 | |
| 123 | #define PICOSCAN_PRE \ |
| 124 | PicoScan32xBegin(l + (lines_sft_offs & 0xff)); \ |
| 125 | dst = DrawLineDest; \ |
| 126 | |
| 127 | #define PICOSCAN_POST \ |
| 128 | PicoScan32xEnd(l + (lines_sft_offs & 0xff)); \ |
| 129 | |
| 130 | #define make_do_loop(name, pre_code, post_code, md_code) \ |
| 131 | /* Direct Color Mode */ \ |
| 132 | static void do_loop_dc##name(unsigned short *dst, \ |
| 133 | unsigned short *dram, int lines_sft_offs, int mdbg) \ |
| 134 | { \ |
| 135 | int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0; \ |
| 136 | unsigned char *pmd = PicoDraw2FB + \ |
| 137 | 328 * (lines_sft_offs & 0xff) + 8; \ |
| 138 | unsigned short *palmd = HighPal; \ |
| 139 | unsigned short *p32x; \ |
| 140 | int lines = lines_sft_offs >> 16; \ |
| 141 | int l; \ |
| 142 | (void)palmd; \ |
| 143 | for (l = 0; l < lines; l++, pmd += 8) { \ |
| 144 | pre_code; \ |
| 145 | p32x = dram + dram[l]; \ |
| 146 | do_line_dc(dst, p32x, pmd, inv_bit, md_code); \ |
| 147 | post_code; \ |
| 148 | } \ |
| 149 | } \ |
| 150 | \ |
| 151 | /* Packed Pixel Mode */ \ |
| 152 | static void do_loop_pp##name(unsigned short *dst, \ |
| 153 | unsigned short *dram, int lines_sft_offs, int mdbg) \ |
| 154 | { \ |
| 155 | unsigned short *pal = Pico32xMem->pal_native; \ |
| 156 | unsigned char *pmd = PicoDraw2FB + \ |
| 157 | 328 * (lines_sft_offs & 0xff) + 8; \ |
| 158 | unsigned short *palmd = HighPal; \ |
| 159 | unsigned char *p32x; \ |
| 160 | int lines = lines_sft_offs >> 16; \ |
| 161 | int l; \ |
| 162 | (void)palmd; \ |
| 163 | for (l = 0; l < lines; l++, pmd += 8) { \ |
| 164 | pre_code; \ |
| 165 | p32x = (void *)(dram + dram[l]); \ |
| 166 | p32x += (lines_sft_offs >> 8) & 1; \ |
| 167 | do_line_pp(dst, p32x, pmd, md_code); \ |
| 168 | post_code; \ |
| 169 | } \ |
| 170 | } \ |
| 171 | \ |
| 172 | /* Run Length Mode */ \ |
| 173 | static void do_loop_rl##name(unsigned short *dst, \ |
| 174 | unsigned short *dram, int lines_sft_offs, int mdbg) \ |
| 175 | { \ |
| 176 | unsigned short *pal = Pico32xMem->pal_native; \ |
| 177 | unsigned char *pmd = PicoDraw2FB + \ |
| 178 | 328 * (lines_sft_offs & 0xff) + 8; \ |
| 179 | unsigned short *palmd = HighPal; \ |
| 180 | unsigned short *p32x; \ |
| 181 | int lines = lines_sft_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 lines_sft_offs; |
| 221 | int which_func; |
| 222 | |
| 223 | DrawLineDest = (char *)DrawLineDestBase + offs * DrawLineDestIncrement; |
| 224 | dram = Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS]; |
| 225 | |
| 226 | if (Pico32xDrawMode == PDM32X_BOTH) { |
| 227 | if (Pico.m.dirtyPal) |
| 228 | PicoDrawUpdateHighPal(); |
| 229 | } |
| 230 | |
| 231 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 2) |
| 232 | { |
| 233 | // Direct Color Mode |
| 234 | do_loop = do_loop_dc_f; |
| 235 | goto do_it; |
| 236 | } |
| 237 | |
| 238 | if (Pico32x.dirty_pal) |
| 239 | convert_pal555(Pico32x.vdp_regs[0] & P32XV_PRI); |
| 240 | |
| 241 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 1) |
| 242 | { |
| 243 | // Packed Pixel Mode |
| 244 | do_loop = do_loop_pp_f; |
| 245 | } |
| 246 | else |
| 247 | { |
| 248 | // Run Length Mode |
| 249 | do_loop = do_loop_rl_f; |
| 250 | } |
| 251 | |
| 252 | do_it: |
| 253 | if (Pico32xDrawMode == PDM32X_BOTH) |
| 254 | which_func = have_scan ? DO_LOOP_MD_SCAN : DO_LOOP_MD; |
| 255 | else |
| 256 | which_func = have_scan ? DO_LOOP_SCAN : DO_LOOP; |
| 257 | lines_sft_offs = (lines << 16) | offs; |
| 258 | if (Pico32x.vdp_regs[2 / 2] & P32XV_SFT) |
| 259 | lines_sft_offs |= 1 << 8; |
| 260 | |
| 261 | do_loop[which_func](DrawLineDest, dram, lines_sft_offs, md_bg); |
| 262 | } |
| 263 | |
| 264 | // mostly unused, games tend to keep 32X layer on |
| 265 | void PicoDraw32xLayerMdOnly(int offs, int lines) |
| 266 | { |
| 267 | int have_scan = PicoScan32xBegin != NULL && PicoScan32xEnd != NULL; |
| 268 | unsigned short *dst = (void *)((char *)DrawLineDestBase + offs * DrawLineDestIncrement); |
| 269 | unsigned char *pmd = PicoDraw2FB + 328 * offs + 8; |
| 270 | unsigned short *pal = HighPal; |
| 271 | int poffs = 0, plen = 320; |
| 272 | int l, p; |
| 273 | |
| 274 | if (!(Pico.video.reg[12] & 1)) { |
| 275 | // 32col mode |
| 276 | poffs = 32; |
| 277 | plen = 256; |
| 278 | } |
| 279 | |
| 280 | if (Pico.m.dirtyPal) |
| 281 | PicoDrawUpdateHighPal(); |
| 282 | |
| 283 | dst += poffs; |
| 284 | for (l = 0; l < lines; l++) { |
| 285 | if (have_scan) { |
| 286 | PicoScan32xBegin(l + offs); |
| 287 | dst = DrawLineDest + poffs; |
| 288 | } |
| 289 | for (p = 0; p < plen; p += 4) { |
| 290 | dst[p + 0] = pal[*pmd++]; |
| 291 | dst[p + 1] = pal[*pmd++]; |
| 292 | dst[p + 2] = pal[*pmd++]; |
| 293 | dst[p + 3] = pal[*pmd++]; |
| 294 | } |
| 295 | dst = (void *)((char *)dst + DrawLineDestIncrement); |
| 296 | pmd += 328 - plen; |
| 297 | if (have_scan) |
| 298 | PicoScan32xEnd(l + offs); |
| 299 | } |
| 300 | } |
| 301 | |
| 302 | void PicoDraw32xSetFrameMode(int is_on, int only_32x) |
| 303 | { |
| 304 | #ifdef _ASM_32X_DRAW |
| 305 | extern void *Pico32xNativePal; |
| 306 | Pico32xNativePal = Pico32xMem->pal_native; |
| 307 | #endif |
| 308 | |
| 309 | if (is_on) { |
| 310 | // use the same layout as alt renderer |
| 311 | PicoDrawSetInternalBuf(PicoDraw2FB, 328); |
| 312 | Pico32xDrawMode = only_32x ? PDM32X_32X_ONLY : PDM32X_BOTH; |
| 313 | } else { |
| 314 | PicoDrawSetInternalBuf(NULL, 0); |
| 315 | Pico32xDrawMode = PDM32X_OFF; |
| 316 | } |
| 317 | } |
| 318 | |