1 /***********************************************************
\r
3 * This source is taken from the Gens project *
\r
4 * Written by Stéphane Dallongeville *
\r
5 * Copyright (c) 2002 by Stéphane Dallongeville *
\r
6 * Modified/adapted for Picodrive by notaz, 2007 *
\r
8 ***********************************************************/
\r
10 #include "../PicoInt.h"
\r
12 #define cdprintf dprintf
\r
13 //#define cdprintf(x...)
\r
16 #define CDC_DMA_SPEED 256
\r
18 int CDC_Decode_Reg_Read; // 2 context?
\r
21 static void CDD_Reset(void)
\r
25 memset(Pico_mcd->s68k_regs+0x34, 0, 2*2); // CDD.Fader, CDD.Control
\r
26 Pico_mcd->cdd.Status = 0;
\r
27 Pico_mcd->cdd.Minute = 0;
\r
28 Pico_mcd->cdd.Seconde = 0;
\r
29 Pico_mcd->cdd.Frame = 0;
\r
30 Pico_mcd->cdd.Ext = 0;
\r
32 // clear receive status and transfer command
\r
33 memset(Pico_mcd->s68k_regs+0x38, 0, 20);
\r
34 Pico_mcd->s68k_regs[0x38+9] = 0xF; // Default checksum
\r
38 static void CDC_Reset(void)
\r
42 memset(Pico_mcd->cdc.Buffer, 0, (16 * 1024 * 2) + 2352);
\r
44 CDC_Update_Header();
\r
46 Pico_mcd->cdc.COMIN = 0;
\r
47 Pico_mcd->cdc.IFSTAT = 0xFF;
\r
48 Pico_mcd->cdc.DAC.N = 0;
\r
49 Pico_mcd->cdc.DBC.N = 0;
\r
50 Pico_mcd->cdc.HEAD.N = 0x01000000;
\r
51 Pico_mcd->cdc.PT.N = 0;
\r
52 Pico_mcd->cdc.WA.N = 2352 * 2;
\r
53 Pico_mcd->cdc.STAT.N = 0x00000080;
\r
54 Pico_mcd->cdc.SBOUT = 0;
\r
55 Pico_mcd->cdc.IFCTRL = 0;
\r
56 Pico_mcd->cdc.CTRL.N = 0;
\r
58 CDC_Decode_Reg_Read = 0;
\r
59 Pico_mcd->scd.Status_CDC &= ~0x08;
\r
63 void LC89510_Reset(void)
\r
68 // clear DMA_Adr & Stop_Watch
\r
69 memset(Pico_mcd->s68k_regs + 0xA, 0, 4);
\r
73 void Update_CDC_TRansfer(int which)
\r
75 unsigned int DMA_Adr, dep, length, len;
\r
76 unsigned short *dest;
\r
79 if (Pico_mcd->cdc.DBC.N <= (CDC_DMA_SPEED * 2))
\r
81 length = (Pico_mcd->cdc.DBC.N + 1) >> 1;
\r
82 Pico_mcd->scd.Status_CDC &= ~0x08; // Last transfer
\r
83 Pico_mcd->s68k_regs[4] |= 0x80; // End data transfer
\r
84 Pico_mcd->s68k_regs[4] &= ~0x40; // no more data ready
\r
85 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
87 if (Pico_mcd->cdc.IFCTRL & 0x40) // DTEIEN = Data Trasnfer End Interrupt Enable ?
\r
89 Pico_mcd->cdc.IFSTAT &= ~0x40;
\r
91 if (Pico_mcd->s68k_regs[0x33] & (1<<5))
\r
93 dprintf("cdc DTE irq 5");
\r
94 SekInterruptS68k(5);
\r
98 else length = CDC_DMA_SPEED;
\r
101 // TODO: dst bounds checking? DAC.N alignment?
\r
102 src = Pico_mcd->cdc.Buffer + Pico_mcd->cdc.DAC.N;
\r
103 DMA_Adr = (Pico_mcd->s68k_regs[0xA]<<8) | Pico_mcd->s68k_regs[0xB];
\r
105 if (which == 7) // WORD RAM
\r
107 if (Pico_mcd->s68k_regs[3] & 4)
\r
109 dep = ((DMA_Adr & 0x3FFF) << 3);
\r
110 cdprintf("CD DMA # %04x -> word_ram1M # %06x, len=%i",
\r
111 Pico_mcd->cdc.DAC.N, dep, length);
\r
113 dep = ((DMA_Adr & 0x3FFF) << 4);
\r
114 if (!(Pico_mcd->s68k_regs[3]&1)) dep += 2;
\r
115 dest = (unsigned short *) (Pico_mcd->word_ram + dep);
\r
117 for (len = length; len > 0; len--, src+=2, dest+=2)
\r
118 *dest = (src[0]<<8) | src[1];
\r
122 dep = ((DMA_Adr & 0x7FFF) << 3);
\r
123 cdprintf("CD DMA # %04x -> word_ram2M # %06x, len=%i",
\r
124 Pico_mcd->cdc.DAC.N, dep, length);
\r
125 dest = (unsigned short *) (Pico_mcd->word_ram + dep);
\r
127 for (len = length; len > 0; len--, src+=2, dest++)
\r
128 *dest = (src[0]<<8) | src[1];
\r
131 else if (which == 4) // PCM RAM
\r
134 dest = (unsigned char *) Ram_PCM;
\r
135 dep = ((DMA_Adr & 0x03FF) << 2) + PCM_Chip.Bank;
\r
137 cdprintf("CD DMA # %04x -> PCD TODO", Pico_mcd->cdc.DAC.N);
\r
140 else if (which == 5) // PRG RAM
\r
142 dep = DMA_Adr << 3;
\r
143 dest = (unsigned short *) (Pico_mcd->prg_ram + dep);
\r
144 cdprintf("CD DMA # %04x -> prg_ram # %06x, len=%i",
\r
145 Pico_mcd->cdc.DAC.N, dep, length);
\r
147 for (len = length; len > 0; len--, src+=2, dest++)
\r
148 *dest = (src[0]<<8) | src[1];
\r
152 Pico_mcd->cdc.DAC.N = (Pico_mcd->cdc.DAC.N + length) & 0xFFFF;
\r
153 if (Pico_mcd->scd.Status_CDC & 0x08) Pico_mcd->cdc.DBC.N -= length;
\r
154 else Pico_mcd->cdc.DBC.N = 0;
\r
158 unsigned short Read_CDC_Host(int is_sub)
\r
162 if (!(Pico_mcd->scd.Status_CDC & 0x08))
\r
164 // Transfer data disabled
\r
165 cdprintf("Read_CDC_Host: Transfer data disabled");
\r
169 if ((is_sub && (Pico_mcd->s68k_regs[4] & 7) != 3) ||
\r
170 (!is_sub && (Pico_mcd->s68k_regs[4] & 7) != 2))
\r
173 cdprintf("Read_CDC_Host: Wrong setting");
\r
177 Pico_mcd->cdc.DBC.N -= 2;
\r
179 if (Pico_mcd->cdc.DBC.N <= 0)
\r
181 Pico_mcd->cdc.DBC.N = 0;
\r
182 Pico_mcd->scd.Status_CDC &= ~0x08; // Last transfer
\r
183 Pico_mcd->s68k_regs[4] |= 0x80; // End data transfer
\r
184 Pico_mcd->s68k_regs[4] &= ~0x40; // no more data ready
\r
185 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
187 if (Pico_mcd->cdc.IFCTRL & 0x40) // DTEIEN = Data Transfer End Interrupt Enable ?
\r
189 Pico_mcd->cdc.IFSTAT &= ~0x40;
\r
191 if (Pico_mcd->s68k_regs[0x33]&(1<<5)) {
\r
192 dprintf("m68k: s68k irq 5");
\r
193 SekInterruptS68k(5);
\r
196 cdprintf("CDC - DTE interrupt");
\r
200 addr = Pico_mcd->cdc.DAC.N;
\r
201 Pico_mcd->cdc.DAC.N += 2;
\r
203 cdprintf("Read_CDC_Host sub=%i d=%04x dac=%04x dbc=%04x", is_sub,
\r
204 (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1], Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N);
\r
206 return (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1];
\r
211 mov esi, Pico_mcd->cdc.DAC.N
\r
212 lea ebx, Pico_mcd->cdc.Buffer
\r
214 mov ax, [ebx + esi]
\r
217 mov Pico_mcd->cdc.DAC.N, esi
\r
224 void CDC_Update_Header(void)
\r
226 if (Pico_mcd->cdc.CTRL.B.B1 & 0x01) // Sub-Header wanted ?
\r
228 Pico_mcd->cdc.HEAD.B.B0 = 0;
\r
229 Pico_mcd->cdc.HEAD.B.B1 = 0;
\r
230 Pico_mcd->cdc.HEAD.B.B2 = 0;
\r
231 Pico_mcd->cdc.HEAD.B.B3 = 0;
\r
237 LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);
\r
239 Pico_mcd->cdc.HEAD.B.B0 = INT_TO_BCDB(MSF.M);
\r
240 Pico_mcd->cdc.HEAD.B.B1 = INT_TO_BCDB(MSF.S);
\r
241 Pico_mcd->cdc.HEAD.B.B2 = INT_TO_BCDB(MSF.F);
\r
242 Pico_mcd->cdc.HEAD.B.B3 = 0x01;
\r
247 unsigned char CDC_Read_Reg(void)
\r
251 switch(Pico_mcd->s68k_regs[5] & 0xF)
\r
254 cdprintf("CDC read reg 00 = %.2X", Pico_mcd->cdc.COMIN);
\r
256 Pico_mcd->s68k_regs[5] = 0x1;
\r
257 return Pico_mcd->cdc.COMIN;
\r
259 case 0x1: // IFSTAT
\r
260 cdprintf("CDC read reg 01 = %.2X", Pico_mcd->cdc.IFSTAT);
\r
262 CDC_Decode_Reg_Read |= (1 << 1); // Reg 1 (decoding)
\r
263 Pico_mcd->s68k_regs[5] = 0x2;
\r
264 return Pico_mcd->cdc.IFSTAT;
\r
267 cdprintf("CDC read reg 02 = %.2X", Pico_mcd->cdc.DBC.B.L);
\r
269 Pico_mcd->s68k_regs[5] = 0x3;
\r
270 return Pico_mcd->cdc.DBC.B.L;
\r
273 cdprintf("CDC read reg 03 = %.2X", Pico_mcd->cdc.DBC.B.H);
\r
275 Pico_mcd->s68k_regs[5] = 0x4;
\r
276 return Pico_mcd->cdc.DBC.B.H;
\r
279 cdprintf("CDC read reg 04 = %.2X", Pico_mcd->cdc.HEAD.B.B0);
\r
281 CDC_Decode_Reg_Read |= (1 << 4); // Reg 4 (decoding)
\r
282 Pico_mcd->s68k_regs[5] = 0x5;
\r
283 return Pico_mcd->cdc.HEAD.B.B0;
\r
286 cdprintf("CDC read reg 05 = %.2X", Pico_mcd->cdc.HEAD.B.B1);
\r
288 CDC_Decode_Reg_Read |= (1 << 5); // Reg 5 (decoding)
\r
289 Pico_mcd->s68k_regs[5] = 0x6;
\r
290 return Pico_mcd->cdc.HEAD.B.B1;
\r
293 cdprintf("CDC read reg 06 = %.2X", Pico_mcd->cdc.HEAD.B.B2);
\r
295 CDC_Decode_Reg_Read |= (1 << 6); // Reg 6 (decoding)
\r
296 Pico_mcd->s68k_regs[5] = 0x7;
\r
297 return Pico_mcd->cdc.HEAD.B.B2;
\r
300 cdprintf("CDC read reg 07 = %.2X", Pico_mcd->cdc.HEAD.B.B3);
\r
302 CDC_Decode_Reg_Read |= (1 << 7); // Reg 7 (decoding)
\r
303 Pico_mcd->s68k_regs[5] = 0x8;
\r
304 return Pico_mcd->cdc.HEAD.B.B3;
\r
307 cdprintf("CDC read reg 08 = %.2X", Pico_mcd->cdc.PT.B.L);
\r
309 CDC_Decode_Reg_Read |= (1 << 8); // Reg 8 (decoding)
\r
310 Pico_mcd->s68k_regs[5] = 0x9;
\r
311 return Pico_mcd->cdc.PT.B.L;
\r
314 cdprintf("CDC read reg 09 = %.2X", Pico_mcd->cdc.PT.B.H);
\r
316 CDC_Decode_Reg_Read |= (1 << 9); // Reg 9 (decoding)
\r
317 Pico_mcd->s68k_regs[5] = 0xA;
\r
318 return Pico_mcd->cdc.PT.B.H;
\r
321 cdprintf("CDC read reg 10 = %.2X", Pico_mcd->cdc.WA.B.L);
\r
323 Pico_mcd->s68k_regs[5] = 0xB;
\r
324 return Pico_mcd->cdc.WA.B.L;
\r
327 cdprintf("CDC read reg 11 = %.2X", Pico_mcd->cdc.WA.B.H);
\r
329 Pico_mcd->s68k_regs[5] = 0xC;
\r
330 return Pico_mcd->cdc.WA.B.H;
\r
333 cdprintf("CDC read reg 12 = %.2X", Pico_mcd->cdc.STAT.B.B0);
\r
335 CDC_Decode_Reg_Read |= (1 << 12); // Reg 12 (decoding)
\r
336 Pico_mcd->s68k_regs[5] = 0xD;
\r
337 return Pico_mcd->cdc.STAT.B.B0;
\r
340 cdprintf("CDC read reg 13 = %.2X", Pico_mcd->cdc.STAT.B.B1);
\r
342 CDC_Decode_Reg_Read |= (1 << 13); // Reg 13 (decoding)
\r
343 Pico_mcd->s68k_regs[5] = 0xE;
\r
344 return Pico_mcd->cdc.STAT.B.B1;
\r
347 cdprintf("CDC read reg 14 = %.2X", Pico_mcd->cdc.STAT.B.B2);
\r
349 CDC_Decode_Reg_Read |= (1 << 14); // Reg 14 (decoding)
\r
350 Pico_mcd->s68k_regs[5] = 0xF;
\r
351 return Pico_mcd->cdc.STAT.B.B2;
\r
354 cdprintf("CDC read reg 15 = %.2X", Pico_mcd->cdc.STAT.B.B3);
\r
356 ret = Pico_mcd->cdc.STAT.B.B3;
\r
357 Pico_mcd->cdc.IFSTAT |= 0x20; // decoding interrupt flag cleared
\r
358 if ((Pico_mcd->cdc.CTRL.B.B0 & 0x80) && (Pico_mcd->cdc.IFCTRL & 0x20))
\r
360 if ((CDC_Decode_Reg_Read & 0x73F2) == 0x73F2)
\r
361 Pico_mcd->cdc.STAT.B.B3 = 0x80;
\r
370 void CDC_Write_Reg(unsigned char Data)
\r
372 cdprintf("CDC write reg%02d = %.2X", Pico_mcd->s68k_regs[5] & 0xF, Data);
\r
374 switch (Pico_mcd->s68k_regs[5] & 0xF)
\r
377 Pico_mcd->s68k_regs[5] = 0x1;
\r
378 Pico_mcd->cdc.SBOUT = Data;
\r
382 case 0x1: // IFCTRL
\r
383 Pico_mcd->s68k_regs[5] = 0x2;
\r
384 Pico_mcd->cdc.IFCTRL = Data;
\r
386 if ((Pico_mcd->cdc.IFCTRL & 0x02) == 0) // Stop data transfer
\r
388 Pico_mcd->cdc.DBC.N = 0;
\r
389 Pico_mcd->scd.Status_CDC &= ~0x08;
\r
390 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
395 Pico_mcd->s68k_regs[5] = 0x3;
\r
396 Pico_mcd->cdc.DBC.B.L = Data;
\r
401 Pico_mcd->s68k_regs[5] = 0x4;
\r
402 Pico_mcd->cdc.DBC.B.H = Data;
\r
407 Pico_mcd->s68k_regs[5] = 0x5;
\r
408 Pico_mcd->cdc.DAC.B.L = Data;
\r
413 Pico_mcd->s68k_regs[5] = 0x6;
\r
414 Pico_mcd->cdc.DAC.B.H = Data;
\r
419 if (Pico_mcd->cdc.IFCTRL & 0x02) // Data transfer enable ?
\r
421 Pico_mcd->cdc.IFSTAT &= ~0x08; // Data transfer in progress
\r
422 Pico_mcd->scd.Status_CDC |= 0x08; // Data transfer in progress
\r
423 Pico_mcd->s68k_regs[4] &= 0x7F; // A data transfer start
\r
425 cdprintf("************** Starting Data Transfer ***********");
\r
426 cdprintf("RS0 = %.4X DAC = %.4X DBC = %.4X DMA adr = %.4X\n\n", Pico_mcd->s68k_regs[4]<<8,
\r
427 Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N, (Pico_mcd->s68k_regs[0xA]<<8) | Pico_mcd->s68k_regs[0xB]);
\r
432 Pico_mcd->cdc.IFSTAT |= 0x40; // end data transfer interrupt flag cleared
\r
436 Pico_mcd->s68k_regs[5] = 0x9;
\r
437 Pico_mcd->cdc.WA.B.L = Data;
\r
442 Pico_mcd->s68k_regs[5] = 0xA;
\r
443 Pico_mcd->cdc.WA.B.H = Data;
\r
448 Pico_mcd->s68k_regs[5] = 0xB;
\r
449 Pico_mcd->cdc.CTRL.B.B0 = Data;
\r
454 Pico_mcd->s68k_regs[5] = 0xC;
\r
455 Pico_mcd->cdc.CTRL.B.B1 = Data;
\r
460 Pico_mcd->s68k_regs[5] = 0xD;
\r
461 Pico_mcd->cdc.PT.B.L = Data;
\r
466 Pico_mcd->s68k_regs[5] = 0xE;
\r
467 Pico_mcd->cdc.PT.B.H = Data;
\r
472 Pico_mcd->cdc.CTRL.B.B2 = Data;
\r
482 static int bswapwrite(int a, unsigned short d)
\r
484 *(unsigned short *)(Pico_mcd->s68k_regs + a) = (d>>8)|(d<<8);
\r
485 return d + (d >> 8);
\r
488 void CDD_Export_Status(void)
\r
492 csum = bswapwrite( 0x38+0, Pico_mcd->cdd.Status);
\r
493 csum += bswapwrite( 0x38+2, Pico_mcd->cdd.Minute);
\r
494 csum += bswapwrite( 0x38+4, Pico_mcd->cdd.Seconde);
\r
495 csum += bswapwrite( 0x38+6, Pico_mcd->cdd.Frame);
\r
496 Pico_mcd->s68k_regs[0x38+8] = Pico_mcd->cdd.Ext;
\r
497 csum += Pico_mcd->cdd.Ext;
\r
498 Pico_mcd->s68k_regs[0x38+9] = ~csum & 0xf;
\r
500 Pico_mcd->s68k_regs[0x37] &= 3; // CDD.Control
\r
502 if (Pico_mcd->s68k_regs[0x33] & (1<<4))
\r
504 dprintf("cdd export irq 4");
\r
505 SekInterruptS68k(4);
\r
508 // cdprintf("CDD exported status\n");
\r
509 cdprintf("out: Status=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",
\r
510 (Pico_mcd->s68k_regs[0x38+0] << 8) | Pico_mcd->s68k_regs[0x38+1],
\r
511 (Pico_mcd->s68k_regs[0x38+2] << 8) | Pico_mcd->s68k_regs[0x38+3],
\r
512 (Pico_mcd->s68k_regs[0x38+4] << 8) | Pico_mcd->s68k_regs[0x38+5],
\r
513 (Pico_mcd->s68k_regs[0x38+6] << 8) | Pico_mcd->s68k_regs[0x38+7],
\r
514 (Pico_mcd->s68k_regs[0x38+8] << 8) | Pico_mcd->s68k_regs[0x38+9]);
\r
518 void CDD_Import_Command(void)
\r
520 // cdprintf("CDD importing command\n");
\r
521 cdprintf("in: Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",
\r
522 (Pico_mcd->s68k_regs[0x38+10+0] << 8) | Pico_mcd->s68k_regs[0x38+10+1],
\r
523 (Pico_mcd->s68k_regs[0x38+10+2] << 8) | Pico_mcd->s68k_regs[0x38+10+3],
\r
524 (Pico_mcd->s68k_regs[0x38+10+4] << 8) | Pico_mcd->s68k_regs[0x38+10+5],
\r
525 (Pico_mcd->s68k_regs[0x38+10+6] << 8) | Pico_mcd->s68k_regs[0x38+10+7],
\r
526 (Pico_mcd->s68k_regs[0x38+10+8] << 8) | Pico_mcd->s68k_regs[0x38+10+9]);
\r
528 switch (Pico_mcd->s68k_regs[0x38+10+0])
\r
530 case 0x0: // STATUS (?)
\r
531 Get_Status_CDD_c0();
\r
534 case 0x1: // STOP ALL (?)
\r
538 case 0x2: // GET TOC INFORMATIONS
\r
539 switch(Pico_mcd->s68k_regs[0x38+10+3])
\r
541 case 0x0: // get current position (MSF format)
\r
542 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00);
\r
546 case 0x1: // get elapsed time of current track played/scanned (relative MSF format)
\r
547 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 1;
\r
548 Get_Track_Pos_CDD_c21();
\r
551 case 0x2: // get current track in RS2-RS3
\r
552 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 2;
\r
553 Get_Current_Track_CDD_c22();
\r
556 case 0x3: // get total length (MSF format)
\r
557 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 3;
\r
558 Get_Total_Lenght_CDD_c23();
\r
561 case 0x4: // first & last track number
\r
562 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 4;
\r
563 Get_First_Last_Track_CDD_c24();
\r
566 case 0x5: // get track addresse (MSF format)
\r
567 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 5;
\r
568 Get_Track_Adr_CDD_c25();
\r
571 default : // invalid, then we return status
\r
572 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 0xF;
\r
573 Get_Status_CDD_c0();
\r
586 case 0x6: // PAUSE/STOP
\r
590 case 0x7: // RESUME
\r
594 case 0x8: // FAST FOWARD
\r
595 Fast_Foward_CDD_c8();
\r
598 case 0x9: // FAST REWIND
\r
599 Fast_Rewind_CDD_c9();
\r
602 case 0xA: // RECOVER INITIAL STATE (?)
\r
606 case 0xC: // CLOSE TRAY
\r
607 Close_Tray_CDD_cC();
\r
610 case 0xD: // OPEN TRAY
\r
611 Open_Tray_CDD_cD();
\r
614 default: // UNKNOWN
\r