974fdb5b |
1 | #include "../pico_int.h" |
2 | |
5a681086 |
3 | int (*PicoScan32xBegin)(unsigned int num); |
4 | int (*PicoScan32xEnd)(unsigned int num); |
5 | int Pico32xDrawMode; |
6 | |
5e49c3a8 |
7 | static void convert_pal555(int invert_prio) |
974fdb5b |
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; |
5e49c3a8 |
14 | unsigned int inv = 0; |
974fdb5b |
15 | int i; |
16 | |
5e49c3a8 |
17 | if (invert_prio) |
18 | inv = 0x00200020; |
19 | |
974fdb5b |
20 | // place prio to LS green bit |
21 | for (i = 0x100/2; i > 0; i--, ps++, pd++) { |
22 | unsigned int t = *ps; |
5e49c3a8 |
23 | *pd = (((t & m1) << 11) | ((t & m2) << 1) | ((t & m3) >> 10)) ^ inv; |
974fdb5b |
24 | } |
25 | |
26 | Pico32x.dirty_pal = 0; |
27 | } |
28 | |
5a681086 |
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; \ |
e51e5983 |
53 | for (i = 320; i > 0; i--, pd++, p32x++, pmd++) { \ |
54 | t = pal[*(unsigned char *)((long)p32x ^ 1)]; \ |
07e5dbab |
55 | if ((t & 0x20) || *pmd == mdbg) \ |
5a681086 |
56 | *pd = t; \ |
57 | else \ |
58 | pmd_draw_code; \ |
5a681086 |
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 | |
974fdb5b |
78 | void FinalizeLine32xRGB555(int sh, int line) |
79 | { |
80 | unsigned short *pd = DrawLineDest; |
81 | unsigned short *pal = Pico32xMem->pal_native; |
5a681086 |
82 | unsigned char *pmd = HighCol + 8; |
83 | unsigned short *dram, *p32x; |
84 | unsigned char mdbg; |
974fdb5b |
85 | |
5a681086 |
86 | FinalizeLine555(sh, line); |
c987bb5c |
87 | |
5a681086 |
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 | { |
5e49c3a8 |
93 | return; |
5a681086 |
94 | } |
5e49c3a8 |
95 | |
266c6afa |
96 | dram = (void *)Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS]; |
5a681086 |
97 | p32x = dram + dram[line]; |
98 | mdbg = Pico.video.reg[7] & 0x3f; |
266c6afa |
99 | |
100 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 2) { // Direct Color Mode |
5a681086 |
101 | int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0; |
102 | do_line_dc(pd, p32x, pmd, inv_bit,); |
266c6afa |
103 | return; |
104 | } |
105 | |
974fdb5b |
106 | if (Pico32x.dirty_pal) |
5e49c3a8 |
107 | convert_pal555(Pico32x.vdp_regs[0] & P32XV_PRI); |
974fdb5b |
108 | |
266c6afa |
109 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 1) { // Packed Pixel Mode |
e51e5983 |
110 | unsigned char *p32xb = (void *)p32x; |
111 | if (Pico32x.vdp_regs[2 / 2] & P32XV_SFT) |
112 | p32xb++; |
113 | do_line_pp(pd, p32xb, pmd,); |
974fdb5b |
114 | } |
266c6afa |
115 | else { // Run Length Mode |
5a681086 |
116 | do_line_rl(pd, p32x, pmd,); |
117 | } |
118 | } |
119 | |
120 | #define MD_LAYER_CODE \ |
121 | *dst = palmd[*pmd] |
122 | |
123 | #define PICOSCAN_PRE \ |
e51e5983 |
124 | PicoScan32xBegin(l + (lines_sft_offs & 0xff)); \ |
5a681086 |
125 | dst = DrawLineDest; \ |
126 | |
127 | #define PICOSCAN_POST \ |
e51e5983 |
128 | PicoScan32xEnd(l + (lines_sft_offs & 0xff)); \ |
5a681086 |
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, \ |
e51e5983 |
133 | unsigned short *dram, int lines_sft_offs, int mdbg) \ |
5a681086 |
134 | { \ |
135 | int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0; \ |
7a961c19 |
136 | unsigned char *pmd = PicoDraw2FB + \ |
137 | 328 * (lines_sft_offs & 0xff) + 8; \ |
5a681086 |
138 | unsigned short *palmd = HighPal; \ |
139 | unsigned short *p32x; \ |
e51e5983 |
140 | int lines = lines_sft_offs >> 16; \ |
5a681086 |
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, \ |
e51e5983 |
153 | unsigned short *dram, int lines_sft_offs, int mdbg) \ |
5a681086 |
154 | { \ |
155 | unsigned short *pal = Pico32xMem->pal_native; \ |
7a961c19 |
156 | unsigned char *pmd = PicoDraw2FB + \ |
157 | 328 * (lines_sft_offs & 0xff) + 8; \ |
5a681086 |
158 | unsigned short *palmd = HighPal; \ |
e51e5983 |
159 | unsigned char *p32x; \ |
160 | int lines = lines_sft_offs >> 16; \ |
5a681086 |
161 | int l; \ |
162 | (void)palmd; \ |
163 | for (l = 0; l < lines; l++, pmd += 8) { \ |
164 | pre_code; \ |
e51e5983 |
165 | p32x = (void *)(dram + dram[l]); \ |
166 | p32x += (lines_sft_offs >> 8) & 1; \ |
5a681086 |
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, \ |
e51e5983 |
174 | unsigned short *dram, int lines_sft_offs, int mdbg) \ |
5a681086 |
175 | { \ |
176 | unsigned short *pal = Pico32xMem->pal_native; \ |
7a961c19 |
177 | unsigned char *pmd = PicoDraw2FB + \ |
178 | 328 * (lines_sft_offs & 0xff) + 8; \ |
5a681086 |
179 | unsigned short *palmd = HighPal; \ |
180 | unsigned short *p32x; \ |
e51e5983 |
181 | int lines = lines_sft_offs >> 16; \ |
5a681086 |
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; |
e51e5983 |
220 | int lines_sft_offs; |
5a681086 |
221 | int which_func; |
222 | |
7a961c19 |
223 | DrawLineDest = (char *)DrawLineDestBase + offs * DrawLineDestIncrement; |
5a681086 |
224 | dram = Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS]; |
225 | |
7a961c19 |
226 | if (Pico32xDrawMode == PDM32X_BOTH) { |
5a681086 |
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: |
7a961c19 |
253 | if (Pico32xDrawMode == PDM32X_BOTH) |
5a681086 |
254 | which_func = have_scan ? DO_LOOP_MD_SCAN : DO_LOOP_MD; |
255 | else |
256 | which_func = have_scan ? DO_LOOP_SCAN : DO_LOOP; |
e51e5983 |
257 | lines_sft_offs = (lines << 16) | offs; |
258 | if (Pico32x.vdp_regs[2 / 2] & P32XV_SFT) |
259 | lines_sft_offs |= 1 << 8; |
5a681086 |
260 | |
e51e5983 |
261 | do_loop[which_func](DrawLineDest, dram, lines_sft_offs, md_bg); |
5a681086 |
262 | } |
263 | |
7a961c19 |
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 | |
5a681086 |
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 |
a2b8c5a5 |
311 | PicoDrawSetInternalBuf(PicoDraw2FB, 328); |
7a961c19 |
312 | Pico32xDrawMode = only_32x ? PDM32X_32X_ONLY : PDM32X_BOTH; |
5a681086 |
313 | } else { |
314 | PicoDrawSetInternalBuf(NULL, 0); |
7a961c19 |
315 | Pico32xDrawMode = PDM32X_OFF; |
266c6afa |
316 | } |
974fdb5b |
317 | } |
318 | |