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
81 char *CmdName[0x100]= {
82 "CdlSync", "CdlNop", "CdlSetloc", "CdlPlay",
83 "CdlForward", "CdlBackward", "CdlReadN", "CdlStandby",
84 "CdlStop", "CdlPause", "CdlInit", "CdlMute",
85 "CdlDemute", "CdlSetfilter", "CdlSetmode", "CdlGetmode",
86 "CdlGetlocL", "CdlGetlocP", "CdlReadT", "CdlGetTN",
87 "CdlGetTD", "CdlSeekL", "CdlSeekP", "CdlSetclock",
88 "CdlGetclock", "CdlTest", "CdlID", "CdlReadS",
89 "CdlReset", NULL, "CDlReadToc", NULL
92 unsigned char Test04[] = { 0 };
93 unsigned char Test05[] = { 0 };
94 unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
95 unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
96 unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
102 #define Acknowledge 3
107 #define MODE_SPEED (1<<7) // 0x80
108 #define MODE_STRSND (1<<6) // 0x40 ADPCM on/off
109 #define MODE_SIZE_2340 (1<<5) // 0x20
110 #define MODE_SIZE_2328 (1<<4) // 0x10
111 #define MODE_SIZE_2048 (0<<4) // 0x00
112 #define MODE_SF (1<<3) // 0x08 channel on/off
113 #define MODE_REPORT (1<<2) // 0x04
114 #define MODE_AUTOPAUSE (1<<1) // 0x02
115 #define MODE_CDDA (1<<0) // 0x01
118 #define STATUS_PLAY (1<<7) // 0x80
119 #define STATUS_SEEK (1<<6) // 0x40
120 #define STATUS_READ (1<<5) // 0x20
121 #define STATUS_SHELLOPEN (1<<4) // 0x10
122 #define STATUS_UNKNOWN3 (1<<3) // 0x08
123 #define STATUS_UNKNOWN2 (1<<2) // 0x04
124 #define STATUS_ROTATING (1<<1) // 0x02
125 #define STATUS_ERROR (1<<0) // 0x01
128 // 1x = 75 sectors per second
129 // PSXCLK = 1 sec in the ps
130 // so (PSXCLK / 75) = cdr read time (linuzappz)
131 #define cdReadTime (PSXCLK / 75)
139 static struct CdrStat stat;
141 static unsigned int msf2sec(const u8 *msf) {
142 return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
145 // for that weird psemu API..
146 static unsigned int fsm2sec(const u8 *msf) {
147 return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
150 static void sec2msf(unsigned int s, u8 *msf) {
151 msf[0] = s / 75 / 60;
152 s = s - msf[0] * 75 * 60;
159 #define CDR_INT(eCycle) { \
160 psxRegs.interrupt |= (1 << PSXINT_CDR); \
161 psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
162 psxRegs.intCycle[PSXINT_CDR].sCycle = psxRegs.cycle; \
163 new_dyna_set_event(PSXINT_CDR, eCycle); \
167 #define CDREAD_INT(eCycle) { \
168 psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
169 psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
170 psxRegs.intCycle[PSXINT_CDREAD].sCycle = psxRegs.cycle; \
171 new_dyna_set_event(PSXINT_CDREAD, eCycle); \
174 // cdrLidSeekInterrupt
175 #define CDRLID_INT(eCycle) { \
176 psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
177 psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
178 psxRegs.intCycle[PSXINT_CDRLID].sCycle = psxRegs.cycle; \
179 new_dyna_set_event(PSXINT_CDRLID, eCycle); \
183 #define CDRMISC_INT(eCycle) { \
184 psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
185 psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
186 psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
187 new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
190 #define StopReading() { \
193 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
195 cdr.StatP &= ~STATUS_READ;\
198 #define StopCdda() { \
200 if (!Config.Cdda) CDR_stop(); \
201 cdr.StatP &= ~STATUS_PLAY; \
203 cdr.FastForward = 0; \
204 cdr.FastBackward = 0; \
205 /*SPU_registerCallback( SPUirq );*/ \
209 #define SetResultSize(size) { \
211 cdr.ResultC = size; \
212 cdr.ResultReady = 1; \
215 static void setIrq(void)
217 if (cdr.Stat & cdr.Reg2)
218 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
221 void cdrLidSeekInterrupt()
223 // turn back on checking
224 if( cdr.LidCheck == 0x10 )
229 // official lid close
230 else if( cdr.LidCheck == 0x30 )
233 cdr.StatP |= STATUS_ROTATING;
236 // GS CDX 3.3 - ~50 getlocp tries
237 CDRLID_INT( cdReadTime * 3 );
242 else if( cdr.LidCheck == 0x40 )
245 cdr.StatP &= ~STATUS_SHELLOPEN;
246 cdr.StatP &= ~STATUS_ROTATING;
249 // GS CDX 3.3 - ~50 getlocp tries
250 CDRLID_INT( cdReadTime * 3 );
255 else if( cdr.LidCheck == 0x50 )
257 // GameShark Lite: Start seeking ($42)
258 cdr.StatP |= STATUS_SEEK;
259 cdr.StatP |= STATUS_ROTATING;
260 cdr.StatP &= ~STATUS_ERROR;
263 CDRLID_INT( cdReadTime * 3 );
268 else if( cdr.LidCheck == 0x60 )
270 // GameShark Lite: Seek detection done ($02)
271 cdr.StatP &= ~STATUS_SEEK;
277 static void Check_Shell( int Irq )
279 // check case open/close
280 if (cdr.LidCheck > 0)
282 CDR_LOG( "LidCheck\n" );
284 // $20 = check lid state
285 if( cdr.LidCheck == 0x20 )
290 if (CDR_getStatus(&stat) != -1)
292 // BIOS hangs + BIOS error messages
293 //if (stat.Type == 0xff)
294 //cdr.Stat = DiskError;
297 if (stat.Status & STATUS_SHELLOPEN)
299 // Vib Ribbon: pre-CD swap
303 // GameShark Lite: Death if DiskError happens
305 // Vib Ribbon: Needs DiskError for CD swap
309 cdr.Stat = DiskError;
311 cdr.StatP |= STATUS_ERROR;
312 cdr.Result[0] |= STATUS_ERROR;
315 // GameShark Lite: Wants -exactly- $10
316 cdr.StatP |= STATUS_SHELLOPEN;
317 cdr.StatP &= ~STATUS_ROTATING;
320 CDRLID_INT( cdReadTime * 3 );
328 else if ( i & STATUS_SHELLOPEN )
330 cdr.StatP |= STATUS_ROTATING;
335 if( cdr.Stat == NoIntr )
336 cdr.Stat = Acknowledge;
340 // begin close-seek-ready cycle
341 CDRLID_INT( cdReadTime * 3 );
345 // GameShark Lite: Wants -exactly- $42, then $02
346 // GS CDX 3.3: Wants $11/$80, $13/$80, $01/$00
349 // case still closed - wait for recheck
352 CDRLID_INT( cdReadTime * 3 );
359 // GS CDX: clear all values but #1,#2
360 if( (cdr.LidCheck >= 0x30) || (cdr.StatP & STATUS_SHELLOPEN) )
363 memset( cdr.Result, 0, 16 );
365 cdr.Result[0] = cdr.StatP;
368 // GS CDX: special return value
369 if( cdr.StatP & STATUS_SHELLOPEN )
371 cdr.Result[1] = 0x80;
375 if( cdr.Stat == NoIntr )
376 cdr.Stat = Acknowledge;
383 static void Find_CurTrack(const u8 *time)
387 current = msf2sec(time);
389 for (cdr.CurTrack = 1; cdr.CurTrack < cdr.ResultTN[1]; cdr.CurTrack++) {
390 CDR_getTD(cdr.CurTrack + 1, cdr.ResultTD);
391 sect = fsm2sec(cdr.ResultTD);
392 if (sect - current >= 150)
397 static void generate_subq(const u8 *time)
399 unsigned char start[3], next[3];
400 unsigned int this_s, start_s, next_s, pregap;
403 CDR_getTD(cdr.CurTrack, start);
404 if (cdr.CurTrack + 1 <= cdr.ResultTN[1]) {
406 CDR_getTD(cdr.CurTrack + 1, next);
409 // last track - cd size
411 next[0] = cdr.SetSectorEnd[2];
412 next[1] = cdr.SetSectorEnd[1];
413 next[2] = cdr.SetSectorEnd[0];
416 this_s = msf2sec(time);
417 start_s = fsm2sec(start);
418 next_s = fsm2sec(next);
420 cdr.TrackChanged = FALSE;
422 if (next_s - this_s < pregap) {
423 cdr.TrackChanged = TRUE;
430 relative_s = this_s - start_s;
431 if (relative_s < 0) {
433 relative_s = -relative_s;
435 sec2msf(relative_s, cdr.subq.Relative);
437 cdr.subq.Track = itob(cdr.CurTrack);
438 cdr.subq.Relative[0] = itob(cdr.subq.Relative[0]);
439 cdr.subq.Relative[1] = itob(cdr.subq.Relative[1]);
440 cdr.subq.Relative[2] = itob(cdr.subq.Relative[2]);
441 cdr.subq.Absolute[0] = itob(time[0]);
442 cdr.subq.Absolute[1] = itob(time[1]);
443 cdr.subq.Absolute[2] = itob(time[2]);
446 static void ReadTrack(const u8 *time) {
447 unsigned char tmp[3];
451 tmp[0] = itob(time[0]);
452 tmp[1] = itob(time[1]);
453 tmp[2] = itob(time[2]);
455 if (memcmp(cdr.Prev, tmp, 3) == 0)
458 CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
460 cdr.RErr = CDR_readTrack(tmp);
461 memcpy(cdr.Prev, tmp, 3);
466 subq = (struct SubQ *)CDR_getBufferSub();
467 if (subq != NULL && cdr.CurTrack == 1) {
468 crc = calcCrc((u8 *)subq + 12, 10);
469 if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
470 cdr.subq.Track = subq->TrackNumber;
471 cdr.subq.Index = subq->IndexNumber;
472 memcpy(cdr.subq.Relative, subq->TrackRelativeAddress, 3);
473 memcpy(cdr.subq.Absolute, subq->AbsoluteAddress, 3);
476 CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
477 tmp[0], tmp[1], tmp[2]);
484 CDR_LOG(" -> %02x,%02x %02x:%02x:%02x %02x:%02x:%02x\n",
485 cdr.subq.Track, cdr.subq.Index,
486 cdr.subq.Relative[0], cdr.subq.Relative[1], cdr.subq.Relative[2],
487 cdr.subq.Absolute[0], cdr.subq.Absolute[1], cdr.subq.Absolute[2]);
490 static void AddIrqQueue(unsigned char irq, unsigned long ecycle) {
492 CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
500 static void cdrPlayInterrupt_Autopause()
502 if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
503 CDR_LOG( "CDDA STOP\n" );
505 // Magic the Gathering
506 // - looping territory cdda
509 //cdr.ResultReady = 1;
510 //cdr.Stat = DataReady;
516 else if (cdr.Mode & MODE_REPORT) {
518 cdr.Result[0] = cdr.StatP;
519 cdr.Result[1] = cdr.subq.Track;
520 cdr.Result[2] = cdr.subq.Index;
522 if (cdr.subq.Absolute[2] & 0x10) {
523 cdr.Result[3] = cdr.subq.Relative[0];
524 cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
525 cdr.Result[5] = cdr.subq.Relative[2];
528 cdr.Result[3] = cdr.subq.Absolute[0];
529 cdr.Result[4] = cdr.subq.Absolute[1];
530 cdr.Result[5] = cdr.subq.Absolute[2];
536 // Rayman: Logo freeze (resultready + dataready)
538 cdr.Stat = DataReady;
546 void cdrPlayInterrupt()
548 if (cdr.Seeked == SEEK_PENDING) {
550 CDR_LOG_I("cdrom: seek stat hack\n");
555 cdr.StatP |= STATUS_ROTATING;
556 cdr.StatP &= ~STATUS_SEEK;
557 cdr.Result[0] = cdr.StatP;
558 cdr.Seeked = SEEK_DONE;
564 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
565 Find_CurTrack(cdr.SetSectorPlay);
566 ReadTrack(cdr.SetSectorPlay);
567 cdr.TrackChanged = FALSE;
570 if (!cdr.Play) return;
572 CDR_LOG( "CDDA - %d:%d:%d\n",
573 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
575 if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
577 cdr.TrackChanged = TRUE;
580 if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
581 cdrPlayInterrupt_Autopause();
583 if (!cdr.Play) return;
585 cdr.SetSectorPlay[2]++;
586 if (cdr.SetSectorPlay[2] == 75) {
587 cdr.SetSectorPlay[2] = 0;
588 cdr.SetSectorPlay[1]++;
589 if (cdr.SetSectorPlay[1] == 60) {
590 cdr.SetSectorPlay[1] = 0;
591 cdr.SetSectorPlay[0]++;
595 CDRMISC_INT(cdReadTime);
597 // update for CdlGetlocP/autopause
598 generate_subq(cdr.SetSectorPlay);
601 void cdrInterrupt() {
603 unsigned char Irq = cdr.Irq;
607 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
618 cdr.StatP |= STATUS_ROTATING;
619 cdr.Result[0] = cdr.StatP;
620 cdr.Stat = Acknowledge;
625 cdr.Result[0] = cdr.StatP;
626 cdr.Stat = Acknowledge;
628 if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
634 cdr.StatP |= STATUS_ROTATING;
635 cdr.Result[0] = cdr.StatP;
636 cdr.Stat = Acknowledge;
640 if (cdr.Seeked == SEEK_PENDING) {
641 // XXX: wrong, should seek instead..
642 memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
643 cdr.Seeked = SEEK_DONE;
647 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
649 if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
650 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
651 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
655 int track = btoi( cdr.Param[0] );
657 if (track <= cdr.ResultTN[1])
658 cdr.CurTrack = track;
660 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
662 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
663 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
664 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
665 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
670 Rayman: detect track changes
673 Twisted Metal 2: skip PREGAP + starting accurate SubQ
674 - plays tracks without retry play
676 Wild 9: skip PREGAP + starting accurate SubQ
677 - plays tracks without retry play
679 Find_CurTrack(cdr.SetSectorPlay);
680 ReadTrack(cdr.SetSectorPlay);
681 cdr.TrackChanged = FALSE;
684 CDR_play(cdr.SetSectorPlay);
686 // Vib Ribbon: gameplay checks flag
687 cdr.StatP &= ~STATUS_SEEK;
691 cdr.StatP |= STATUS_ROTATING;
692 cdr.Result[0] = cdr.StatP;
693 cdr.Stat = Acknowledge;
695 cdr.StatP |= STATUS_PLAY;
698 // BIOS player - set flag again
701 CDRMISC_INT( cdReadTime );
707 cdr.StatP |= STATUS_ROTATING;
708 cdr.Result[0] = cdr.StatP;
712 // GameShark CD Player: Calls 2x + Play 2x
713 if( cdr.FastForward == 0 ) cdr.FastForward = 2;
714 else cdr.FastForward++;
716 cdr.FastBackward = 0;
722 cdr.StatP |= STATUS_ROTATING;
723 cdr.Result[0] = cdr.StatP;
727 // GameShark CD Player: Calls 2x + Play 2x
728 if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
729 else cdr.FastBackward++;
737 cdr.StatP |= STATUS_ROTATING;
738 cdr.Result[0] = cdr.StatP;
745 cdr.StatP &= ~STATUS_ROTATING;
746 cdr.Result[0] = cdr.StatP;
748 // cdr.Stat = Acknowledge;
750 if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
755 cdr.Result[0] = cdr.StatP;
756 cdr.Stat = Acknowledge;
759 Gundam Battle Assault 2: much slower (*)
760 - Fixes boot, gameplay
762 Hokuto no Ken 2: slower
763 - Fixes intro + subtitles
765 InuYasha - Feudal Fairy Tale: slower
768 AddIrqQueue(CdlPause + 0x20, cdReadTime * 3);
772 case CdlPause + 0x20:
774 cdr.StatP &= ~STATUS_READ;
775 cdr.StatP |= STATUS_ROTATING;
776 cdr.Result[0] = cdr.StatP;
782 cdr.StatP = STATUS_ROTATING;
783 cdr.Result[0] = cdr.StatP;
784 cdr.Stat = Acknowledge;
786 AddIrqQueue(CdlInit + 0x20, 0x800);
792 cdr.Result[0] = cdr.StatP;
799 cdr.StatP |= STATUS_ROTATING;
800 cdr.Result[0] = cdr.StatP;
801 cdr.Stat = Acknowledge;
806 cdr.StatP |= STATUS_ROTATING;
807 cdr.Result[0] = cdr.StatP;
808 cdr.Stat = Acknowledge;
813 cdr.StatP |= STATUS_ROTATING;
814 cdr.Result[0] = cdr.StatP;
815 cdr.Stat = Acknowledge;
820 cdr.StatP |= STATUS_ROTATING;
821 cdr.Result[0] = cdr.StatP;
822 cdr.Stat = Acknowledge;
827 cdr.StatP |= STATUS_ROTATING;
828 cdr.Result[0] = cdr.StatP;
829 cdr.Result[1] = cdr.Mode;
830 cdr.Result[2] = cdr.File;
831 cdr.Result[3] = cdr.Channel;
834 cdr.Stat = Acknowledge;
839 for (i = 0; i < 8; i++)
840 cdr.Result[i] = cdr.Transfer[i];
841 cdr.Stat = Acknowledge;
846 memcpy(&cdr.Result, &cdr.subq, 8);
848 if (!cdr.Play && !cdr.Reading)
849 cdr.Result[1] = 0; // HACK?
851 cdr.Stat = Acknowledge;
855 // 5-Star Racing: don't stop CDDA
857 // Vib Ribbon: CD swap
862 cdr.StatP |= STATUS_ROTATING;
863 cdr.Result[0] = cdr.StatP;
864 if (CDR_getTN(cdr.ResultTN) == -1) {
865 cdr.Stat = DiskError;
866 cdr.Result[0] |= STATUS_ERROR;
868 cdr.Stat = Acknowledge;
869 cdr.Result[1] = itob(cdr.ResultTN[0]);
870 cdr.Result[2] = itob(cdr.ResultTN[1]);
876 cdr.Track = btoi(cdr.Param[0]);
878 cdr.StatP |= STATUS_ROTATING;
879 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
880 cdr.Stat = DiskError;
881 cdr.Result[0] |= STATUS_ERROR;
883 cdr.Stat = Acknowledge;
884 cdr.Result[0] = cdr.StatP;
885 cdr.Result[1] = itob(cdr.ResultTD[2]);
886 cdr.Result[2] = itob(cdr.ResultTD[1]);
887 cdr.Result[3] = itob(cdr.ResultTD[0]);
894 cdr.StatP |= STATUS_ROTATING;
895 cdr.Result[0] = cdr.StatP;
896 cdr.StatP |= STATUS_SEEK;
897 cdr.Stat = Acknowledge;
900 Crusaders of Might and Magic = 0.5x-4x
901 - fix cutscene speech start
907 - fix cutscene speech
912 CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
913 cdr.Seeked = SEEK_PENDING;
917 cdr.Stat = Acknowledge;
918 switch (cdr.Param[0]) {
919 case 0x20: // System Controller ROM Version
921 memcpy(cdr.Result, Test20, 4);
925 memcpy(cdr.Result, Test22, 4);
927 case 0x23: case 0x24:
929 memcpy(cdr.Result, Test23, 4);
936 cdr.StatP |= STATUS_ROTATING;
937 cdr.Result[0] = cdr.StatP;
938 cdr.Stat = Acknowledge;
939 AddIrqQueue(CdlID + 0x20, 0x800);
944 cdr.Result[0] = cdr.StatP;
949 // 0x10 - audio | 0x80 - unlicensed
950 if (CDR_getStatus(&stat) == -1) {
951 cdr.Result[1] = 0x80; // 0x80 leads to the menu in the bios, else loads CD
955 cdr.Result[1] |= 0x10;
956 if (CdromId[0] == '\0')
957 cdr.Result[1] |= 0x80;
959 cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
961 strncpy((char *)&cdr.Result[4], "PCSX", 4);
967 cdr.StatP = STATUS_ROTATING;
968 cdr.Result[0] = cdr.StatP;
969 cdr.Stat = Acknowledge;
974 cdr.StatP |= STATUS_ROTATING;
975 cdr.Result[0] = cdr.StatP;
976 cdr.Stat = Acknowledge;
977 AddIrqQueue(CdlReadT + 0x20, 0x800);
980 case CdlReadT + 0x20:
982 cdr.StatP |= STATUS_ROTATING;
983 cdr.Result[0] = cdr.StatP;
989 cdr.StatP |= STATUS_ROTATING;
990 cdr.Result[0] = cdr.StatP;
991 cdr.Stat = Acknowledge;
992 AddIrqQueue(CdlReadToc + 0x20, cdReadTime * 16);
995 case CdlReadToc + 0x20:
997 cdr.StatP |= STATUS_ROTATING;
998 cdr.Result[0] = cdr.StatP;
1004 if (!cdr.Reading) return;
1006 // Fighting Force 2 - update subq time immediately
1008 Find_CurTrack(cdr.SetSector);
1009 ReadTrack(cdr.SetSector);
1012 // Crusaders of Might and Magic - update getlocl now
1013 // - fixes cutscene speech
1015 u8 *buf = CDR_getBuffer();
1017 memcpy(cdr.Transfer, buf, 8);
1021 Duke Nukem: Land of the Babes - seek then delay read for one frame
1023 C-12 - Final Resistance - doesn't like seek
1026 if (cdr.Seeked != SEEK_DONE) {
1027 cdr.StatP |= STATUS_SEEK;
1028 cdr.StatP &= ~STATUS_READ;
1030 // Crusaders of Might and Magic - use short time
1031 // - fix cutscene speech (startup)
1033 // ??? - use more accurate seek time later
1034 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1036 cdr.StatP |= STATUS_READ;
1037 cdr.StatP &= ~STATUS_SEEK;
1039 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1043 cdr.StatP |= STATUS_ROTATING;
1044 cdr.Result[0] = cdr.StatP;
1045 cdr.Stat = Acknowledge;
1049 cdr.Stat = Complete;
1059 #ifdef CDR_LOG_CMD_IRQ
1060 SysPrintf("IRQ %d cmd %02x stat %02x: ",
1061 !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
1062 for (i = 0; i < cdr.ResultC; i++)
1063 SysPrintf("%02x ", cdr.Result[i]);
1068 #ifdef __ARM_ARCH_7A__
1069 #define ssat32_to_16(v) \
1070 asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
1072 #define ssat32_to_16(v) do { \
1073 if (v < -32768) v = -32768; \
1074 else if (v > 32767) v = 32767; \
1078 void cdrAttenuate(s16 *buf, int samples, int stereo)
1081 int ll = cdr.AttenuatorLeftToLeft;
1082 int lr = cdr.AttenuatorLeftToRight;
1083 int rl = cdr.AttenuatorRightToLeft;
1084 int rr = cdr.AttenuatorRightToRight;
1086 if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
1089 if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
1093 for (i = 0; i < samples; i++) {
1096 l = (l * ll + r * rl) >> 7;
1097 r = (r * rr + l * lr) >> 7;
1105 for (i = 0; i < samples; i++) {
1107 l = l * (ll + rl) >> 7;
1108 //r = r * (rr + lr) >> 7;
1116 void cdrReadInterrupt() {
1122 if (cdr.Irq || cdr.Stat) {
1123 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1130 cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1131 cdr.StatP &= ~STATUS_SEEK;
1132 cdr.Result[0] = cdr.StatP;
1133 cdr.Seeked = SEEK_DONE;
1135 ReadTrack(cdr.SetSector);
1137 buf = CDR_getBuffer();
1141 if (cdr.RErr == -1) {
1142 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1143 memset(cdr.Transfer, 0, DATA_SIZE);
1144 cdr.Stat = DiskError;
1145 cdr.Result[0] |= STATUS_ERROR;
1146 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1150 memcpy(cdr.Transfer, buf, DATA_SIZE);
1151 CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1154 CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1156 if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1157 // Firemen 2: Multi-XA files - briefings, cutscenes
1158 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1159 cdr.File = cdr.Transfer[4 + 0];
1160 cdr.Channel = cdr.Transfer[4 + 1];
1163 if((cdr.Transfer[4 + 2] & 0x4) &&
1164 (cdr.Transfer[4 + 1] == cdr.Channel) &&
1165 (cdr.Transfer[4 + 0] == cdr.File)) {
1166 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1168 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
1169 SPU_playADPCMchannel(&cdr.Xa);
1170 cdr.FirstSector = 0;
1172 else cdr.FirstSector = -1;
1177 if (cdr.SetSector[2] == 75) {
1178 cdr.SetSector[2] = 0;
1180 if (cdr.SetSector[1] == 60) {
1181 cdr.SetSector[1] = 0;
1188 CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
1191 Croc 2: $40 - only FORM1 (*)
1192 Judge Dredd: $C8 - only FORM1 (*)
1193 Sim Theme Park - no adpcm at all (zero)
1196 if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
1197 cdr.Stat = DataReady;
1201 // update for CdlGetlocP
1202 ReadTrack(cdr.SetSector);
1213 bit 5 - 1 result ready
1215 bit 7 - 1 command being processed
1218 unsigned char cdrRead0(void) {
1219 if (cdr.ResultReady)
1227 // cdr.Ctrl &= ~0x40;
1229 // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1232 CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1234 return psxHu8(0x1800) = cdr.Ctrl;
1237 void cdrWrite0(unsigned char rt) {
1238 CDR_LOG_IO("cdr w0: %02x\n", rt);
1240 cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1243 unsigned char cdrRead1(void) {
1244 if ((cdr.ResultP & 0xf) < cdr.ResultC)
1245 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1249 if (cdr.ResultP == cdr.ResultC)
1250 cdr.ResultReady = 0;
1252 CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1254 return psxHu8(0x1801);
1257 void cdrWrite1(unsigned char rt) {
1261 CDR_LOG_IO("cdr w1: %02x\n", rt);
1263 switch (cdr.Ctrl & 3) {
1267 cdr.AttenuatorRightToRightT = rt;
1276 #ifdef CDR_LOG_CMD_IRQ
1277 SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
1279 SysPrintf(" Param[%d] = {", cdr.ParamC);
1280 for (i = 0; i < cdr.ParamC; i++)
1281 SysPrintf(" %x,", cdr.Param[i]);
1288 cdr.ResultReady = 0;
1290 // cdr.Stat = NoIntr;
1291 AddIrqQueue(cdr.Cmd, 0x800);
1310 for (i = 0; i < 3; i++)
1311 set_loc[i] = btoi(cdr.Param[i]);
1313 // FIXME: clean up this SetSector/SetSectorPlay mess,
1314 // there should be single var tracking current sector pos
1316 i = msf2sec(cdr.SetSectorPlay);
1318 i = msf2sec(cdr.SetSector);
1319 i = abs(i - msf2sec(set_loc));
1321 cdr.Seeked = SEEK_PENDING;
1323 memcpy(cdr.SetSector, set_loc, 3);
1324 cdr.SetSector[3] = 0;
1328 // Vib Ribbon: try same track again
1331 // Vib Ribbon - decoded buffer IRQ for CDDA reading
1332 // - fixes ribbon timing + music CD mode
1333 //CDRDBUF_INT( PSXCLK / 44100 * 0x100 );
1337 cdr.StatP |= STATUS_SEEK;
1338 cdr.StatP &= ~STATUS_ROTATING;
1344 cdr.FirstSector = 1;
1354 // GameShark CD Player: Reset CDDA to track start
1356 // grab time for current track
1357 CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
1359 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
1360 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
1361 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
1370 GameShark CD Player: save time for resume
1372 Twisted Metal - World Tour: don't mix Setloc / CdlPlay cursors
1381 cdr.Seeked = SEEK_DONE;
1388 // Duke Nukem - Time to Kill
1389 // - do not directly set cd-xa volume
1390 //SPU_writeRegister( H_CDLeft, 0x0000 );
1391 //SPU_writeRegister( H_CDRight, 0x0000 );
1397 // Duke Nukem - Time to Kill
1398 // - do not directly set cd-xa volume
1399 //SPU_writeRegister( H_CDLeft, 0x7f00 );
1400 //SPU_writeRegister( H_CDRight, 0x7f00 );
1404 cdr.File = cdr.Param[0];
1405 cdr.Channel = cdr.Param[1];
1409 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1411 cdr.Mode = cdr.Param[0];
1413 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1414 // - fixes choppy movie sound
1415 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1420 //AddIrqQueue(cdr.Cmd, 0x800);
1422 // GameShark CDX CD Player: very long time
1423 AddIrqQueue(cdr.Cmd, 0x100000);
1428 // Tomb Raider 2 - reset cdda
1436 cdr.FirstSector = 1;
1442 CDR_LOG_I("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
1447 unsigned char cdrRead2(void) {
1450 if (cdr.Readed == 0) {
1456 CDR_LOG_IO("cdr r2: %02x\n", ret);
1460 void cdrWrite2(unsigned char rt) {
1461 CDR_LOG_IO("cdr w2: %02x\n", rt);
1463 switch (cdr.Ctrl & 3) {
1465 if (cdr.ParamC < 8) // FIXME: size and wrapping
1466 cdr.Param[cdr.ParamC++] = rt;
1473 cdr.AttenuatorLeftToLeftT = rt;
1476 cdr.AttenuatorRightToLeftT = rt;
1481 unsigned char cdrRead3(void) {
1483 psxHu8(0x1803) = cdr.Stat | 0xE0;
1485 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1487 CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1488 return psxHu8(0x1803);
1491 void cdrWrite3(unsigned char rt) {
1492 CDR_LOG_IO("cdr w3: %02x\n", rt);
1494 switch (cdr.Ctrl & 3) {
1504 cdr.AttenuatorLeftToRightT = rt;
1508 memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
1509 CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
1510 cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
1511 cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
1516 if ((rt & 0x80) && cdr.Readed == 0) {
1518 pTransfer = cdr.Transfer;
1520 switch (cdr.Mode & 0x30) {
1521 case MODE_SIZE_2328:
1526 case MODE_SIZE_2340:
1536 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1541 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1546 if (cdr.Readed == 0) {
1547 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1551 cdsize = (bcr & 0xffff) * 4;
1553 // Ape Escape: bcr = 0001 / 0000
1557 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
1558 case MODE_SIZE_2340: cdsize = 2340; break;
1559 case MODE_SIZE_2328: cdsize = 2328; break;
1561 case MODE_SIZE_2048: cdsize = 2048; break;
1566 ptr = (u8 *)PSXM(madr);
1568 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1573 GS CDX: Enhancement CD crash
1576 - Spams DMA3 and gets buffer overrun
1578 size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1583 memcpy(ptr, pTransfer, size);
1586 psxCpu->Clear(madr, cdsize / 4);
1587 pTransfer += cdsize;
1591 if( chcr == 0x11400100 ) {
1592 CDRDMA_INT( (cdsize/4) / 4 );
1594 else if( chcr == 0x11000000 ) {
1595 CDRDMA_INT( (cdsize/4) * 1 );
1600 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1604 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1608 void cdrDmaInterrupt()
1610 if (HW_DMA3_CHCR & SWAP32(0x01000000))
1612 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1617 static void getCdInfo(void)
1621 CDR_getTN(cdr.ResultTN);
1622 CDR_getTD(0, cdr.SetSectorEnd);
1623 tmp = cdr.SetSectorEnd[0];
1624 cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
1625 cdr.SetSectorEnd[2] = tmp;
1629 memset(&cdr, 0, sizeof(cdr));
1633 pTransfer = cdr.Transfer;
1635 // BIOS player - default values
1636 cdr.AttenuatorLeftToLeft = 0x80;
1637 cdr.AttenuatorLeftToRight = 0x00;
1638 cdr.AttenuatorRightToLeft = 0x00;
1639 cdr.AttenuatorRightToRight = 0x80;
1644 int cdrFreeze(void *f, int Mode) {
1648 if (Mode == 0 && !Config.Cdda)
1651 cdr.freeze_ver = 0x63647201;
1652 gzfreeze(&cdr, sizeof(cdr));
1655 cdr.ParamP = cdr.ParamC;
1656 tmp = pTransfer - cdr.Transfer;
1659 gzfreeze(&tmp, sizeof(tmp));
1664 pTransfer = cdr.Transfer + tmp;
1666 // read right sub data
1667 memcpy(tmpp, cdr.Prev, 3);
1672 Find_CurTrack(cdr.SetSectorPlay);
1674 CDR_play(cdr.SetSectorPlay);
1677 if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
1678 // old versions did not latch Reg2, have to fixup..
1679 if (cdr.Reg2 == 0) {
1680 SysPrintf("cdrom: fixing up old savestate\n");
1689 void LidInterrupt() {
1690 cdr.LidCheck = 0x20; // start checker
1695 CDRLID_INT( cdReadTime * 3 );
1697 // generate interrupt if none active - open or close
1698 if (cdr.Irq == 0 || cdr.Irq == 0xff) {
1701 AddIrqQueue(CdlNop, 0x800);