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 Pico_mcd->cdc.Host_Data = 0;
\r
69 Pico_mcd->cdc.DMA_Adr = 0;
\r
70 Pico_mcd->cdc.Stop_Watch = 0;
\r
74 void Update_CDC_TRansfer(int which)
\r
76 unsigned int dep, length, len;
\r
77 unsigned short *dest;
\r
80 if (Pico_mcd->cdc.DBC.N <= (CDC_DMA_SPEED * 2))
\r
82 length = (Pico_mcd->cdc.DBC.N + 1) >> 1;
\r
83 Pico_mcd->scd.Status_CDC &= ~0x08; // Last transfer
\r
84 Pico_mcd->s68k_regs[4] |= 0x80; // End data transfer
\r
85 Pico_mcd->s68k_regs[4] &= ~0x40; // no more data ready
\r
86 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
88 if (Pico_mcd->cdc.IFCTRL & 0x40) // DTEIEN = Data Trasnfer End Interrupt Enable ?
\r
90 Pico_mcd->cdc.IFSTAT &= ~0x40;
\r
92 if (Pico_mcd->s68k_regs[0x33] & (1<<5))
\r
94 dprintf("cdc DTE irq 5");
\r
95 SekInterruptS68k(5);
\r
99 else length = CDC_DMA_SPEED;
\r
102 // TODO: dst bounds checking? DAC.N alignment?
\r
103 src = Pico_mcd->cdc.Buffer + Pico_mcd->cdc.DAC.N;
\r
106 if (which == 7) // WORD RAM
\r
108 if (Pico_mcd->s68k_regs[3] & 4)
\r
110 dep = ((Pico_mcd->cdc.DMA_Adr & 0x3FFF) << 3);
\r
111 cdprintf("CD DMA # %04x -> word_ram1M # %06x, len=%i",
\r
112 Pico_mcd->cdc.DAC.N, dep, length);
\r
114 dep = ((Pico_mcd->cdc.DMA_Adr & 0x3FFF) << 4);
\r
115 if (!(Pico_mcd->s68k_regs[3]&1)) dep += 2;
\r
116 dest = (unsigned short *) (Pico_mcd->word_ram + dep);
\r
118 for (len = length; len > 0; len--, src+=2, dest+=2)
\r
119 *dest = (src[0]<<8) | src[1];
\r
123 dep = ((Pico_mcd->cdc.DMA_Adr & 0x7FFF) << 3);
\r
124 cdprintf("CD DMA # %04x -> word_ram2M # %06x, len=%i",
\r
125 Pico_mcd->cdc.DAC.N, dep, length);
\r
126 dest = (unsigned short *) (Pico_mcd->word_ram + dep);
\r
128 for (len = length; len > 0; len--, src+=2, dest++)
\r
129 *dest = (src[0]<<8) | src[1];
\r
132 else if (which == 4) // PCM RAM
\r
135 dest = (unsigned char *) Ram_PCM;
\r
136 dep = ((Pico_mcd->cdc.DMA_Adr & 0x03FF) << 2) + PCM_Chip.Bank;
\r
138 cdprintf("TODO: PCM Dma");
\r
141 else if (which == 5) // PRG RAM
\r
143 dep = (Pico_mcd->cdc.DMA_Adr & 0xFFFF) << 3;
\r
144 dest = (unsigned short *) (Pico_mcd->prg_ram + dep);
\r
145 cdprintf("CD DMA # %04x -> prg_ram # %06x, len=%i",
\r
146 Pico_mcd->cdc.DAC.N, dep, length);
\r
148 for (len = length; len > 0; len--, src+=2, dest++)
\r
149 *dest = (src[0]<<8) | src[1];
\r
153 Pico_mcd->cdc.DAC.N = (Pico_mcd->cdc.DAC.N + length) & 0xFFFF;
\r
154 if (Pico_mcd->scd.Status_CDC & 0x08) Pico_mcd->cdc.DBC.N -= length;
\r
155 else Pico_mcd->cdc.DBC.N = 0;
\r
159 unsigned short Read_CDC_Host(int is_sub)
\r
163 if (!(Pico_mcd->scd.Status_CDC & 0x08))
\r
165 // Transfer data disabled
\r
166 cdprintf("Read_CDC_Host: Transfer data disabled");
\r
170 if ((is_sub && (Pico_mcd->s68k_regs[4] & 7) != 3) ||
\r
171 (!is_sub && (Pico_mcd->s68k_regs[4] & 7) != 2))
\r
174 cdprintf("Read_CDC_Host: Wrong setting");
\r
178 Pico_mcd->cdc.DBC.N -= 2;
\r
180 if (Pico_mcd->cdc.DBC.N <= 0)
\r
182 Pico_mcd->cdc.DBC.N = 0;
\r
183 Pico_mcd->scd.Status_CDC &= ~0x08; // Last transfer
\r
184 Pico_mcd->s68k_regs[4] |= 0x80; // End data transfer
\r
185 Pico_mcd->s68k_regs[4] &= ~0x40; // no more data ready
\r
186 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
188 if (Pico_mcd->cdc.IFCTRL & 0x40) // DTEIEN = Data Transfer End Interrupt Enable ?
\r
190 Pico_mcd->cdc.IFSTAT &= ~0x40;
\r
192 if (Pico_mcd->s68k_regs[0x33]&(1<<5)) {
\r
193 dprintf("m68k: s68k irq 5");
\r
194 SekInterruptS68k(5);
\r
197 cdprintf("CDC - DTE interrupt");
\r
201 addr = Pico_mcd->cdc.DAC.N;
\r
202 Pico_mcd->cdc.DAC.N += 2;
\r
204 cdprintf("Read_CDC_Host sub=%i d=%04x dac=%04x dbc=%04x", is_sub,
\r
205 (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1], Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N);
\r
207 return (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1];
\r
212 mov esi, Pico_mcd->cdc.DAC.N
\r
213 lea ebx, Pico_mcd->cdc.Buffer
\r
215 mov ax, [ebx + esi]
\r
218 mov Pico_mcd->cdc.DAC.N, esi
\r
225 void CDC_Update_Header(void)
\r
227 if (Pico_mcd->cdc.CTRL.B.B1 & 0x01) // Sub-Header wanted ?
\r
229 Pico_mcd->cdc.HEAD.B.B0 = 0;
\r
230 Pico_mcd->cdc.HEAD.B.B1 = 0;
\r
231 Pico_mcd->cdc.HEAD.B.B2 = 0;
\r
232 Pico_mcd->cdc.HEAD.B.B3 = 0;
\r
238 LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);
\r
240 Pico_mcd->cdc.HEAD.B.B0 = INT_TO_BCDB(MSF.M);
\r
241 Pico_mcd->cdc.HEAD.B.B1 = INT_TO_BCDB(MSF.S);
\r
242 Pico_mcd->cdc.HEAD.B.B2 = INT_TO_BCDB(MSF.F);
\r
243 Pico_mcd->cdc.HEAD.B.B3 = 0x01;
\r
248 unsigned char CDC_Read_Reg(void)
\r
252 switch(Pico_mcd->s68k_regs[5] & 0xF)
\r
255 cdprintf("CDC read reg 00 = %.2X", Pico_mcd->cdc.COMIN);
\r
257 Pico_mcd->s68k_regs[5] = 0x1;
\r
258 return Pico_mcd->cdc.COMIN;
\r
260 case 0x1: // IFSTAT
\r
261 cdprintf("CDC read reg 01 = %.2X", Pico_mcd->cdc.IFSTAT);
\r
263 CDC_Decode_Reg_Read |= (1 << 1); // Reg 1 (decoding)
\r
264 Pico_mcd->s68k_regs[5] = 0x2;
\r
265 return Pico_mcd->cdc.IFSTAT;
\r
268 cdprintf("CDC read reg 02 = %.2X", Pico_mcd->cdc.DBC.B.L);
\r
270 Pico_mcd->s68k_regs[5] = 0x3;
\r
271 return Pico_mcd->cdc.DBC.B.L;
\r
274 cdprintf("CDC read reg 03 = %.2X", Pico_mcd->cdc.DBC.B.H);
\r
276 Pico_mcd->s68k_regs[5] = 0x4;
\r
277 return Pico_mcd->cdc.DBC.B.H;
\r
280 cdprintf("CDC read reg 04 = %.2X", Pico_mcd->cdc.HEAD.B.B0);
\r
282 CDC_Decode_Reg_Read |= (1 << 4); // Reg 4 (decoding)
\r
283 Pico_mcd->s68k_regs[5] = 0x5;
\r
284 return Pico_mcd->cdc.HEAD.B.B0;
\r
287 cdprintf("CDC read reg 05 = %.2X", Pico_mcd->cdc.HEAD.B.B1);
\r
289 CDC_Decode_Reg_Read |= (1 << 5); // Reg 5 (decoding)
\r
290 Pico_mcd->s68k_regs[5] = 0x6;
\r
291 return Pico_mcd->cdc.HEAD.B.B1;
\r
294 cdprintf("CDC read reg 06 = %.2X", Pico_mcd->cdc.HEAD.B.B2);
\r
296 CDC_Decode_Reg_Read |= (1 << 6); // Reg 6 (decoding)
\r
297 Pico_mcd->s68k_regs[5] = 0x7;
\r
298 return Pico_mcd->cdc.HEAD.B.B2;
\r
301 cdprintf("CDC read reg 07 = %.2X", Pico_mcd->cdc.HEAD.B.B3);
\r
303 CDC_Decode_Reg_Read |= (1 << 7); // Reg 7 (decoding)
\r
304 Pico_mcd->s68k_regs[5] = 0x8;
\r
305 return Pico_mcd->cdc.HEAD.B.B3;
\r
308 cdprintf("CDC read reg 08 = %.2X", Pico_mcd->cdc.PT.B.L);
\r
310 CDC_Decode_Reg_Read |= (1 << 8); // Reg 8 (decoding)
\r
311 Pico_mcd->s68k_regs[5] = 0x9;
\r
312 return Pico_mcd->cdc.PT.B.L;
\r
315 cdprintf("CDC read reg 09 = %.2X", Pico_mcd->cdc.PT.B.H);
\r
317 CDC_Decode_Reg_Read |= (1 << 9); // Reg 9 (decoding)
\r
318 Pico_mcd->s68k_regs[5] = 0xA;
\r
319 return Pico_mcd->cdc.PT.B.H;
\r
322 cdprintf("CDC read reg 10 = %.2X", Pico_mcd->cdc.WA.B.L);
\r
324 Pico_mcd->s68k_regs[5] = 0xB;
\r
325 return Pico_mcd->cdc.WA.B.L;
\r
328 cdprintf("CDC read reg 11 = %.2X", Pico_mcd->cdc.WA.B.H);
\r
330 Pico_mcd->s68k_regs[5] = 0xC;
\r
331 return Pico_mcd->cdc.WA.B.H;
\r
334 cdprintf("CDC read reg 12 = %.2X", Pico_mcd->cdc.STAT.B.B0);
\r
336 CDC_Decode_Reg_Read |= (1 << 12); // Reg 12 (decoding)
\r
337 Pico_mcd->s68k_regs[5] = 0xD;
\r
338 return Pico_mcd->cdc.STAT.B.B0;
\r
341 cdprintf("CDC read reg 13 = %.2X", Pico_mcd->cdc.STAT.B.B1);
\r
343 CDC_Decode_Reg_Read |= (1 << 13); // Reg 13 (decoding)
\r
344 Pico_mcd->s68k_regs[5] = 0xE;
\r
345 return Pico_mcd->cdc.STAT.B.B1;
\r
348 cdprintf("CDC read reg 14 = %.2X", Pico_mcd->cdc.STAT.B.B2);
\r
350 CDC_Decode_Reg_Read |= (1 << 14); // Reg 14 (decoding)
\r
351 Pico_mcd->s68k_regs[5] = 0xF;
\r
352 return Pico_mcd->cdc.STAT.B.B2;
\r
355 cdprintf("CDC read reg 15 = %.2X", Pico_mcd->cdc.STAT.B.B3);
\r
357 ret = Pico_mcd->cdc.STAT.B.B3;
\r
358 Pico_mcd->cdc.IFSTAT |= 0x20; // decoding interrupt flag cleared
\r
359 if ((Pico_mcd->cdc.CTRL.B.B0 & 0x80) && (Pico_mcd->cdc.IFCTRL & 0x20))
\r
361 if ((CDC_Decode_Reg_Read & 0x73F2) == 0x73F2)
\r
362 Pico_mcd->cdc.STAT.B.B3 = 0x80;
\r
371 void CDC_Write_Reg(unsigned char Data)
\r
373 cdprintf("CDC write reg%02d = %.2X", Pico_mcd->s68k_regs[5] & 0xF, Data);
\r
375 switch (Pico_mcd->s68k_regs[5] & 0xF)
\r
378 Pico_mcd->s68k_regs[5] = 0x1;
\r
379 Pico_mcd->cdc.SBOUT = Data;
\r
383 case 0x1: // IFCTRL
\r
384 Pico_mcd->s68k_regs[5] = 0x2;
\r
385 Pico_mcd->cdc.IFCTRL = Data;
\r
387 if ((Pico_mcd->cdc.IFCTRL & 0x02) == 0) // Stop data transfer
\r
389 Pico_mcd->cdc.DBC.N = 0;
\r
390 Pico_mcd->scd.Status_CDC &= ~0x08;
\r
391 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
396 Pico_mcd->s68k_regs[5] = 0x3;
\r
397 Pico_mcd->cdc.DBC.B.L = Data;
\r
402 Pico_mcd->s68k_regs[5] = 0x4;
\r
403 Pico_mcd->cdc.DBC.B.H = Data;
\r
408 Pico_mcd->s68k_regs[5] = 0x5;
\r
409 Pico_mcd->cdc.DAC.B.L = Data;
\r
414 Pico_mcd->s68k_regs[5] = 0x6;
\r
415 Pico_mcd->cdc.DAC.B.H = Data;
\r
420 if (Pico_mcd->cdc.IFCTRL & 0x02) // Data transfer enable ?
\r
422 Pico_mcd->cdc.IFSTAT &= ~0x08; // Data transfer in progress
\r
423 Pico_mcd->scd.Status_CDC |= 0x08; // Data transfer in progress
\r
424 Pico_mcd->s68k_regs[4] &= 0x7F; // A data transfer start
\r
426 cdprintf("************** Starting Data Transfer ***********");
\r
427 cdprintf("RS0 = %.4X DAC = %.4X DBC = %.4X DMA adr = %.4X\n\n", Pico_mcd->s68k_regs[4]<<8,
\r
428 Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N, Pico_mcd->cdc.DMA_Adr);
\r
433 Pico_mcd->cdc.IFSTAT |= 0x40; // end data transfer interrupt flag cleared
\r
437 Pico_mcd->s68k_regs[5] = 0x9;
\r
438 Pico_mcd->cdc.WA.B.L = Data;
\r
443 Pico_mcd->s68k_regs[5] = 0xA;
\r
444 Pico_mcd->cdc.WA.B.H = Data;
\r
449 Pico_mcd->s68k_regs[5] = 0xB;
\r
450 Pico_mcd->cdc.CTRL.B.B0 = Data;
\r
455 Pico_mcd->s68k_regs[5] = 0xC;
\r
456 Pico_mcd->cdc.CTRL.B.B1 = Data;
\r
461 Pico_mcd->s68k_regs[5] = 0xD;
\r
462 Pico_mcd->cdc.PT.B.L = Data;
\r
467 Pico_mcd->s68k_regs[5] = 0xE;
\r
468 Pico_mcd->cdc.PT.B.H = Data;
\r
473 Pico_mcd->cdc.CTRL.B.B2 = Data;
\r
483 static int bswapwrite(int a, unsigned short d)
\r
485 *(unsigned short *)(Pico_mcd->s68k_regs + a) = (d>>8)|(d<<8);
\r
486 return d + (d >> 8);
\r
489 void CDD_Export_Status(void)
\r
493 csum = bswapwrite( 0x38+0, Pico_mcd->cdd.Status);
\r
494 csum += bswapwrite( 0x38+2, Pico_mcd->cdd.Minute);
\r
495 csum += bswapwrite( 0x38+4, Pico_mcd->cdd.Seconde);
\r
496 csum += bswapwrite( 0x38+6, Pico_mcd->cdd.Frame);
\r
497 Pico_mcd->s68k_regs[0x38+8] = Pico_mcd->cdd.Ext;
\r
498 csum += Pico_mcd->cdd.Ext;
\r
499 Pico_mcd->s68k_regs[0x38+9] = ~csum & 0xf;
\r
501 Pico_mcd->s68k_regs[0x37] &= 3; // CDD.Control
\r
503 if (Pico_mcd->s68k_regs[0x33] & (1<<4))
\r
505 dprintf("cdd export irq 4");
\r
506 SekInterruptS68k(4);
\r
509 // cdprintf("CDD exported status\n");
\r
510 cdprintf("out: Status=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",
\r
511 (Pico_mcd->s68k_regs[0x38+0] << 8) | Pico_mcd->s68k_regs[0x38+1],
\r
512 (Pico_mcd->s68k_regs[0x38+2] << 8) | Pico_mcd->s68k_regs[0x38+3],
\r
513 (Pico_mcd->s68k_regs[0x38+4] << 8) | Pico_mcd->s68k_regs[0x38+5],
\r
514 (Pico_mcd->s68k_regs[0x38+6] << 8) | Pico_mcd->s68k_regs[0x38+7],
\r
515 (Pico_mcd->s68k_regs[0x38+8] << 8) | Pico_mcd->s68k_regs[0x38+9]);
\r
519 void CDD_Import_Command(void)
\r
521 // cdprintf("CDD importing command\n");
\r
522 cdprintf("in: Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",
\r
523 (Pico_mcd->s68k_regs[0x38+10+0] << 8) | Pico_mcd->s68k_regs[0x38+10+1],
\r
524 (Pico_mcd->s68k_regs[0x38+10+2] << 8) | Pico_mcd->s68k_regs[0x38+10+3],
\r
525 (Pico_mcd->s68k_regs[0x38+10+4] << 8) | Pico_mcd->s68k_regs[0x38+10+5],
\r
526 (Pico_mcd->s68k_regs[0x38+10+6] << 8) | Pico_mcd->s68k_regs[0x38+10+7],
\r
527 (Pico_mcd->s68k_regs[0x38+10+8] << 8) | Pico_mcd->s68k_regs[0x38+10+9]);
\r
529 switch (Pico_mcd->s68k_regs[0x38+10+0])
\r
531 case 0x0: // STATUS (?)
\r
532 Get_Status_CDD_c0();
\r
535 case 0x1: // STOP ALL (?)
\r
539 case 0x2: // GET TOC INFORMATIONS
\r
540 switch(Pico_mcd->s68k_regs[0x38+10+3])
\r
542 case 0x0: // get current position (MSF format)
\r
543 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00);
\r
547 case 0x1: // get elapsed time of current track played/scanned (relative MSF format)
\r
548 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 1;
\r
549 Get_Track_Pos_CDD_c21();
\r
552 case 0x2: // get current track in RS2-RS3
\r
553 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 2;
\r
554 Get_Current_Track_CDD_c22();
\r
557 case 0x3: // get total length (MSF format)
\r
558 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 3;
\r
559 Get_Total_Lenght_CDD_c23();
\r
562 case 0x4: // first & last track number
\r
563 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 4;
\r
564 Get_First_Last_Track_CDD_c24();
\r
567 case 0x5: // get track addresse (MSF format)
\r
568 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 5;
\r
569 Get_Track_Adr_CDD_c25();
\r
572 default : // invalid, then we return status
\r
573 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 0xF;
\r
574 Get_Status_CDD_c0();
\r
587 case 0x6: // PAUSE/STOP
\r
591 case 0x7: // RESUME
\r
595 case 0x8: // FAST FOWARD
\r
596 Fast_Foward_CDD_c8();
\r
599 case 0x9: // FAST REWIND
\r
600 Fast_Rewind_CDD_c9();
\r
603 case 0xA: // RECOVER INITIAL STATE (?)
\r
607 case 0xC: // CLOSE TRAY
\r
608 Close_Tray_CDD_cC();
\r
611 case 0xD: // OPEN TRAY
\r
612 Open_Tray_CDD_cD();
\r
615 default: // UNKNOWN
\r