1 /***************************************************************************
2 * Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program; if not, write to the *
16 * Free Software Foundation, Inc., *
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA. *
18 ***************************************************************************/
21 * Handles all CD-ROM registers and functions.
30 #define CDR_LOG SysPrintf
35 #define CDR_LOG_I SysPrintf
37 #define CDR_LOG_I(...)
40 #define CDR_LOG_IO SysPrintf
42 #define CDR_LOG_IO(...)
44 //#define CDR_LOG_CMD_IRQ
47 static unsigned char *pTransfer;
49 /* CD-ROM magic numbers */
63 #define CdlSetfilter 13
73 #define CdlSetclock 23
74 #define CdlGetclock 24
82 char *CmdName[0x100]= {
83 "CdlSync", "CdlNop", "CdlSetloc", "CdlPlay",
84 "CdlForward", "CdlBackward", "CdlReadN", "CdlStandby",
85 "CdlStop", "CdlPause", "CdlInit", "CdlMute",
86 "CdlDemute", "CdlSetfilter", "CdlSetmode", "CdlGetmode",
87 "CdlGetlocL", "CdlGetlocP", "CdlReadT", "CdlGetTN",
88 "CdlGetTD", "CdlSeekL", "CdlSeekP", "CdlSetclock",
89 "CdlGetclock", "CdlTest", "CdlID", "CdlReadS",
90 "CdlReset", NULL, "CDlReadToc", NULL
93 unsigned char Test04[] = { 0 };
94 unsigned char Test05[] = { 0 };
95 unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
96 unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
97 unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
103 #define Acknowledge 3
108 #define MODE_SPEED (1<<7) // 0x80
109 #define MODE_STRSND (1<<6) // 0x40 ADPCM on/off
110 #define MODE_SIZE_2340 (1<<5) // 0x20
111 #define MODE_SIZE_2328 (1<<4) // 0x10
112 #define MODE_SIZE_2048 (0<<4) // 0x00
113 #define MODE_SF (1<<3) // 0x08 channel on/off
114 #define MODE_REPORT (1<<2) // 0x04
115 #define MODE_AUTOPAUSE (1<<1) // 0x02
116 #define MODE_CDDA (1<<0) // 0x01
119 #define STATUS_PLAY (1<<7) // 0x80
120 #define STATUS_SEEK (1<<6) // 0x40
121 #define STATUS_READ (1<<5) // 0x20
122 #define STATUS_SHELLOPEN (1<<4) // 0x10
123 #define STATUS_UNKNOWN3 (1<<3) // 0x08
124 #define STATUS_UNKNOWN2 (1<<2) // 0x04
125 #define STATUS_ROTATING (1<<1) // 0x02
126 #define STATUS_ERROR (1<<0) // 0x01
129 #define ERROR_NOT_READY (1<<7) // 0x80
130 #define ERROR_INVALIDCMD (1<<6) // 0x40
131 #define ERROR_INVALIDARG (1<<5) // 0x20
133 // 1x = 75 sectors per second
134 // PSXCLK = 1 sec in the ps
135 // so (PSXCLK / 75) = cdr read time (linuzappz)
136 #define cdReadTime (PSXCLK / 75)
139 DRIVESTATE_STANDBY = 0,
141 DRIVESTATE_RESCAN_CD,
142 DRIVESTATE_PREPARE_CD,
152 static struct CdrStat stat;
154 static unsigned int msf2sec(const u8 *msf) {
155 return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
158 // for that weird psemu API..
159 static unsigned int fsm2sec(const u8 *msf) {
160 return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
163 static void sec2msf(unsigned int s, u8 *msf) {
164 msf[0] = s / 75 / 60;
165 s = s - msf[0] * 75 * 60;
172 #define CDR_INT(eCycle) { \
173 psxRegs.interrupt |= (1 << PSXINT_CDR); \
174 psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
175 psxRegs.intCycle[PSXINT_CDR].sCycle = psxRegs.cycle; \
176 new_dyna_set_event(PSXINT_CDR, eCycle); \
180 #define CDREAD_INT(eCycle) { \
181 psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
182 psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
183 psxRegs.intCycle[PSXINT_CDREAD].sCycle = psxRegs.cycle; \
184 new_dyna_set_event(PSXINT_CDREAD, eCycle); \
187 // cdrLidSeekInterrupt
188 #define CDRLID_INT(eCycle) { \
189 psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
190 psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
191 psxRegs.intCycle[PSXINT_CDRLID].sCycle = psxRegs.cycle; \
192 new_dyna_set_event(PSXINT_CDRLID, eCycle); \
196 #define CDRMISC_INT(eCycle) { \
197 psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
198 psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
199 psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
200 new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
203 #define StopReading() { \
206 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
208 cdr.StatP &= ~STATUS_READ;\
211 #define StopCdda() { \
213 if (!Config.Cdda) CDR_stop(); \
214 cdr.StatP &= ~STATUS_PLAY; \
216 cdr.FastForward = 0; \
217 cdr.FastBackward = 0; \
218 /*SPU_registerCallback( SPUirq );*/ \
222 #define SetResultSize(size) { \
224 cdr.ResultC = size; \
225 cdr.ResultReady = 1; \
228 static void setIrq(void)
230 if (cdr.Stat & cdr.Reg2)
231 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
234 // timing used in this function was taken from tests on real hardware
235 // (yes it's slow, but you probably don't want to modify it)
236 void cdrLidSeekInterrupt()
238 switch (cdr.DriveState) {
240 case DRIVESTATE_STANDBY:
241 cdr.StatP &= ~STATUS_SEEK;
243 if (CDR_getStatus(&stat) == -1)
246 if (stat.Status & STATUS_SHELLOPEN)
249 cdr.DriveState = DRIVESTATE_LID_OPEN;
254 case DRIVESTATE_LID_OPEN:
255 if (CDR_getStatus(&stat) == -1)
256 stat.Status &= ~STATUS_SHELLOPEN;
259 if (!(cdr.StatP & STATUS_SHELLOPEN)) {
261 cdr.StatP |= STATUS_SHELLOPEN;
263 // could generate error irq here, but real hardware
264 // only sometimes does that
265 // (not done when lots of commands are sent?)
267 CDRLID_INT(cdReadTime * 30);
270 else if (cdr.StatP & STATUS_ROTATING) {
271 cdr.StatP &= ~STATUS_ROTATING;
273 else if (!(stat.Status & STATUS_SHELLOPEN)) {
277 // cdr.StatP STATUS_SHELLOPEN is "sticky"
278 // and is only cleared by CdlNop
280 cdr.DriveState = DRIVESTATE_RESCAN_CD;
281 CDRLID_INT(cdReadTime * 105);
286 CDRLID_INT(cdReadTime * 3);
289 case DRIVESTATE_RESCAN_CD:
290 cdr.StatP |= STATUS_ROTATING;
291 cdr.DriveState = DRIVESTATE_PREPARE_CD;
293 // this is very long on real hardware, over 6 seconds
294 // make it a bit faster here...
295 CDRLID_INT(cdReadTime * 150);
298 case DRIVESTATE_PREPARE_CD:
299 cdr.StatP |= STATUS_SEEK;
301 cdr.DriveState = DRIVESTATE_STANDBY;
302 CDRLID_INT(cdReadTime * 26);
307 static void Find_CurTrack(const u8 *time)
311 current = msf2sec(time);
313 for (cdr.CurTrack = 1; cdr.CurTrack < cdr.ResultTN[1]; cdr.CurTrack++) {
314 CDR_getTD(cdr.CurTrack + 1, cdr.ResultTD);
315 sect = fsm2sec(cdr.ResultTD);
316 if (sect - current >= 150)
321 static void generate_subq(const u8 *time)
323 unsigned char start[3], next[3];
324 unsigned int this_s, start_s, next_s, pregap;
327 CDR_getTD(cdr.CurTrack, start);
328 if (cdr.CurTrack + 1 <= cdr.ResultTN[1]) {
330 CDR_getTD(cdr.CurTrack + 1, next);
333 // last track - cd size
335 next[0] = cdr.SetSectorEnd[2];
336 next[1] = cdr.SetSectorEnd[1];
337 next[2] = cdr.SetSectorEnd[0];
340 this_s = msf2sec(time);
341 start_s = fsm2sec(start);
342 next_s = fsm2sec(next);
344 cdr.TrackChanged = FALSE;
346 if (next_s - this_s < pregap) {
347 cdr.TrackChanged = TRUE;
354 relative_s = this_s - start_s;
355 if (relative_s < 0) {
357 relative_s = -relative_s;
359 sec2msf(relative_s, cdr.subq.Relative);
361 cdr.subq.Track = itob(cdr.CurTrack);
362 cdr.subq.Relative[0] = itob(cdr.subq.Relative[0]);
363 cdr.subq.Relative[1] = itob(cdr.subq.Relative[1]);
364 cdr.subq.Relative[2] = itob(cdr.subq.Relative[2]);
365 cdr.subq.Absolute[0] = itob(time[0]);
366 cdr.subq.Absolute[1] = itob(time[1]);
367 cdr.subq.Absolute[2] = itob(time[2]);
370 static void ReadTrack(const u8 *time) {
371 unsigned char tmp[3];
375 tmp[0] = itob(time[0]);
376 tmp[1] = itob(time[1]);
377 tmp[2] = itob(time[2]);
379 if (memcmp(cdr.Prev, tmp, 3) == 0)
382 CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
384 cdr.RErr = CDR_readTrack(tmp);
385 memcpy(cdr.Prev, tmp, 3);
390 subq = (struct SubQ *)CDR_getBufferSub();
391 if (subq != NULL && cdr.CurTrack == 1) {
392 crc = calcCrc((u8 *)subq + 12, 10);
393 if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
394 cdr.subq.Track = subq->TrackNumber;
395 cdr.subq.Index = subq->IndexNumber;
396 memcpy(cdr.subq.Relative, subq->TrackRelativeAddress, 3);
397 memcpy(cdr.subq.Absolute, subq->AbsoluteAddress, 3);
400 CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
401 tmp[0], tmp[1], tmp[2]);
408 CDR_LOG(" -> %02x,%02x %02x:%02x:%02x %02x:%02x:%02x\n",
409 cdr.subq.Track, cdr.subq.Index,
410 cdr.subq.Relative[0], cdr.subq.Relative[1], cdr.subq.Relative[2],
411 cdr.subq.Absolute[0], cdr.subq.Absolute[1], cdr.subq.Absolute[2]);
414 static void AddIrqQueue(unsigned short irq, unsigned long ecycle) {
416 if (irq == cdr.Irq || irq + 0x100 == cdr.Irq) {
422 CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
431 static void cdrPlayInterrupt_Autopause()
433 if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
434 CDR_LOG( "CDDA STOP\n" );
436 // Magic the Gathering
437 // - looping territory cdda
440 //cdr.ResultReady = 1;
441 //cdr.Stat = DataReady;
447 else if (cdr.Mode & MODE_REPORT) {
449 cdr.Result[0] = cdr.StatP;
450 cdr.Result[1] = cdr.subq.Track;
451 cdr.Result[2] = cdr.subq.Index;
453 if (cdr.subq.Absolute[2] & 0x10) {
454 cdr.Result[3] = cdr.subq.Relative[0];
455 cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
456 cdr.Result[5] = cdr.subq.Relative[2];
459 cdr.Result[3] = cdr.subq.Absolute[0];
460 cdr.Result[4] = cdr.subq.Absolute[1];
461 cdr.Result[5] = cdr.subq.Absolute[2];
467 // Rayman: Logo freeze (resultready + dataready)
469 cdr.Stat = DataReady;
477 void cdrPlayInterrupt()
479 if (cdr.Seeked == SEEK_PENDING) {
481 CDR_LOG_I("cdrom: seek stat hack\n");
486 cdr.StatP |= STATUS_ROTATING;
487 cdr.StatP &= ~STATUS_SEEK;
488 cdr.Result[0] = cdr.StatP;
489 cdr.Seeked = SEEK_DONE;
495 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
496 Find_CurTrack(cdr.SetSectorPlay);
497 ReadTrack(cdr.SetSectorPlay);
498 cdr.TrackChanged = FALSE;
501 if (!cdr.Play) return;
503 CDR_LOG( "CDDA - %d:%d:%d\n",
504 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
506 if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
508 cdr.TrackChanged = TRUE;
511 if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
512 cdrPlayInterrupt_Autopause();
514 if (!cdr.Play) return;
516 cdr.SetSectorPlay[2]++;
517 if (cdr.SetSectorPlay[2] == 75) {
518 cdr.SetSectorPlay[2] = 0;
519 cdr.SetSectorPlay[1]++;
520 if (cdr.SetSectorPlay[1] == 60) {
521 cdr.SetSectorPlay[1] = 0;
522 cdr.SetSectorPlay[0]++;
526 CDRMISC_INT(cdReadTime);
528 // update for CdlGetlocP/autopause
529 generate_subq(cdr.SetSectorPlay);
532 void cdrInterrupt() {
534 int no_busy_error = 0;
535 int start_rotating = 0;
541 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
550 cdr.Result[0] = cdr.StatP;
551 cdr.Stat = Acknowledge;
553 if (cdr.IrqRepeated) {
555 if (cdr.eCycle > psxRegs.cycle) {
565 // TOOD: sometimes/always return error?
569 if (cdr.DriveState != DRIVESTATE_LID_OPEN)
570 cdr.StatP &= ~STATUS_SHELLOPEN;
578 if (cdr.Seeked == SEEK_PENDING) {
579 // XXX: wrong, should seek instead..
580 memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
581 cdr.Seeked = SEEK_DONE;
585 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
587 if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
588 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
589 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
593 int track = btoi( cdr.Param[0] );
595 if (track <= cdr.ResultTN[1])
596 cdr.CurTrack = track;
598 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
600 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
601 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
602 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
603 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
608 Rayman: detect track changes
611 Twisted Metal 2: skip PREGAP + starting accurate SubQ
612 - plays tracks without retry play
614 Wild 9: skip PREGAP + starting accurate SubQ
615 - plays tracks without retry play
617 Find_CurTrack(cdr.SetSectorPlay);
618 ReadTrack(cdr.SetSectorPlay);
619 cdr.TrackChanged = FALSE;
622 CDR_play(cdr.SetSectorPlay);
624 // Vib Ribbon: gameplay checks flag
625 cdr.StatP &= ~STATUS_SEEK;
626 cdr.Result[0] = cdr.StatP;
628 cdr.StatP |= STATUS_PLAY;
630 // BIOS player - set flag again
633 CDRMISC_INT( cdReadTime );
638 // TODO: error 80 if stopped
641 // GameShark CD Player: Calls 2x + Play 2x
642 if( cdr.FastForward == 0 ) cdr.FastForward = 2;
643 else cdr.FastForward++;
645 cdr.FastBackward = 0;
651 // GameShark CD Player: Calls 2x + Play 2x
652 if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
653 else cdr.FastBackward++;
659 if (cdr.DriveState != DRIVESTATE_STOPPED) {
660 error = ERROR_INVALIDARG;
663 AddIrqQueue(CdlStandby + 0x100, cdReadTime * 125 / 2);
667 case CdlStandby + 0x100:
673 if (cdr.DriveState == DRIVESTATE_STANDBY)
674 delay = cdReadTime * 30 / 2;
676 cdr.DriveState = DRIVESTATE_STOPPED;
677 AddIrqQueue(CdlStop + 0x100, delay);
680 case CdlStop + 0x100:
681 cdr.StatP &= ~STATUS_ROTATING;
682 cdr.Result[0] = cdr.StatP;
688 Gundam Battle Assault 2: much slower (*)
689 - Fixes boot, gameplay
691 Hokuto no Ken 2: slower
692 - Fixes intro + subtitles
694 InuYasha - Feudal Fairy Tale: slower
697 AddIrqQueue(CdlPause + 0x100, cdReadTime * 3);
701 case CdlPause + 0x100:
702 cdr.StatP &= ~STATUS_READ;
703 cdr.Result[0] = cdr.StatP;
708 AddIrqQueue(CdlInit + 0x100, cdReadTime * 6);
713 case CdlInit + 0x100:
732 cdr.Result[1] = cdr.Mode;
733 cdr.Result[2] = cdr.File;
734 cdr.Result[3] = cdr.Channel;
742 memcpy(cdr.Result, cdr.Transfer, 8);
747 memcpy(&cdr.Result, &cdr.subq, 8);
749 if (!cdr.Play && !cdr.Reading)
750 cdr.Result[1] = 0; // HACK?
753 case CdlReadT: // SetSession?
755 AddIrqQueue(CdlReadT + 0x100, cdReadTime * 290 / 4);
759 case CdlReadT + 0x100:
765 if (CDR_getTN(cdr.ResultTN) == -1) {
766 cdr.Stat = DiskError;
767 cdr.Result[0] |= STATUS_ERROR;
769 cdr.Stat = Acknowledge;
770 cdr.Result[1] = itob(cdr.ResultTN[0]);
771 cdr.Result[2] = itob(cdr.ResultTN[1]);
776 cdr.Track = btoi(cdr.Param[0]);
778 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
779 cdr.Stat = DiskError;
780 cdr.Result[0] |= STATUS_ERROR;
782 cdr.Stat = Acknowledge;
783 cdr.Result[0] = cdr.StatP;
784 cdr.Result[1] = itob(cdr.ResultTD[2]);
785 cdr.Result[2] = itob(cdr.ResultTD[1]);
786 cdr.Result[3] = itob(cdr.ResultTD[0]);
792 cdr.StatP |= STATUS_SEEK;
795 Crusaders of Might and Magic = 0.5x-4x
796 - fix cutscene speech start
802 - fix cutscene speech
807 CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
808 cdr.Seeked = SEEK_PENDING;
813 switch (cdr.Param[0]) {
814 case 0x20: // System Controller ROM Version
816 memcpy(cdr.Result, Test20, 4);
820 memcpy(cdr.Result, Test22, 4);
822 case 0x23: case 0x24:
824 memcpy(cdr.Result, Test23, 4);
831 AddIrqQueue(CdlID + 0x100, 20480);
836 cdr.Result[0] = cdr.StatP;
841 // 0x10 - audio | 0x40 - disk missing | 0x80 - unlicensed
842 if (CDR_getStatus(&stat) == -1 || stat.Type == 0 || stat.Type == 0xff) {
843 cdr.Result[1] = 0xc0;
847 cdr.Result[1] |= 0x10;
848 if (CdromId[0] == '\0')
849 cdr.Result[1] |= 0x80;
851 cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
853 strncpy((char *)&cdr.Result[4], "PCSX", 4);
858 // yes, it really sets STATUS_SHELLOPEN
859 cdr.StatP |= STATUS_SHELLOPEN;
860 cdr.DriveState = DRIVESTATE_RESCAN_CD;
868 CDR_LOG_I("got CdlGetQ\n");
872 AddIrqQueue(CdlReadToc + 0x100, cdReadTime * 180 / 4);
877 case CdlReadToc + 0x100:
884 if (!cdr.Reading) return;
886 // Fighting Force 2 - update subq time immediately
888 Find_CurTrack(cdr.SetSector);
889 ReadTrack(cdr.SetSector);
892 // Crusaders of Might and Magic - update getlocl now
893 // - fixes cutscene speech
895 u8 *buf = CDR_getBuffer();
897 memcpy(cdr.Transfer, buf, 8);
901 Duke Nukem: Land of the Babes - seek then delay read for one frame
903 C-12 - Final Resistance - doesn't like seek
906 if (cdr.Seeked != SEEK_DONE) {
907 cdr.StatP |= STATUS_SEEK;
908 cdr.StatP &= ~STATUS_READ;
910 // Crusaders of Might and Magic - use short time
911 // - fix cutscene speech (startup)
913 // ??? - use more accurate seek time later
914 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
916 cdr.StatP |= STATUS_READ;
917 cdr.StatP &= ~STATUS_SEEK;
919 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
922 cdr.Result[0] = cdr.StatP;
927 CDR_LOG_I("Invalid command: %02x\n", Irq);
928 error = ERROR_INVALIDCMD;
933 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
934 cdr.Result[1] = error;
935 cdr.Stat = DiskError;
939 if (cdr.DriveState == DRIVESTATE_STOPPED && start_rotating) {
940 cdr.DriveState = DRIVESTATE_STANDBY;
941 cdr.StatP |= STATUS_ROTATING;
944 if (!no_busy_error) {
945 switch (cdr.DriveState) {
946 case DRIVESTATE_LID_OPEN:
947 case DRIVESTATE_RESCAN_CD:
948 case DRIVESTATE_PREPARE_CD:
950 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
951 cdr.Result[1] = ERROR_NOT_READY;
952 cdr.Stat = DiskError;
961 #ifdef CDR_LOG_CMD_IRQ
964 SysPrintf("CDR IRQ %d cmd %02x stat %02x: ",
965 !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
966 for (i = 0; i < cdr.ResultC; i++)
967 SysPrintf("%02x ", cdr.Result[i]);
973 #ifdef __ARM_ARCH_7A__
974 #define ssat32_to_16(v) \
975 asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
977 #define ssat32_to_16(v) do { \
978 if (v < -32768) v = -32768; \
979 else if (v > 32767) v = 32767; \
983 void cdrAttenuate(s16 *buf, int samples, int stereo)
986 int ll = cdr.AttenuatorLeftToLeft;
987 int lr = cdr.AttenuatorLeftToRight;
988 int rl = cdr.AttenuatorRightToLeft;
989 int rr = cdr.AttenuatorRightToRight;
991 if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
994 if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
998 for (i = 0; i < samples; i++) {
1001 l = (l * ll + r * rl) >> 7;
1002 r = (r * rr + l * lr) >> 7;
1010 for (i = 0; i < samples; i++) {
1012 l = l * (ll + rl) >> 7;
1013 //r = r * (rr + lr) >> 7;
1021 void cdrReadInterrupt() {
1027 if (cdr.Irq || cdr.Stat) {
1028 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1035 cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1036 cdr.StatP &= ~STATUS_SEEK;
1037 cdr.Result[0] = cdr.StatP;
1038 cdr.Seeked = SEEK_DONE;
1040 ReadTrack(cdr.SetSector);
1042 buf = CDR_getBuffer();
1046 if (cdr.RErr == -1) {
1047 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1048 memset(cdr.Transfer, 0, DATA_SIZE);
1049 cdr.Stat = DiskError;
1050 cdr.Result[0] |= STATUS_ERROR;
1051 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1055 memcpy(cdr.Transfer, buf, DATA_SIZE);
1056 CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1059 CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1061 if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1062 // Firemen 2: Multi-XA files - briefings, cutscenes
1063 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1064 cdr.File = cdr.Transfer[4 + 0];
1065 cdr.Channel = cdr.Transfer[4 + 1];
1068 if((cdr.Transfer[4 + 2] & 0x4) &&
1069 (cdr.Transfer[4 + 1] == cdr.Channel) &&
1070 (cdr.Transfer[4 + 0] == cdr.File)) {
1071 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1073 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
1074 SPU_playADPCMchannel(&cdr.Xa);
1075 cdr.FirstSector = 0;
1077 else cdr.FirstSector = -1;
1082 if (cdr.SetSector[2] == 75) {
1083 cdr.SetSector[2] = 0;
1085 if (cdr.SetSector[1] == 60) {
1086 cdr.SetSector[1] = 0;
1093 CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
1096 Croc 2: $40 - only FORM1 (*)
1097 Judge Dredd: $C8 - only FORM1 (*)
1098 Sim Theme Park - no adpcm at all (zero)
1101 if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
1102 cdr.Stat = DataReady;
1106 // update for CdlGetlocP
1107 ReadTrack(cdr.SetSector);
1116 bit 5 - 1 result ready
1118 bit 7 - 1 command being processed
1121 unsigned char cdrRead0(void) {
1122 if (cdr.ResultReady)
1130 // cdr.Ctrl &= ~0x40;
1132 // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1135 CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1137 return psxHu8(0x1800) = cdr.Ctrl;
1140 void cdrWrite0(unsigned char rt) {
1141 CDR_LOG_IO("cdr w0: %02x\n", rt);
1143 cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1146 unsigned char cdrRead1(void) {
1147 if ((cdr.ResultP & 0xf) < cdr.ResultC)
1148 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1152 if (cdr.ResultP == cdr.ResultC)
1153 cdr.ResultReady = 0;
1155 CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1157 return psxHu8(0x1801);
1160 void cdrWrite1(unsigned char rt) {
1164 CDR_LOG_IO("cdr w1: %02x\n", rt);
1166 switch (cdr.Ctrl & 3) {
1170 cdr.AttenuatorRightToRightT = rt;
1179 #ifdef CDR_LOG_CMD_IRQ
1180 SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
1182 SysPrintf(" Param[%d] = {", cdr.ParamC);
1183 for (i = 0; i < cdr.ParamC; i++)
1184 SysPrintf(" %x,", cdr.Param[i]);
1191 cdr.ResultReady = 0;
1193 // cdr.Stat = NoIntr;
1194 AddIrqQueue(cdr.Cmd, 0x800);
1213 for (i = 0; i < 3; i++)
1214 set_loc[i] = btoi(cdr.Param[i]);
1216 // FIXME: clean up this SetSector/SetSectorPlay mess,
1217 // there should be single var tracking current sector pos
1219 i = msf2sec(cdr.SetSectorPlay);
1221 i = msf2sec(cdr.SetSector);
1222 i = abs(i - msf2sec(set_loc));
1224 cdr.Seeked = SEEK_PENDING;
1226 memcpy(cdr.SetSector, set_loc, 3);
1227 cdr.SetSector[3] = 0;
1231 // Vib Ribbon: try same track again
1234 // Vib Ribbon - decoded buffer IRQ for CDDA reading
1235 // - fixes ribbon timing + music CD mode
1236 //CDRDBUF_INT( PSXCLK / 44100 * 0x100 );
1240 cdr.StatP |= STATUS_SEEK;
1241 cdr.StatP &= ~STATUS_ROTATING;
1247 cdr.FirstSector = 1;
1257 // GameShark CD Player: Reset CDDA to track start
1259 // grab time for current track
1260 CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
1262 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
1263 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
1264 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
1273 GameShark CD Player: save time for resume
1275 Twisted Metal - World Tour: don't mix Setloc / CdlPlay cursors
1284 cdr.Seeked = SEEK_DONE;
1291 // Duke Nukem - Time to Kill
1292 // - do not directly set cd-xa volume
1293 //SPU_writeRegister( H_CDLeft, 0x0000 );
1294 //SPU_writeRegister( H_CDRight, 0x0000 );
1300 // Duke Nukem - Time to Kill
1301 // - do not directly set cd-xa volume
1302 //SPU_writeRegister( H_CDLeft, 0x7f00 );
1303 //SPU_writeRegister( H_CDRight, 0x7f00 );
1307 cdr.File = cdr.Param[0];
1308 cdr.Channel = cdr.Param[1];
1312 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1314 cdr.Mode = cdr.Param[0];
1316 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1317 // - fixes choppy movie sound
1318 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1323 //AddIrqQueue(cdr.Cmd, 0x800);
1325 // GameShark CDX CD Player: very long time
1326 AddIrqQueue(cdr.Cmd, 0x100000);
1331 // Tomb Raider 2 - reset cdda
1339 cdr.FirstSector = 1;
1345 CDR_LOG_I("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
1350 unsigned char cdrRead2(void) {
1353 if (cdr.Readed == 0) {
1359 CDR_LOG_IO("cdr r2: %02x\n", ret);
1363 void cdrWrite2(unsigned char rt) {
1364 CDR_LOG_IO("cdr w2: %02x\n", rt);
1366 switch (cdr.Ctrl & 3) {
1368 if (cdr.ParamC < 8) // FIXME: size and wrapping
1369 cdr.Param[cdr.ParamC++] = rt;
1376 cdr.AttenuatorLeftToLeftT = rt;
1379 cdr.AttenuatorRightToLeftT = rt;
1384 unsigned char cdrRead3(void) {
1386 psxHu8(0x1803) = cdr.Stat | 0xE0;
1388 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1390 CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1391 return psxHu8(0x1803);
1394 void cdrWrite3(unsigned char rt) {
1395 CDR_LOG_IO("cdr w3: %02x\n", rt);
1397 switch (cdr.Ctrl & 3) {
1407 cdr.AttenuatorLeftToRightT = rt;
1411 memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
1412 CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
1413 cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
1414 cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
1419 if ((rt & 0x80) && cdr.Readed == 0) {
1421 pTransfer = cdr.Transfer;
1423 switch (cdr.Mode & 0x30) {
1424 case MODE_SIZE_2328:
1429 case MODE_SIZE_2340:
1439 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1444 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1449 if (cdr.Readed == 0) {
1450 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1454 cdsize = (bcr & 0xffff) * 4;
1456 // Ape Escape: bcr = 0001 / 0000
1460 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
1461 case MODE_SIZE_2340: cdsize = 2340; break;
1462 case MODE_SIZE_2328: cdsize = 2328; break;
1464 case MODE_SIZE_2048: cdsize = 2048; break;
1469 ptr = (u8 *)PSXM(madr);
1471 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1476 GS CDX: Enhancement CD crash
1479 - Spams DMA3 and gets buffer overrun
1481 size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1486 memcpy(ptr, pTransfer, size);
1489 psxCpu->Clear(madr, cdsize / 4);
1490 pTransfer += cdsize;
1494 if( chcr == 0x11400100 ) {
1495 CDRDMA_INT( (cdsize/4) / 4 );
1497 else if( chcr == 0x11000000 ) {
1498 CDRDMA_INT( (cdsize/4) * 1 );
1503 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1507 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1511 void cdrDmaInterrupt()
1513 if (HW_DMA3_CHCR & SWAP32(0x01000000))
1515 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1520 static void getCdInfo(void)
1524 CDR_getTN(cdr.ResultTN);
1525 CDR_getTD(0, cdr.SetSectorEnd);
1526 tmp = cdr.SetSectorEnd[0];
1527 cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
1528 cdr.SetSectorEnd[2] = tmp;
1532 memset(&cdr, 0, sizeof(cdr));
1538 cdr.DriveState = DRIVESTATE_STANDBY;
1539 pTransfer = cdr.Transfer;
1541 // BIOS player - default values
1542 cdr.AttenuatorLeftToLeft = 0x80;
1543 cdr.AttenuatorLeftToRight = 0x00;
1544 cdr.AttenuatorRightToLeft = 0x00;
1545 cdr.AttenuatorRightToRight = 0x80;
1550 int cdrFreeze(void *f, int Mode) {
1554 if (Mode == 0 && !Config.Cdda)
1557 cdr.freeze_ver = 0x63647201;
1558 gzfreeze(&cdr, sizeof(cdr));
1561 cdr.ParamP = cdr.ParamC;
1562 tmp = pTransfer - cdr.Transfer;
1565 gzfreeze(&tmp, sizeof(tmp));
1570 pTransfer = cdr.Transfer + tmp;
1572 // read right sub data
1573 memcpy(tmpp, cdr.Prev, 3);
1578 Find_CurTrack(cdr.SetSectorPlay);
1580 CDR_play(cdr.SetSectorPlay);
1583 if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
1584 // old versions did not latch Reg2, have to fixup..
1585 if (cdr.Reg2 == 0) {
1586 SysPrintf("cdrom: fixing up old savestate\n");
1595 void LidInterrupt() {
1598 cdrLidSeekInterrupt();