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; \ |
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 | |
974fdb5b |
85 | void FinalizeLine32xRGB555(int sh, int line) |
86 | { |
87 | unsigned short *pd = DrawLineDest; |
88 | unsigned short *pal = Pico32xMem->pal_native; |
5a681086 |
89 | unsigned char *pmd = HighCol + 8; |
90 | unsigned short *dram, *p32x; |
91 | unsigned char mdbg; |
974fdb5b |
92 | |
5a681086 |
93 | FinalizeLine555(sh, line); |
c987bb5c |
94 | |
5a681086 |
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 | { |
5e49c3a8 |
100 | return; |
5a681086 |
101 | } |
5e49c3a8 |
102 | |
266c6afa |
103 | dram = (void *)Pico32xMem->dram[Pico32x.vdp_regs[0x0a/2] & P32XV_FS]; |
5a681086 |
104 | p32x = dram + dram[line]; |
105 | mdbg = Pico.video.reg[7] & 0x3f; |
266c6afa |
106 | |
107 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 2) { // Direct Color Mode |
5a681086 |
108 | int inv_bit = (Pico32x.vdp_regs[0] & P32XV_PRI) ? 0x8000 : 0; |
109 | do_line_dc(pd, p32x, pmd, inv_bit,); |
266c6afa |
110 | return; |
111 | } |
112 | |
974fdb5b |
113 | if (Pico32x.dirty_pal) |
5e49c3a8 |
114 | convert_pal555(Pico32x.vdp_regs[0] & P32XV_PRI); |
974fdb5b |
115 | |
266c6afa |
116 | if ((Pico32x.vdp_regs[0] & P32XV_Mx) == 1) { // Packed Pixel Mode |
5a681086 |
117 | do_line_pp(pd, p32x, pmd,); |
974fdb5b |
118 | } |
266c6afa |
119 | else { // Run Length Mode |
5a681086 |
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; |
266c6afa |
274 | } |
974fdb5b |
275 | } |
276 | |