platform ps2, handle audio similar to psp
[picodrive.git] / cd / gfx_cd.c
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
12 static 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
36 static 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
74 static 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
86 static 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
255 Pixel_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
271 Next_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
291 PICO_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
348 PICO_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
369 PICO_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
413 PICO_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
424 typedef unsigned short u16;
425 #endif
426
427 // check: Heart of the alien, jaguar xj 220
428 PICO_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