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
19 static void CDD_Reset(void)
\r
23 memset(Pico_mcd->s68k_regs+0x34, 0, 2*2); // CDD.Fader, CDD.Control
\r
24 Pico_mcd->cdd.Status = 0;
\r
25 Pico_mcd->cdd.Minute = 0;
\r
26 Pico_mcd->cdd.Seconde = 0;
\r
27 Pico_mcd->cdd.Frame = 0;
\r
28 Pico_mcd->cdd.Ext = 0;
\r
30 // clear receive status and transfer command
\r
31 memset(Pico_mcd->s68k_regs+0x38, 0, 20);
\r
32 Pico_mcd->s68k_regs[0x38+9] = 0xF; // Default checksum
\r
36 static void CDC_Reset(void)
\r
40 memset(Pico_mcd->cdc.Buffer, 0, (16 * 1024 * 2) + 2352);
\r
42 CDC_Update_Header();
\r
44 Pico_mcd->cdc.COMIN = 0;
\r
45 Pico_mcd->cdc.IFSTAT = 0xFF;
\r
46 Pico_mcd->cdc.DAC.N = 0;
\r
47 Pico_mcd->cdc.DBC.N = 0;
\r
48 Pico_mcd->cdc.HEAD.N = 0x01000000;
\r
49 Pico_mcd->cdc.PT.N = 0;
\r
50 Pico_mcd->cdc.WA.N = 2352 * 2;
\r
51 Pico_mcd->cdc.STAT.N = 0x00000080;
\r
52 Pico_mcd->cdc.SBOUT = 0;
\r
53 Pico_mcd->cdc.IFCTRL = 0;
\r
54 Pico_mcd->cdc.CTRL.N = 0;
\r
56 Pico_mcd->cdd.CDC_Decode_Reg_Read = 0;
\r
57 Pico_mcd->scd.Status_CDC &= ~0x08;
\r
61 void LC89510_Reset(void)
\r
66 // clear DMA_Adr & Stop_Watch
\r
67 memset(Pico_mcd->s68k_regs + 0xA, 0, 4);
\r
71 void Update_CDC_TRansfer(int which)
\r
73 unsigned int DMA_Adr, dep, length, len;
\r
74 unsigned short *dest;
\r
77 if (Pico_mcd->cdc.DBC.N <= (CDC_DMA_SPEED * 2))
\r
79 length = (Pico_mcd->cdc.DBC.N + 1) >> 1;
\r
80 Pico_mcd->scd.Status_CDC &= ~0x08; // Last transfer
\r
81 Pico_mcd->s68k_regs[4] |= 0x80; // End data transfer
\r
82 Pico_mcd->s68k_regs[4] &= ~0x40; // no more data ready
\r
83 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
85 if (Pico_mcd->cdc.IFCTRL & 0x40) // DTEIEN = Data Trasnfer End Interrupt Enable ?
\r
87 Pico_mcd->cdc.IFSTAT &= ~0x40;
\r
89 if (Pico_mcd->s68k_regs[0x33] & (1<<5))
\r
91 dprintf("cdc DTE irq 5");
\r
92 SekInterruptS68k(5);
\r
96 else length = CDC_DMA_SPEED;
\r
99 // TODO: dst bounds checking? DAC.N alignment?
\r
100 src = Pico_mcd->cdc.Buffer + Pico_mcd->cdc.DAC.N;
\r
101 DMA_Adr = (Pico_mcd->s68k_regs[0xA]<<8) | Pico_mcd->s68k_regs[0xB];
\r
103 if (which == 7) // WORD RAM
\r
105 if (Pico_mcd->s68k_regs[3] & 4)
\r
107 dep = ((DMA_Adr & 0x3FFF) << 3);
\r
108 cdprintf("CD DMA # %04x -> word_ram1M # %06x, len=%i",
\r
109 Pico_mcd->cdc.DAC.N, dep, length);
\r
111 dep = ((DMA_Adr & 0x3FFF) << 4);
\r
112 if (!(Pico_mcd->s68k_regs[3]&1)) dep += 2;
\r
113 dest = (unsigned short *) (Pico_mcd->word_ram + dep);
\r
115 for (len = length; len > 0; len--, src+=2, dest+=2)
\r
116 *dest = (src[0]<<8) | src[1];
\r
120 dep = ((DMA_Adr & 0x7FFF) << 3);
\r
121 cdprintf("CD DMA # %04x -> word_ram2M # %06x, len=%i",
\r
122 Pico_mcd->cdc.DAC.N, dep, length);
\r
123 dest = (unsigned short *) (Pico_mcd->word_ram + dep);
\r
125 for (len = length; len > 0; len--, src+=2, dest++)
\r
126 *dest = (src[0]<<8) | src[1];
\r
129 else if (which == 4) // PCM RAM
\r
132 dest = (unsigned char *) Ram_PCM;
\r
133 dep = ((DMA_Adr & 0x03FF) << 2) + PCM_Chip.Bank;
\r
135 cdprintf("CD DMA # %04x -> PCD TODO", Pico_mcd->cdc.DAC.N);
\r
138 else if (which == 5) // PRG RAM
\r
140 dep = DMA_Adr << 3;
\r
141 dest = (unsigned short *) (Pico_mcd->prg_ram + dep);
\r
142 cdprintf("CD DMA # %04x -> prg_ram # %06x, len=%i",
\r
143 Pico_mcd->cdc.DAC.N, dep, length);
\r
145 for (len = length; len > 0; len--, src+=2, dest++)
\r
146 *dest = (src[0]<<8) | src[1];
\r
150 Pico_mcd->cdc.DAC.N = (Pico_mcd->cdc.DAC.N + length) & 0xFFFF;
\r
151 if (Pico_mcd->scd.Status_CDC & 0x08) Pico_mcd->cdc.DBC.N -= length;
\r
152 else Pico_mcd->cdc.DBC.N = 0;
\r
156 unsigned short Read_CDC_Host(int is_sub)
\r
160 if (!(Pico_mcd->scd.Status_CDC & 0x08))
\r
162 // Transfer data disabled
\r
163 cdprintf("Read_CDC_Host: Transfer data disabled");
\r
167 if ((is_sub && (Pico_mcd->s68k_regs[4] & 7) != 3) ||
\r
168 (!is_sub && (Pico_mcd->s68k_regs[4] & 7) != 2))
\r
171 cdprintf("Read_CDC_Host: Wrong setting");
\r
175 Pico_mcd->cdc.DBC.N -= 2;
\r
177 if (Pico_mcd->cdc.DBC.N <= 0)
\r
179 Pico_mcd->cdc.DBC.N = 0;
\r
180 Pico_mcd->scd.Status_CDC &= ~0x08; // Last transfer
\r
181 Pico_mcd->s68k_regs[4] |= 0x80; // End data transfer
\r
182 Pico_mcd->s68k_regs[4] &= ~0x40; // no more data ready
\r
183 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
185 if (Pico_mcd->cdc.IFCTRL & 0x40) // DTEIEN = Data Transfer End Interrupt Enable ?
\r
187 Pico_mcd->cdc.IFSTAT &= ~0x40;
\r
189 if (Pico_mcd->s68k_regs[0x33]&(1<<5)) {
\r
190 dprintf("m68k: s68k irq 5");
\r
191 SekInterruptS68k(5);
\r
194 cdprintf("CDC - DTE interrupt");
\r
198 addr = Pico_mcd->cdc.DAC.N;
\r
199 Pico_mcd->cdc.DAC.N += 2;
\r
201 cdprintf("Read_CDC_Host sub=%i d=%04x dac=%04x dbc=%04x", is_sub,
\r
202 (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1], Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N);
\r
204 return (Pico_mcd->cdc.Buffer[addr]<<8) | Pico_mcd->cdc.Buffer[addr+1];
\r
209 mov esi, Pico_mcd->cdc.DAC.N
\r
210 lea ebx, Pico_mcd->cdc.Buffer
\r
212 mov ax, [ebx + esi]
\r
215 mov Pico_mcd->cdc.DAC.N, esi
\r
222 void CDC_Update_Header(void)
\r
224 if (Pico_mcd->cdc.CTRL.B.B1 & 0x01) // Sub-Header wanted ?
\r
226 Pico_mcd->cdc.HEAD.B.B0 = 0;
\r
227 Pico_mcd->cdc.HEAD.B.B1 = 0;
\r
228 Pico_mcd->cdc.HEAD.B.B2 = 0;
\r
229 Pico_mcd->cdc.HEAD.B.B3 = 0;
\r
235 LBA_to_MSF(Pico_mcd->scd.Cur_LBA, &MSF);
\r
237 Pico_mcd->cdc.HEAD.B.B0 = INT_TO_BCDB(MSF.M);
\r
238 Pico_mcd->cdc.HEAD.B.B1 = INT_TO_BCDB(MSF.S);
\r
239 Pico_mcd->cdc.HEAD.B.B2 = INT_TO_BCDB(MSF.F);
\r
240 Pico_mcd->cdc.HEAD.B.B3 = 0x01;
\r
245 unsigned char CDC_Read_Reg(void)
\r
249 switch(Pico_mcd->s68k_regs[5] & 0xF)
\r
252 cdprintf("CDC read reg 00 = %.2X", Pico_mcd->cdc.COMIN);
\r
254 Pico_mcd->s68k_regs[5] = 0x1;
\r
255 return Pico_mcd->cdc.COMIN;
\r
257 case 0x1: // IFSTAT
\r
258 cdprintf("CDC read reg 01 = %.2X", Pico_mcd->cdc.IFSTAT);
\r
260 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 1); // Reg 1 (decoding)
\r
261 Pico_mcd->s68k_regs[5] = 0x2;
\r
262 return Pico_mcd->cdc.IFSTAT;
\r
265 cdprintf("CDC read reg 02 = %.2X", Pico_mcd->cdc.DBC.B.L);
\r
267 Pico_mcd->s68k_regs[5] = 0x3;
\r
268 return Pico_mcd->cdc.DBC.B.L;
\r
271 cdprintf("CDC read reg 03 = %.2X", Pico_mcd->cdc.DBC.B.H);
\r
273 Pico_mcd->s68k_regs[5] = 0x4;
\r
274 return Pico_mcd->cdc.DBC.B.H;
\r
277 cdprintf("CDC read reg 04 = %.2X", Pico_mcd->cdc.HEAD.B.B0);
\r
279 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 4); // Reg 4 (decoding)
\r
280 Pico_mcd->s68k_regs[5] = 0x5;
\r
281 return Pico_mcd->cdc.HEAD.B.B0;
\r
284 cdprintf("CDC read reg 05 = %.2X", Pico_mcd->cdc.HEAD.B.B1);
\r
286 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 5); // Reg 5 (decoding)
\r
287 Pico_mcd->s68k_regs[5] = 0x6;
\r
288 return Pico_mcd->cdc.HEAD.B.B1;
\r
291 cdprintf("CDC read reg 06 = %.2X", Pico_mcd->cdc.HEAD.B.B2);
\r
293 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 6); // Reg 6 (decoding)
\r
294 Pico_mcd->s68k_regs[5] = 0x7;
\r
295 return Pico_mcd->cdc.HEAD.B.B2;
\r
298 cdprintf("CDC read reg 07 = %.2X", Pico_mcd->cdc.HEAD.B.B3);
\r
300 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 7); // Reg 7 (decoding)
\r
301 Pico_mcd->s68k_regs[5] = 0x8;
\r
302 return Pico_mcd->cdc.HEAD.B.B3;
\r
305 cdprintf("CDC read reg 08 = %.2X", Pico_mcd->cdc.PT.B.L);
\r
307 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 8); // Reg 8 (decoding)
\r
308 Pico_mcd->s68k_regs[5] = 0x9;
\r
309 return Pico_mcd->cdc.PT.B.L;
\r
312 cdprintf("CDC read reg 09 = %.2X", Pico_mcd->cdc.PT.B.H);
\r
314 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 9); // Reg 9 (decoding)
\r
315 Pico_mcd->s68k_regs[5] = 0xA;
\r
316 return Pico_mcd->cdc.PT.B.H;
\r
319 cdprintf("CDC read reg 10 = %.2X", Pico_mcd->cdc.WA.B.L);
\r
321 Pico_mcd->s68k_regs[5] = 0xB;
\r
322 return Pico_mcd->cdc.WA.B.L;
\r
325 cdprintf("CDC read reg 11 = %.2X", Pico_mcd->cdc.WA.B.H);
\r
327 Pico_mcd->s68k_regs[5] = 0xC;
\r
328 return Pico_mcd->cdc.WA.B.H;
\r
331 cdprintf("CDC read reg 12 = %.2X", Pico_mcd->cdc.STAT.B.B0);
\r
333 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 12); // Reg 12 (decoding)
\r
334 Pico_mcd->s68k_regs[5] = 0xD;
\r
335 return Pico_mcd->cdc.STAT.B.B0;
\r
338 cdprintf("CDC read reg 13 = %.2X", Pico_mcd->cdc.STAT.B.B1);
\r
340 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 13); // Reg 13 (decoding)
\r
341 Pico_mcd->s68k_regs[5] = 0xE;
\r
342 return Pico_mcd->cdc.STAT.B.B1;
\r
345 cdprintf("CDC read reg 14 = %.2X", Pico_mcd->cdc.STAT.B.B2);
\r
347 Pico_mcd->cdd.CDC_Decode_Reg_Read |= (1 << 14); // Reg 14 (decoding)
\r
348 Pico_mcd->s68k_regs[5] = 0xF;
\r
349 return Pico_mcd->cdc.STAT.B.B2;
\r
352 cdprintf("CDC read reg 15 = %.2X", Pico_mcd->cdc.STAT.B.B3);
\r
354 ret = Pico_mcd->cdc.STAT.B.B3;
\r
355 Pico_mcd->cdc.IFSTAT |= 0x20; // decoding interrupt flag cleared
\r
356 if ((Pico_mcd->cdc.CTRL.B.B0 & 0x80) && (Pico_mcd->cdc.IFCTRL & 0x20))
\r
358 if ((Pico_mcd->cdd.CDC_Decode_Reg_Read & 0x73F2) == 0x73F2)
\r
359 Pico_mcd->cdc.STAT.B.B3 = 0x80;
\r
368 void CDC_Write_Reg(unsigned char Data)
\r
370 cdprintf("CDC write reg%02d = %.2X", Pico_mcd->s68k_regs[5] & 0xF, Data);
\r
372 switch (Pico_mcd->s68k_regs[5] & 0xF)
\r
375 Pico_mcd->s68k_regs[5] = 0x1;
\r
376 Pico_mcd->cdc.SBOUT = Data;
\r
380 case 0x1: // IFCTRL
\r
381 Pico_mcd->s68k_regs[5] = 0x2;
\r
382 Pico_mcd->cdc.IFCTRL = Data;
\r
384 if ((Pico_mcd->cdc.IFCTRL & 0x02) == 0) // Stop data transfer
\r
386 Pico_mcd->cdc.DBC.N = 0;
\r
387 Pico_mcd->scd.Status_CDC &= ~0x08;
\r
388 Pico_mcd->cdc.IFSTAT |= 0x08; // No more data transfer in progress
\r
393 Pico_mcd->s68k_regs[5] = 0x3;
\r
394 Pico_mcd->cdc.DBC.B.L = Data;
\r
399 Pico_mcd->s68k_regs[5] = 0x4;
\r
400 Pico_mcd->cdc.DBC.B.H = Data;
\r
405 Pico_mcd->s68k_regs[5] = 0x5;
\r
406 Pico_mcd->cdc.DAC.B.L = Data;
\r
411 Pico_mcd->s68k_regs[5] = 0x6;
\r
412 Pico_mcd->cdc.DAC.B.H = Data;
\r
417 if (Pico_mcd->cdc.IFCTRL & 0x02) // Data transfer enable ?
\r
419 Pico_mcd->cdc.IFSTAT &= ~0x08; // Data transfer in progress
\r
420 Pico_mcd->scd.Status_CDC |= 0x08; // Data transfer in progress
\r
421 Pico_mcd->s68k_regs[4] &= 0x7F; // A data transfer start
\r
423 cdprintf("************** Starting Data Transfer ***********");
\r
424 cdprintf("RS0 = %.4X DAC = %.4X DBC = %.4X DMA adr = %.4X\n\n", Pico_mcd->s68k_regs[4]<<8,
\r
425 Pico_mcd->cdc.DAC.N, Pico_mcd->cdc.DBC.N, (Pico_mcd->s68k_regs[0xA]<<8) | Pico_mcd->s68k_regs[0xB]);
\r
430 Pico_mcd->cdc.IFSTAT |= 0x40; // end data transfer interrupt flag cleared
\r
434 Pico_mcd->s68k_regs[5] = 0x9;
\r
435 Pico_mcd->cdc.WA.B.L = Data;
\r
440 Pico_mcd->s68k_regs[5] = 0xA;
\r
441 Pico_mcd->cdc.WA.B.H = Data;
\r
446 Pico_mcd->s68k_regs[5] = 0xB;
\r
447 Pico_mcd->cdc.CTRL.B.B0 = Data;
\r
452 Pico_mcd->s68k_regs[5] = 0xC;
\r
453 Pico_mcd->cdc.CTRL.B.B1 = Data;
\r
458 Pico_mcd->s68k_regs[5] = 0xD;
\r
459 Pico_mcd->cdc.PT.B.L = Data;
\r
464 Pico_mcd->s68k_regs[5] = 0xE;
\r
465 Pico_mcd->cdc.PT.B.H = Data;
\r
470 Pico_mcd->cdc.CTRL.B.B2 = Data;
\r
480 static int bswapwrite(int a, unsigned short d)
\r
482 *(unsigned short *)(Pico_mcd->s68k_regs + a) = (d>>8)|(d<<8);
\r
483 return d + (d >> 8);
\r
486 void CDD_Export_Status(void)
\r
490 csum = bswapwrite( 0x38+0, Pico_mcd->cdd.Status);
\r
491 csum += bswapwrite( 0x38+2, Pico_mcd->cdd.Minute);
\r
492 csum += bswapwrite( 0x38+4, Pico_mcd->cdd.Seconde);
\r
493 csum += bswapwrite( 0x38+6, Pico_mcd->cdd.Frame);
\r
494 Pico_mcd->s68k_regs[0x38+8] = Pico_mcd->cdd.Ext;
\r
495 csum += Pico_mcd->cdd.Ext;
\r
496 Pico_mcd->s68k_regs[0x38+9] = ~csum & 0xf;
\r
498 Pico_mcd->s68k_regs[0x37] &= 3; // CDD.Control
\r
500 if (Pico_mcd->s68k_regs[0x33] & (1<<4))
\r
502 dprintf("cdd export irq 4");
\r
503 SekInterruptS68k(4);
\r
506 // cdprintf("CDD exported status\n");
\r
507 cdprintf("out: Status=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",
\r
508 (Pico_mcd->s68k_regs[0x38+0] << 8) | Pico_mcd->s68k_regs[0x38+1],
\r
509 (Pico_mcd->s68k_regs[0x38+2] << 8) | Pico_mcd->s68k_regs[0x38+3],
\r
510 (Pico_mcd->s68k_regs[0x38+4] << 8) | Pico_mcd->s68k_regs[0x38+5],
\r
511 (Pico_mcd->s68k_regs[0x38+6] << 8) | Pico_mcd->s68k_regs[0x38+7],
\r
512 (Pico_mcd->s68k_regs[0x38+8] << 8) | Pico_mcd->s68k_regs[0x38+9]);
\r
516 void CDD_Import_Command(void)
\r
518 // cdprintf("CDD importing command\n");
\r
519 cdprintf("in: Command=%.4X, Minute=%.4X, Second=%.4X, Frame=%.4X Checksum=%.4X",
\r
520 (Pico_mcd->s68k_regs[0x38+10+0] << 8) | Pico_mcd->s68k_regs[0x38+10+1],
\r
521 (Pico_mcd->s68k_regs[0x38+10+2] << 8) | Pico_mcd->s68k_regs[0x38+10+3],
\r
522 (Pico_mcd->s68k_regs[0x38+10+4] << 8) | Pico_mcd->s68k_regs[0x38+10+5],
\r
523 (Pico_mcd->s68k_regs[0x38+10+6] << 8) | Pico_mcd->s68k_regs[0x38+10+7],
\r
524 (Pico_mcd->s68k_regs[0x38+10+8] << 8) | Pico_mcd->s68k_regs[0x38+10+9]);
\r
526 switch (Pico_mcd->s68k_regs[0x38+10+0])
\r
528 case 0x0: // STATUS (?)
\r
529 Get_Status_CDD_c0();
\r
532 case 0x1: // STOP ALL (?)
\r
536 case 0x2: // GET TOC INFORMATIONS
\r
537 switch(Pico_mcd->s68k_regs[0x38+10+3])
\r
539 case 0x0: // get current position (MSF format)
\r
540 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00);
\r
544 case 0x1: // get elapsed time of current track played/scanned (relative MSF format)
\r
545 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 1;
\r
546 Get_Track_Pos_CDD_c21();
\r
549 case 0x2: // get current track in RS2-RS3
\r
550 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 2;
\r
551 Get_Current_Track_CDD_c22();
\r
554 case 0x3: // get total length (MSF format)
\r
555 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 3;
\r
556 Get_Total_Lenght_CDD_c23();
\r
559 case 0x4: // first & last track number
\r
560 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 4;
\r
561 Get_First_Last_Track_CDD_c24();
\r
564 case 0x5: // get track addresse (MSF format)
\r
565 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 5;
\r
566 Get_Track_Adr_CDD_c25();
\r
569 default : // invalid, then we return status
\r
570 Pico_mcd->cdd.Status = (Pico_mcd->cdd.Status & 0xFF00) | 0xF;
\r
571 Get_Status_CDD_c0();
\r
584 case 0x6: // PAUSE/STOP
\r
588 case 0x7: // RESUME
\r
592 case 0x8: // FAST FOWARD
\r
593 Fast_Foward_CDD_c8();
\r
596 case 0x9: // FAST REWIND
\r
597 Fast_Rewind_CDD_c9();
\r
600 case 0xA: // RECOVER INITIAL STATE (?)
\r
604 case 0xC: // CLOSE TRAY
\r
605 Close_Tray_CDD_cC();
\r
608 case 0xD: // OPEN TRAY
\r
609 Open_Tray_CDD_cD();
\r
612 default: // UNKNOWN
\r