fix operator spr change ARM code bugs
[picodrive.git] / pico / cd / gfx_cd.c
... / ...
CommitLineData
1// This is a direct rewrite of gfx_cd.asm (x86 asm to C).
2// You can even find some x86 register names :)
3// Original code (c) 2002 by Stéphane Dallongeville
4
5// (c) Copyright 2007, Grazvydas "notaz" Ignotas
6
7
8#include "../pico_int.h"
9
10#define _rot_comp Pico_mcd->rot_comp
11
12static const int Table_Rot_Time[] =
13{
14 0x00054000, 0x00048000, 0x00040000, 0x00036000, //; 008-032 ; briefing - sprite
15 0x0002E000, 0x00028000, 0x00024000, 0x00022000, //; 036-064 ; arbre souvent
16 0x00021000, 0x00020000, 0x0001E000, 0x0001B800, //; 068-096 ; map thunderstrike
17 0x00019800, 0x00017A00, 0x00015C00, 0x00013E00, //; 100-128 ; logo défoncé
18
19 0x00012000, 0x00011800, 0x00011000, 0x00010800, //; 132-160 ; briefing - map
20 0x00010000, 0x0000F800, 0x0000F000, 0x0000E800, //; 164-192
21 0x0000E000, 0x0000D800, 0x0000D000, 0x0000C800, //; 196-224
22 0x0000C000, 0x0000B800, 0x0000B000, 0x0000A800, //; 228-256 ; batman visage
23
24 0x0000A000, 0x00009F00, 0x00009E00, 0x00009D00, //; 260-288
25 0x00009C00, 0x00009B00, 0x00009A00, 0x00009900, //; 292-320
26 0x00009800, 0x00009700, 0x00009600, 0x00009500, //; 324-352
27 0x00009400, 0x00009300, 0x00009200, 0x00009100, //; 356-384
28
29 0x00009000, 0x00008F00, 0x00008E00, 0x00008D00, //; 388-416
30 0x00008C00, 0x00008B00, 0x00008A00, 0x00008900, //; 420-448
31 0x00008800, 0x00008700, 0x00008600, 0x00008500, //; 452-476
32 0x00008400, 0x00008300, 0x00008200, 0x00008100, //; 480-512
33};
34
35
36static void gfx_cd_start(void)
37{
38 int upd_len;
39
40 // _rot_comp.XD_Mul = ((_rot_comp.Reg_5C & 0x1f) + 1) * 4; // unused
41 _rot_comp.Function = (_rot_comp.Reg_58 & 7) | (Pico_mcd->s68k_regs[3] & 0x18); // Jmp_Adr
42 // _rot_comp.Buffer_Adr = (_rot_comp.Reg_5E & 0xfff8) << 2; // unused?
43 _rot_comp.YD = (_rot_comp.Reg_60 >> 3) & 7;
44 _rot_comp.Vector_Adr = (_rot_comp.Reg_66 & 0xfffe) << 2;
45
46 upd_len = (_rot_comp.Reg_62 >> 3) & 0x3f;
47 upd_len = Table_Rot_Time[upd_len];
48 _rot_comp.Draw_Speed = _rot_comp.Float_Part = upd_len;
49
50 _rot_comp.Reg_58 |= 0x8000; // Stamp_Size, we start a new GFX operation
51
52 switch (_rot_comp.Reg_58 & 6) // Scr_16?
53 {
54 case 0: // ?
55 _rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xff80) << 2;
56 break;
57 case 2: // .Dot_32
58 _rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xffe0) << 2;
59 break;
60 case 4: // .Scr_16
61 _rot_comp.Stamp_Map_Adr = 0x20000;
62 break;
63 case 6: // .Scr_16_Dot_32
64 _rot_comp.Stamp_Map_Adr = (_rot_comp.Reg_5A & 0xe000) << 2;
65 break;
66 }
67
68 dprintf("gfx_cd_start, stamp_map_addr=%06x", _rot_comp.Stamp_Map_Adr);
69
70 gfx_cd_update();
71}
72
73
74static void gfx_completed(void)
75{
76 _rot_comp.Reg_58 &= 0x7fff; // Stamp_Size
77 _rot_comp.Reg_64 = 0;
78 if (Pico_mcd->s68k_regs[0x33] & (1<<1))
79 {
80 elprintf(EL_INTS, "gfx_cd irq 1");
81 SekInterruptS68k(1);
82 }
83}
84
85
86static void gfx_do(unsigned int func, unsigned short *stamp_base, unsigned int H_Dot)
87{
88 unsigned int eax, ebx, ecx, edx, esi, edi, pixel;
89 unsigned int XD, Buffer_Adr;
90 int DYXS;
91
92 XD = _rot_comp.Reg_60 & 7;
93 Buffer_Adr = ((_rot_comp.Reg_5E & 0xfff8) + _rot_comp.YD) << 2;
94 ecx = *(unsigned int *)(Pico_mcd->word_ram2M + _rot_comp.Vector_Adr);
95 edx = ecx >> 16;
96 ecx = (ecx & 0xffff) << 8;
97 edx <<= 8;
98 DYXS = *(int *)(Pico_mcd->word_ram2M + _rot_comp.Vector_Adr + 4);
99 _rot_comp.Vector_Adr += 8;
100
101 // MAKE_IMAGE_LINE
102 while (H_Dot)
103 {
104 // MAKE_IMAGE_PIXEL
105 if (!(func & 1)) // NOT TILED
106 {
107 int mask = (func & 4) ? 0x00800000 : 0x00f80000;
108 if ((ecx | edx) & mask)
109 {
110 if (func & 0x18) goto Next_Pixel;
111 pixel = 0;
112 goto Pixel_Out;
113 }
114 }
115
116 if (func & 2) // mode 32x32 dot
117 {
118 if (func & 4) // 16x16 screen
119 {
120 ebx = ((ecx >> (11+5)) & 0x007f) |
121 ((edx >> (11-2)) & 0x3f80);
122 }
123 else // 1x1 screen
124 {
125 ebx = ((ecx >> (11+5)) & 0x07) |
126 ((edx >> (11+2)) & 0x38);
127 }
128 }
129 else // mode 16x16 dot
130 {
131 if (func & 4) // 16x16 screen
132 {
133 ebx = ((ecx >> (11+4)) & 0x00ff) |
134 ((edx >> (11-4)) & 0xff00);
135 }
136 else // 1x1 screen
137 {
138 ebx = ((ecx >> (11+4)) & 0x0f) |
139 ((edx >> (11+0)) & 0xf0);
140 }
141 }
142
143 edi = stamp_base[ebx];
144 esi = (edi & 0x7ff) << 7;
145 if (!esi) { pixel = 0; goto Pixel_Out; }
146 edi >>= (11+1);
147 edi &= (0x1c>>1);
148 eax = ecx;
149 ebx = edx;
150 if (func & 2) edi |= 1; // 32 dots?
151 switch (edi)
152 {
153 case 0x00: // No_Flip_0, 16x16 dots
154 ebx = (ebx >> 9) & 0x3c;
155 ebx += esi;
156 edi = (eax & 0x3800) ^ 0x1000; // bswap
157 eax = ((eax >> 8) & 0x40) + ebx;
158 break;
159 case 0x01: // No_Flip_0, 32x32 dots
160 ebx = (ebx >> 9) & 0x7c;
161 ebx += esi;
162 edi = (eax & 0x3800) ^ 0x1000; // bswap
163 eax = ((eax >> 7) & 0x180) + ebx;
164 break;
165 case 0x02: // No_Flip_90, 16x16 dots
166 eax = (eax >> 9) & 0x3c;
167 eax += esi;
168 edi = (ebx & 0x3800) ^ 0x2800; // bswap
169 eax += ((ebx >> 8) & 0x40) ^ 0x40;
170 break;
171 case 0x03: // No_Flip_90, 32x32 dots
172 eax = (eax >> 9) & 0x7c;
173 eax += esi;
174 edi = (ebx & 0x3800) ^ 0x2800; // bswap
175 eax += ((ebx >> 7) & 0x180) ^ 0x180;
176 break;
177 case 0x04: // No_Flip_180, 16x16 dots
178 ebx = ((ebx >> 9) & 0x3c) ^ 0x3c;
179 ebx += esi;
180 edi = (eax & 0x3800) ^ 0x2800; // bswap and flip
181 eax = (((eax >> 8) & 0x40) ^ 0x40) + ebx;
182 break;
183 case 0x05: // No_Flip_180, 32x32 dots
184 ebx = ((ebx >> 9) & 0x7c) ^ 0x7c;
185 ebx += esi;
186 edi = (eax & 0x3800) ^ 0x2800; // bswap and flip
187 eax = (((eax >> 7) & 0x180) ^ 0x180) + ebx;
188 break;
189 case 0x06: // No_Flip_270, 16x16 dots
190 eax = ((eax >> 9) & 0x3c) ^ 0x3c;
191 eax += esi;
192 edi = (ebx & 0x3800) ^ 0x1000; // bswap
193 eax += (ebx >> 8) & 0x40;
194 break;
195 case 0x07: // No_Flip_270, 32x32 dots
196 eax = ((eax >> 9) & 0x7c) ^ 0x7c;
197 eax += esi;
198 edi = (ebx & 0x3800) ^ 0x1000; // bswap
199 eax += (ebx >> 7) & 0x180;
200 break;
201 case 0x08: // Flip_0, 16x16 dots
202 ebx = (ebx >> 9) & 0x3c;
203 ebx += esi;
204 edi = (eax & 0x3800) ^ 0x2800; // bswap, flip
205 eax = (((eax >> 8) & 0x40) ^ 0x40) + ebx;
206 break;
207 case 0x09: // Flip_0, 32x32 dots
208 ebx = (ebx >> 9) & 0x7c;
209 ebx += esi;
210 edi = (eax & 0x3800) ^ 0x2800; // bswap, flip
211 eax = (((eax >> 7) & 0x180) ^ 0x180) + ebx;
212 break;
213 case 0x0a: // Flip_90, 16x16 dots
214 eax = ((eax >> 9) & 0x3c) ^ 0x3c;
215 eax += esi;
216 edi = (ebx & 0x3800) ^ 0x2800; // bswap, flip
217 eax += ((ebx >> 8) & 0x40) ^ 0x40;
218 break;
219 case 0x0b: // Flip_90, 32x32 dots
220 eax = ((eax >> 9) & 0x7c) ^ 0x7c;
221 eax += esi;
222 edi = (ebx & 0x3800) ^ 0x2800; // bswap, flip
223 eax += ((ebx >> 7) & 0x180) ^ 0x180;
224 break;
225 case 0x0c: // Flip_180, 16x16 dots
226 ebx = ((ebx >> 9) & 0x3c) ^ 0x3c;
227 ebx += esi;
228 edi = (eax & 0x3800) ^ 0x1000; // bswap
229 eax = ((eax >> 8) & 0x40) + ebx;
230 break;
231 case 0x0d: // Flip_180, 32x32 dots
232 ebx = ((ebx >> 9) & 0x7c) ^ 0x7c;
233 ebx += esi;
234 edi = (eax & 0x3800) ^ 0x1000; // bswap
235 eax = ((eax >> 7) & 0x180) + ebx;
236 break;
237 case 0x0e: // Flip_270, 16x16 dots
238 eax = (eax >> 9) & 0x3c;
239 eax += esi;
240 edi = (ebx & 0x3800) ^ 0x1000; // bswap, flip
241 eax += (ebx >> 8) & 0x40;
242 break;
243 case 0x0f: // Flip_270, 32x32 dots
244 eax = (eax >> 9) & 0x7c;
245 eax += esi;
246 edi = (ebx & 0x3800) ^ 0x1000; // bswap, flip
247 eax += (ebx >> 7) & 0x180;
248 break;
249 }
250
251 pixel = *(Pico_mcd->word_ram2M + (edi >> 12) + eax);
252 if (!(edi & 0x800)) pixel >>= 4;
253 else pixel &= 0x0f;
254
255Pixel_Out:
256 if (!pixel && (func & 0x18)) goto Next_Pixel;
257 esi = Buffer_Adr + ((XD>>1)^1); // pixel addr
258 eax = *(Pico_mcd->word_ram2M + esi); // old pixel
259 if (XD & 1)
260 {
261 if ((eax & 0x0f) && (func & 0x18) == 0x08) goto Next_Pixel; // underwrite
262 *(Pico_mcd->word_ram2M + esi) = pixel | (eax & 0xf0);
263 }
264 else
265 {
266 if ((eax & 0xf0) && (func & 0x18) == 0x08) goto Next_Pixel; // underwrite
267 *(Pico_mcd->word_ram2M + esi) = (pixel << 4) | (eax & 0xf);
268 }
269
270
271Next_Pixel:
272 ecx += (DYXS << 16) >> 16; // _rot_comp.DXS;
273 edx += DYXS >> 16; // _rot_comp.DYS;
274 XD++;
275 if (XD >= 8)
276 {
277 Buffer_Adr += ((_rot_comp.Reg_5C & 0x1f) + 1) << 5;
278 XD = 0;
279 }
280 H_Dot--;
281 }
282 // end while
283
284
285// nothing_to_draw:
286 _rot_comp.YD++;
287 // _rot_comp.V_Dot--; // will be done by caller
288}
289
290
291PICO_INTERNAL void gfx_cd_update(void)
292{
293 int V_Dot = _rot_comp.Reg_64 & 0xff;
294 int jobs;
295
296 dprintf("gfx_cd_update, Reg_64 = %04x", _rot_comp.Reg_64);
297
298 if (!V_Dot)
299 {
300 gfx_completed();
301 return;
302 }
303
304 jobs = _rot_comp.Float_Part >> 16;
305
306 if (!jobs)
307 {
308 _rot_comp.Float_Part += _rot_comp.Draw_Speed;
309 return;
310 }
311
312 _rot_comp.Float_Part &= 0xffff;
313 _rot_comp.Float_Part += _rot_comp.Draw_Speed;
314
315 if (PicoOpt & POPT_EN_MCD_GFX)
316 {
317 unsigned int func = _rot_comp.Function;
318 unsigned int H_Dot = _rot_comp.Reg_62 & 0x1ff;
319 unsigned short *stamp_base = (unsigned short *) (Pico_mcd->word_ram2M + _rot_comp.Stamp_Map_Adr);
320
321 while (jobs--)
322 {
323 gfx_do(func, stamp_base, H_Dot); // jmp [Jmp_Adr]:
324
325 V_Dot--; // dec byte [V_Dot]
326 if (V_Dot == 0)
327 {
328 // GFX_Completed:
329 gfx_completed();
330 return;
331 }
332 }
333 }
334 else
335 {
336 if (jobs >= V_Dot)
337 {
338 gfx_completed();
339 return;
340 }
341 V_Dot -= jobs;
342 }
343
344 _rot_comp.Reg_64 = V_Dot;
345}
346
347
348PICO_INTERNAL_ASM unsigned int gfx_cd_read(unsigned int a)
349{
350 unsigned int d = 0;
351
352 switch (a) {
353 case 0x58: d = _rot_comp.Reg_58; break;
354 case 0x5A: d = _rot_comp.Reg_5A; break;
355 case 0x5C: d = _rot_comp.Reg_5C; break;
356 case 0x5E: d = _rot_comp.Reg_5E; break;
357 case 0x60: d = _rot_comp.Reg_60; break;
358 case 0x62: d = _rot_comp.Reg_62; break;
359 case 0x64: d = _rot_comp.Reg_64; break;
360 case 0x66: break;
361 default: dprintf("gfx_cd_read FIXME: unexpected address: %02x", a); break;
362 }
363
364 dprintf("gfx_cd_read(%02x) = %04x", a, d);
365
366 return d;
367}
368
369PICO_INTERNAL_ASM void gfx_cd_write16(unsigned int a, unsigned int d)
370{
371 dprintf("gfx_cd_write16(%x, %04x)", a, d);
372
373 switch (a) {
374 case 0x58: // .Reg_Stamp_Size
375 _rot_comp.Reg_58 = d & 7;
376 return;
377
378 case 0x5A: // .Reg_Stamp_Adr
379 _rot_comp.Reg_5A = d & 0xffe0;
380 return;
381
382 case 0x5C: // .Reg_IM_VCell_Size
383 _rot_comp.Reg_5C = d & 0x1f;
384 return;
385
386 case 0x5E: // .Reg_IM_Adr
387 _rot_comp.Reg_5E = d & 0xFFF8;
388 return;
389
390 case 0x60: // .Reg_IM_Offset
391 _rot_comp.Reg_60 = d & 0x3f;
392 return;
393
394 case 0x62: // .Reg_IM_HDot_Size
395 _rot_comp.Reg_62 = d & 0x1ff;
396 return;
397
398 case 0x64: // .Reg_IM_VDot_Size
399 _rot_comp.Reg_64 = d & 0xff; // V_Dot, must be 32bit?
400 return;
401
402 case 0x66: // .Reg_Vector_Adr
403 _rot_comp.Reg_66 = d & 0xfffe;
404 if (Pico_mcd->s68k_regs[3]&4) return; // can't do tanformations in 1M mode
405 gfx_cd_start();
406 return;
407
408 default: dprintf("gfx_cd_write16 FIXME: unexpected address: %02x", a); return;
409 }
410}
411
412
413PICO_INTERNAL void gfx_cd_reset(void)
414{
415 memset(&_rot_comp.Reg_58, 0, sizeof(_rot_comp));
416}
417
418
419// --------------------------------
420
421#include "cell_map.c"
422
423#ifndef UTYPES_DEFINED
424typedef unsigned short u16;
425#endif
426
427// check: Heart of the alien, jaguar xj 220
428PICO_INTERNAL void DmaSlowCell(unsigned int source, unsigned int a, int len, unsigned char inc)
429{
430 unsigned char *base;
431 unsigned int asrc, a2;
432 u16 *r;
433
434 base = Pico_mcd->word_ram1M[Pico_mcd->s68k_regs[3]&1];
435
436 switch (Pico.video.type)
437 {
438 case 1: // vram
439 r = Pico.vram;
440 for(; len; len--)
441 {
442 asrc = cell_map(source >> 2) << 2;
443 asrc |= source & 2;
444 // if(a&1) d=(d<<8)|(d>>8); // ??
445 r[a>>1] = *(u16 *)(base + asrc);
446 source += 2;
447 // AutoIncrement
448 a=(u16)(a+inc);
449 }
450 rendstatus |= PDRAW_SPRITES_MOVED;
451 break;
452
453 case 3: // cram
454 Pico.m.dirtyPal = 1;
455 r = Pico.cram;
456 for(a2=a&0x7f; len; len--)
457 {
458 asrc = cell_map(source >> 2) << 2;
459 asrc |= source & 2;
460 r[a2>>1] = *(u16 *)(base + asrc);
461 source += 2;
462 // AutoIncrement
463 a2+=inc;
464 // good dest?
465 if(a2 >= 0x80) break;
466 }
467 a=(a&0xff00)|a2;
468 break;
469
470 case 5: // vsram[a&0x003f]=d;
471 r = Pico.vsram;
472 for(a2=a&0x7f; len; len--)
473 {
474 asrc = cell_map(source >> 2) << 2;
475 asrc |= source & 2;
476 r[a2>>1] = *(u16 *)(base + asrc);
477 source += 2;
478 // AutoIncrement
479 a2+=inc;
480 // good dest?
481 if(a2 >= 0x80) break;
482 }
483 a=(a&0xff00)|a2;
484 break;
485 }
486 // remember addr
487 Pico.video.addr=(u16)a;
488}
489