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 02110-1301 USA. *
18 ***************************************************************************/
21 * Handles all CD-ROM registers and functions.
27 #include "arm_features.h"
31 #define CDR_LOG SysPrintf
36 #define CDR_LOG_I SysPrintf
38 #define CDR_LOG_I(...)
41 #define CDR_LOG_IO SysPrintf
43 #define CDR_LOG_IO(...)
45 //#define CDR_LOG_CMD_IRQ
48 static unsigned char *pTransfer;
50 /* CD-ROM magic numbers */
51 #define CdlSync 0 /* nocash documentation : "Uh, actually, returns error code 40h = Invalid Command...?" */
64 #define CdlSetfilter 13
66 #define CdlGetparam 15
74 #define CdlSetclock 23
75 #define CdlGetclock 24
83 char *CmdName[0x100]= {
84 "CdlSync", "CdlNop", "CdlSetloc", "CdlPlay",
85 "CdlForward", "CdlBackward", "CdlReadN", "CdlStandby",
86 "CdlStop", "CdlPause", "CdlReset", "CdlMute",
87 "CdlDemute", "CdlSetfilter", "CdlSetmode", "CdlGetparam",
88 "CdlGetlocL", "CdlGetlocP", "CdlReadT", "CdlGetTN",
89 "CdlGetTD", "CdlSeekL", "CdlSeekP", "CdlSetclock",
90 "CdlGetclock", "CdlTest", "CdlID", "CdlReadS",
91 "CdlInit", NULL, "CDlReadToc", NULL
94 unsigned char Test04[] = { 0 };
95 unsigned char Test05[] = { 0 };
96 unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
97 unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
98 unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
104 #define Acknowledge 3
109 #define MODE_SPEED (1<<7) // 0x80
110 #define MODE_STRSND (1<<6) // 0x40 ADPCM on/off
111 #define MODE_SIZE_2340 (1<<5) // 0x20
112 #define MODE_SIZE_2328 (1<<4) // 0x10
113 #define MODE_SIZE_2048 (0<<4) // 0x00
114 #define MODE_SF (1<<3) // 0x08 channel on/off
115 #define MODE_REPORT (1<<2) // 0x04
116 #define MODE_AUTOPAUSE (1<<1) // 0x02
117 #define MODE_CDDA (1<<0) // 0x01
120 #define STATUS_PLAY (1<<7) // 0x80
121 #define STATUS_SEEK (1<<6) // 0x40
122 #define STATUS_READ (1<<5) // 0x20
123 #define STATUS_SHELLOPEN (1<<4) // 0x10
124 #define STATUS_UNKNOWN3 (1<<3) // 0x08
125 #define STATUS_UNKNOWN2 (1<<2) // 0x04
126 #define STATUS_ROTATING (1<<1) // 0x02
127 #define STATUS_ERROR (1<<0) // 0x01
130 #define ERROR_NOTREADY (1<<7) // 0x80
131 #define ERROR_INVALIDCMD (1<<6) // 0x40
132 #define ERROR_INVALIDARG (1<<5) // 0x20
134 // 1x = 75 sectors per second
135 // PSXCLK = 1 sec in the ps
136 // so (PSXCLK / 75) = cdr read time (linuzappz)
137 #define cdReadTime (PSXCLK / 75)
140 DRIVESTATE_STANDBY = 0,
142 DRIVESTATE_RESCAN_CD,
143 DRIVESTATE_PREPARE_CD,
153 static struct CdrStat stat;
155 static unsigned int msf2sec(const u8 *msf) {
156 return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
159 // for that weird psemu API..
160 static unsigned int fsm2sec(const u8 *msf) {
161 return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
164 static void sec2msf(unsigned int s, u8 *msf) {
165 msf[0] = s / 75 / 60;
166 s = s - msf[0] * 75 * 60;
173 #define CDR_INT(eCycle) { \
174 psxRegs.interrupt |= (1 << PSXINT_CDR); \
175 psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
176 psxRegs.intCycle[PSXINT_CDR].sCycle = psxRegs.cycle; \
177 new_dyna_set_event(PSXINT_CDR, eCycle); \
181 #define CDREAD_INT(eCycle) { \
182 psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
183 psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
184 psxRegs.intCycle[PSXINT_CDREAD].sCycle = psxRegs.cycle; \
185 new_dyna_set_event(PSXINT_CDREAD, eCycle); \
188 // cdrLidSeekInterrupt
189 #define CDRLID_INT(eCycle) { \
190 psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
191 psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
192 psxRegs.intCycle[PSXINT_CDRLID].sCycle = psxRegs.cycle; \
193 new_dyna_set_event(PSXINT_CDRLID, eCycle); \
197 #define CDRMISC_INT(eCycle) { \
198 psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
199 psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
200 psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
201 new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
204 #define StopReading() { \
207 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
209 cdr.StatP &= ~(STATUS_READ|STATUS_SEEK);\
212 #define StopCdda() { \
214 if (!Config.Cdda) CDR_stop(); \
215 cdr.StatP &= ~STATUS_PLAY; \
217 cdr.FastForward = 0; \
218 cdr.FastBackward = 0; \
219 /*SPU_registerCallback( SPUirq );*/ \
223 #define SetResultSize(size) { \
225 cdr.ResultC = size; \
226 cdr.ResultReady = 1; \
229 static void setIrq(void)
231 if (cdr.Stat & cdr.Reg2)
232 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
235 // timing used in this function was taken from tests on real hardware
236 // (yes it's slow, but you probably don't want to modify it)
237 void cdrLidSeekInterrupt()
239 switch (cdr.DriveState) {
241 case DRIVESTATE_STANDBY:
242 cdr.StatP &= ~STATUS_SEEK;
244 if (CDR_getStatus(&stat) == -1)
247 if (stat.Status & STATUS_SHELLOPEN)
250 cdr.DriveState = DRIVESTATE_LID_OPEN;
255 case DRIVESTATE_LID_OPEN:
256 if (CDR_getStatus(&stat) == -1)
257 stat.Status &= ~STATUS_SHELLOPEN;
260 if (!(cdr.StatP & STATUS_SHELLOPEN)) {
262 cdr.StatP |= STATUS_SHELLOPEN;
264 // could generate error irq here, but real hardware
265 // only sometimes does that
266 // (not done when lots of commands are sent?)
268 CDRLID_INT(cdReadTime * 30);
271 else if (cdr.StatP & STATUS_ROTATING) {
272 cdr.StatP &= ~STATUS_ROTATING;
274 else if (!(stat.Status & STATUS_SHELLOPEN)) {
278 // cdr.StatP STATUS_SHELLOPEN is "sticky"
279 // and is only cleared by CdlNop
281 cdr.DriveState = DRIVESTATE_RESCAN_CD;
282 CDRLID_INT(cdReadTime * 105);
287 CDRLID_INT(cdReadTime * 3);
290 case DRIVESTATE_RESCAN_CD:
291 cdr.StatP |= STATUS_ROTATING;
292 cdr.DriveState = DRIVESTATE_PREPARE_CD;
294 // this is very long on real hardware, over 6 seconds
295 // make it a bit faster here...
296 CDRLID_INT(cdReadTime * 150);
299 case DRIVESTATE_PREPARE_CD:
300 cdr.StatP |= STATUS_SEEK;
302 cdr.DriveState = DRIVESTATE_STANDBY;
303 CDRLID_INT(cdReadTime * 26);
308 static void Find_CurTrack(const u8 *time)
312 current = msf2sec(time);
314 for (cdr.CurTrack = 1; cdr.CurTrack < cdr.ResultTN[1]; cdr.CurTrack++) {
315 CDR_getTD(cdr.CurTrack + 1, cdr.ResultTD);
316 sect = fsm2sec(cdr.ResultTD);
317 if (sect - current >= 150)
322 static void generate_subq(const u8 *time)
324 unsigned char start[3], next[3];
325 unsigned int this_s, start_s, next_s, pregap;
328 CDR_getTD(cdr.CurTrack, start);
329 if (cdr.CurTrack + 1 <= cdr.ResultTN[1]) {
331 CDR_getTD(cdr.CurTrack + 1, next);
334 // last track - cd size
336 next[0] = cdr.SetSectorEnd[2];
337 next[1] = cdr.SetSectorEnd[1];
338 next[2] = cdr.SetSectorEnd[0];
341 this_s = msf2sec(time);
342 start_s = fsm2sec(start);
343 next_s = fsm2sec(next);
345 cdr.TrackChanged = FALSE;
347 if (next_s - this_s < pregap) {
348 cdr.TrackChanged = TRUE;
355 relative_s = this_s - start_s;
356 if (relative_s < 0) {
358 relative_s = -relative_s;
360 sec2msf(relative_s, cdr.subq.Relative);
362 cdr.subq.Track = itob(cdr.CurTrack);
363 cdr.subq.Relative[0] = itob(cdr.subq.Relative[0]);
364 cdr.subq.Relative[1] = itob(cdr.subq.Relative[1]);
365 cdr.subq.Relative[2] = itob(cdr.subq.Relative[2]);
366 cdr.subq.Absolute[0] = itob(time[0]);
367 cdr.subq.Absolute[1] = itob(time[1]);
368 cdr.subq.Absolute[2] = itob(time[2]);
371 static void ReadTrack(const u8 *time) {
372 unsigned char tmp[3];
376 tmp[0] = itob(time[0]);
377 tmp[1] = itob(time[1]);
378 tmp[2] = itob(time[2]);
380 if (memcmp(cdr.Prev, tmp, 3) == 0)
383 CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
385 cdr.RErr = CDR_readTrack(tmp);
386 memcpy(cdr.Prev, tmp, 3);
391 subq = (struct SubQ *)CDR_getBufferSub();
392 if (subq != NULL && cdr.CurTrack == 1) {
393 crc = calcCrc((u8 *)subq + 12, 10);
394 if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
395 cdr.subq.Track = subq->TrackNumber;
396 cdr.subq.Index = subq->IndexNumber;
397 memcpy(cdr.subq.Relative, subq->TrackRelativeAddress, 3);
398 memcpy(cdr.subq.Absolute, subq->AbsoluteAddress, 3);
401 CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
402 tmp[0], tmp[1], tmp[2]);
409 CDR_LOG(" -> %02x,%02x %02x:%02x:%02x %02x:%02x:%02x\n",
410 cdr.subq.Track, cdr.subq.Index,
411 cdr.subq.Relative[0], cdr.subq.Relative[1], cdr.subq.Relative[2],
412 cdr.subq.Absolute[0], cdr.subq.Absolute[1], cdr.subq.Absolute[2]);
415 static void AddIrqQueue(unsigned short irq, unsigned long ecycle) {
417 if (irq == cdr.Irq || irq + 0x100 == cdr.Irq) {
423 CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
432 static void cdrPlayInterrupt_Autopause()
434 if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
435 CDR_LOG( "CDDA STOP\n" );
437 // Magic the Gathering
438 // - looping territory cdda
441 //cdr.ResultReady = 1;
442 //cdr.Stat = DataReady;
448 else if (cdr.Mode & MODE_REPORT) {
450 cdr.Result[0] = cdr.StatP;
451 cdr.Result[1] = cdr.subq.Track;
452 cdr.Result[2] = cdr.subq.Index;
454 if (cdr.subq.Absolute[2] & 0x10) {
455 cdr.Result[3] = cdr.subq.Relative[0];
456 cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
457 cdr.Result[5] = cdr.subq.Relative[2];
460 cdr.Result[3] = cdr.subq.Absolute[0];
461 cdr.Result[4] = cdr.subq.Absolute[1];
462 cdr.Result[5] = cdr.subq.Absolute[2];
468 // Rayman: Logo freeze (resultready + dataready)
470 cdr.Stat = DataReady;
478 void cdrPlayInterrupt()
480 if (cdr.Seeked == SEEK_PENDING) {
482 CDR_LOG_I("cdrom: seek stat hack\n");
487 cdr.StatP |= STATUS_ROTATING;
488 cdr.StatP &= ~STATUS_SEEK;
489 cdr.Result[0] = cdr.StatP;
490 cdr.Seeked = SEEK_DONE;
496 if (cdr.SetlocPending) {
497 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
498 cdr.SetlocPending = 0;
499 cdr.m_locationChanged = TRUE;
501 Find_CurTrack(cdr.SetSectorPlay);
502 ReadTrack(cdr.SetSectorPlay);
503 cdr.TrackChanged = FALSE;
506 if (!cdr.Play) return;
508 CDR_LOG( "CDDA - %d:%d:%d\n",
509 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
511 if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
513 cdr.TrackChanged = TRUE;
516 if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
517 cdrPlayInterrupt_Autopause();
519 if (!cdr.Play) return;
521 cdr.SetSectorPlay[2]++;
522 if (cdr.SetSectorPlay[2] == 75) {
523 cdr.SetSectorPlay[2] = 0;
524 cdr.SetSectorPlay[1]++;
525 if (cdr.SetSectorPlay[1] == 60) {
526 cdr.SetSectorPlay[1] = 0;
527 cdr.SetSectorPlay[0]++;
531 if (cdr.m_locationChanged)
533 CDRMISC_INT(cdReadTime * 30);
534 cdr.m_locationChanged = FALSE;
538 CDRMISC_INT(cdReadTime);
541 // update for CdlGetlocP/autopause
542 generate_subq(cdr.SetSectorPlay);
545 void cdrInterrupt() {
547 int no_busy_error = 0;
548 int start_rotating = 0;
551 unsigned int seekTime = 0;
555 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
564 cdr.Result[0] = cdr.StatP;
565 cdr.Stat = Acknowledge;
567 if (cdr.IrqRepeated) {
569 if (cdr.eCycle > psxRegs.cycle) {
579 if (cdr.DriveState != DRIVESTATE_LID_OPEN)
580 cdr.StatP &= ~STATUS_SHELLOPEN;
590 if (cdr.Seeked == SEEK_PENDING) {
591 // XXX: wrong, should seek instead..
592 cdr.Seeked = SEEK_DONE;
594 if (cdr.SetlocPending) {
595 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
596 cdr.SetlocPending = 0;
597 cdr.m_locationChanged = TRUE;
601 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
603 if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
604 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
605 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
609 int track = btoi( cdr.Param[0] );
611 if (track <= cdr.ResultTN[1])
612 cdr.CurTrack = track;
614 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
616 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
617 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
618 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
619 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
624 Rayman: detect track changes
627 Twisted Metal 2: skip PREGAP + starting accurate SubQ
628 - plays tracks without retry play
630 Wild 9: skip PREGAP + starting accurate SubQ
631 - plays tracks without retry play
633 Find_CurTrack(cdr.SetSectorPlay);
634 ReadTrack(cdr.SetSectorPlay);
635 cdr.TrackChanged = FALSE;
638 CDR_play(cdr.SetSectorPlay);
640 // Vib Ribbon: gameplay checks flag
641 cdr.StatP &= ~STATUS_SEEK;
642 cdr.Result[0] = cdr.StatP;
644 cdr.StatP |= STATUS_PLAY;
646 // BIOS player - set flag again
649 CDRMISC_INT( cdReadTime );
654 // TODO: error 80 if stopped
657 // GameShark CD Player: Calls 2x + Play 2x
658 if( cdr.FastForward == 0 ) cdr.FastForward = 2;
659 else cdr.FastForward++;
661 cdr.FastBackward = 0;
667 // GameShark CD Player: Calls 2x + Play 2x
668 if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
669 else cdr.FastBackward++;
675 if (cdr.DriveState != DRIVESTATE_STOPPED) {
676 error = ERROR_INVALIDARG;
679 AddIrqQueue(CdlStandby + 0x100, cdReadTime * 125 / 2);
683 case CdlStandby + 0x100:
689 // grab time for current track
690 CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
692 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
693 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
694 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
701 if (cdr.DriveState == DRIVESTATE_STANDBY)
702 delay = cdReadTime * 30 / 2;
704 cdr.DriveState = DRIVESTATE_STOPPED;
705 AddIrqQueue(CdlStop + 0x100, delay);
708 case CdlStop + 0x100:
709 cdr.StatP &= ~STATUS_ROTATING;
710 cdr.Result[0] = cdr.StatP;
716 Gundam Battle Assault 2: much slower (*)
717 - Fixes boot, gameplay
719 Hokuto no Ken 2: slower
720 - Fixes intro + subtitles
722 InuYasha - Feudal Fairy Tale: slower
725 /* Gameblabla - Tightening the timings (as taken from Duckstation).
726 * The timings from Duckstation are based upon hardware tests.
727 * Mednafen's timing don't work for Gundam Battle Assault 2 in PAL/50hz mode,
728 * seems to be timing sensitive as it can depend on the CPU's clock speed.
730 if (cdr.DriveState != DRIVESTATE_STANDBY)
736 delay = (((cdr.Mode & MODE_SPEED) ? 2 : 1) * (1000000));
737 CDRMISC_INT((cdr.Mode & MODE_SPEED) ? cdReadTime / 2 : cdReadTime);
739 AddIrqQueue(CdlPause + 0x100, delay);
743 case CdlPause + 0x100:
744 cdr.StatP &= ~STATUS_READ;
745 cdr.Result[0] = cdr.StatP;
751 cdr.Mode = 0x20; /* This fixes This is Football 2, Pooh's Party lockups */
752 AddIrqQueue(CdlReset + 0x100, 4100000);
757 case CdlReset + 0x100:
770 cdr.File = cdr.Param[0];
771 cdr.Channel = cdr.Param[1];
779 /* Gameblabla : According to mednafen, Result size should be 5 and done this way. */
781 cdr.Result[1] = cdr.Mode;
783 cdr.Result[3] = cdr.File;
784 cdr.Result[4] = cdr.Channel;
790 memcpy(cdr.Result, cdr.Transfer, 8);
795 memcpy(&cdr.Result, &cdr.subq, 8);
797 if (!cdr.Play && !cdr.Reading)
798 cdr.Result[1] = 0; // HACK?
801 case CdlReadT: // SetSession?
803 AddIrqQueue(CdlReadT + 0x100, cdReadTime * 290 / 4);
807 case CdlReadT + 0x100:
813 if (CDR_getTN(cdr.ResultTN) == -1) {
814 cdr.Stat = DiskError;
815 cdr.Result[0] |= STATUS_ERROR;
817 cdr.Stat = Acknowledge;
818 cdr.Result[1] = itob(cdr.ResultTN[0]);
819 cdr.Result[2] = itob(cdr.ResultTN[1]);
824 cdr.Track = btoi(cdr.Param[0]);
826 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
827 cdr.Stat = DiskError;
828 cdr.Result[0] |= STATUS_ERROR;
830 cdr.Stat = Acknowledge;
831 cdr.Result[0] = cdr.StatP;
832 cdr.Result[1] = itob(cdr.ResultTD[2]);
833 cdr.Result[2] = itob(cdr.ResultTD[1]);
834 /* According to Nocash's documentation, the function doesn't care about ff.
835 * This can be seen also in Mednafen's implementation. */
836 //cdr.Result[3] = itob(cdr.ResultTD[0]);
844 cdr.StatP |= STATUS_SEEK;
847 Crusaders of Might and Magic = 0.5x-4x
848 - fix cutscene speech start
854 - fix cutscene speech
859 CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
860 cdr.Seeked = SEEK_PENDING;
865 switch (cdr.Param[0]) {
866 case 0x20: // System Controller ROM Version
868 memcpy(cdr.Result, Test20, 4);
872 memcpy(cdr.Result, Test22, 4);
874 case 0x23: case 0x24:
876 memcpy(cdr.Result, Test23, 4);
883 AddIrqQueue(CdlID + 0x100, 20480);
888 cdr.Result[0] = cdr.StatP;
893 // 0x10 - audio | 0x40 - disk missing | 0x80 - unlicensed
894 if (CDR_getStatus(&stat) == -1 || stat.Type == 0 || stat.Type == 0xff) {
895 cdr.Result[1] = 0xc0;
899 cdr.Result[1] |= 0x10;
900 if (CdromId[0] == '\0')
901 cdr.Result[1] |= 0x80;
903 cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
905 strncpy((char *)&cdr.Result[4], "PCSX", 4);
910 // yes, it really sets STATUS_SHELLOPEN
911 cdr.StatP |= STATUS_SHELLOPEN;
912 cdr.DriveState = DRIVESTATE_RESCAN_CD;
923 AddIrqQueue(CdlReadToc + 0x100, cdReadTime * 180 / 4);
928 case CdlReadToc + 0x100:
935 if (cdr.SetlocPending) {
936 seekTime = abs(msf2sec(cdr.SetSectorPlay) - msf2sec(cdr.SetSector)) * (cdReadTime / 200);
937 if(seekTime > 1000000) seekTime = 1000000;
938 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
939 cdr.SetlocPending = 0;
940 cdr.m_locationChanged = TRUE;
942 Find_CurTrack(cdr.SetSectorPlay);
944 if ((cdr.Mode & MODE_CDDA) && cdr.CurTrack > 1)
945 // Read* acts as play for cdda tracks in cdda mode
951 // Fighting Force 2 - update subq time immediately
953 ReadTrack(cdr.SetSectorPlay);
956 // Crusaders of Might and Magic - update getlocl now
957 // - fixes cutscene speech
959 u8 *buf = CDR_getBuffer();
961 memcpy(cdr.Transfer, buf, 8);
965 Duke Nukem: Land of the Babes - seek then delay read for one frame
967 C-12 - Final Resistance - doesn't like seek
970 if (cdr.Seeked != SEEK_DONE) {
971 cdr.StatP |= STATUS_SEEK;
972 cdr.StatP &= ~STATUS_READ;
974 // Crusaders of Might and Magic - use short time
975 // - fix cutscene speech (startup)
977 // ??? - use more accurate seek time later
978 CDREAD_INT(((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1) + seekTime);
980 cdr.StatP |= STATUS_READ;
981 cdr.StatP &= ~STATUS_SEEK;
983 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
986 cdr.Result[0] = cdr.StatP;
991 CDR_LOG_I("Invalid command: %02x\n", Irq);
992 error = ERROR_INVALIDCMD;
997 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
998 cdr.Result[1] = error;
999 cdr.Stat = DiskError;
1003 if (cdr.DriveState == DRIVESTATE_STOPPED && start_rotating) {
1004 cdr.DriveState = DRIVESTATE_STANDBY;
1005 cdr.StatP |= STATUS_ROTATING;
1008 if (!no_busy_error) {
1009 switch (cdr.DriveState) {
1010 case DRIVESTATE_LID_OPEN:
1011 case DRIVESTATE_RESCAN_CD:
1012 case DRIVESTATE_PREPARE_CD:
1014 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
1015 cdr.Result[1] = ERROR_NOTREADY;
1016 cdr.Stat = DiskError;
1025 #ifdef CDR_LOG_CMD_IRQ
1028 SysPrintf("CDR IRQ %d cmd %02x stat %02x: ",
1029 !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
1030 for (i = 0; i < cdr.ResultC; i++)
1031 SysPrintf("%02x ", cdr.Result[i]);
1038 #define ssat32_to_16(v) \
1039 asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
1041 #define ssat32_to_16(v) do { \
1042 if (v < -32768) v = -32768; \
1043 else if (v > 32767) v = 32767; \
1047 void cdrAttenuate(s16 *buf, int samples, int stereo)
1050 int ll = cdr.AttenuatorLeftToLeft;
1051 int lr = cdr.AttenuatorLeftToRight;
1052 int rl = cdr.AttenuatorRightToLeft;
1053 int rr = cdr.AttenuatorRightToRight;
1055 if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
1058 if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
1062 for (i = 0; i < samples; i++) {
1065 l = (l * ll + r * rl) >> 7;
1066 r = (r * rr + l * lr) >> 7;
1074 for (i = 0; i < samples; i++) {
1076 l = l * (ll + rl) >> 7;
1077 //r = r * (rr + lr) >> 7;
1085 void cdrReadInterrupt() {
1091 if (cdr.Irq || cdr.Stat) {
1092 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1099 cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1100 cdr.StatP &= ~STATUS_SEEK;
1101 cdr.Result[0] = cdr.StatP;
1102 cdr.Seeked = SEEK_DONE;
1104 ReadTrack(cdr.SetSectorPlay);
1106 buf = CDR_getBuffer();
1110 if (cdr.RErr == -1) {
1111 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1112 memset(cdr.Transfer, 0, DATA_SIZE);
1113 cdr.Stat = DiskError;
1114 cdr.Result[0] |= STATUS_ERROR;
1115 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1119 memcpy(cdr.Transfer, buf, DATA_SIZE);
1120 CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1123 CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1125 if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1126 // Firemen 2: Multi-XA files - briefings, cutscenes
1127 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1128 cdr.File = cdr.Transfer[4 + 0];
1129 cdr.Channel = cdr.Transfer[4 + 1];
1133 * Skips playing on channel 255.
1134 * Fixes missing audio in Blue's Clues : Blue's Big Musical. (Should also fix Taxi 2)
1135 * TODO : Check if this is the proper behaviour.
1137 if((cdr.Transfer[4 + 2] & 0x4) &&
1138 (cdr.Transfer[4 + 1] == cdr.Channel) &&
1139 (cdr.Transfer[4 + 0] == cdr.File) && cdr.Channel != 255) {
1140 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1142 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
1143 SPU_playADPCMchannel(&cdr.Xa);
1144 cdr.FirstSector = 0;
1146 else cdr.FirstSector = -1;
1150 cdr.SetSectorPlay[2]++;
1151 if (cdr.SetSectorPlay[2] == 75) {
1152 cdr.SetSectorPlay[2] = 0;
1153 cdr.SetSectorPlay[1]++;
1154 if (cdr.SetSectorPlay[1] == 60) {
1155 cdr.SetSectorPlay[1] = 0;
1156 cdr.SetSectorPlay[0]++;
1162 uint32_t delay = (cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime;
1163 if (cdr.m_locationChanged) {
1164 CDREAD_INT(delay * 30);
1165 cdr.m_locationChanged = FALSE;
1171 Croc 2: $40 - only FORM1 (*)
1172 Judge Dredd: $C8 - only FORM1 (*)
1173 Sim Theme Park - no adpcm at all (zero)
1176 if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
1177 cdr.Stat = DataReady;
1181 // update for CdlGetlocP
1182 ReadTrack(cdr.SetSectorPlay);
1191 bit 5 - 1 result ready
1193 bit 7 - 1 command being processed
1196 unsigned char cdrRead0(void) {
1197 if (cdr.ResultReady)
1205 // cdr.Ctrl &= ~0x40;
1207 // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1210 CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1212 return psxHu8(0x1800) = cdr.Ctrl;
1215 void cdrWrite0(unsigned char rt) {
1216 CDR_LOG_IO("cdr w0: %02x\n", rt);
1218 cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1221 unsigned char cdrRead1(void) {
1222 if ((cdr.ResultP & 0xf) < cdr.ResultC)
1223 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1227 if (cdr.ResultP == cdr.ResultC)
1228 cdr.ResultReady = 0;
1230 CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1232 return psxHu8(0x1801);
1235 void cdrWrite1(unsigned char rt) {
1239 CDR_LOG_IO("cdr w1: %02x\n", rt);
1241 switch (cdr.Ctrl & 3) {
1245 cdr.AttenuatorRightToRightT = rt;
1254 #ifdef CDR_LOG_CMD_IRQ
1255 SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
1257 SysPrintf(" Param[%d] = {", cdr.ParamC);
1258 for (i = 0; i < cdr.ParamC; i++)
1259 SysPrintf(" %x,", cdr.Param[i]);
1266 cdr.ResultReady = 0;
1268 // cdr.Stat = NoIntr;
1269 AddIrqQueue(cdr.Cmd, 0x800);
1273 CDR_LOG("CDROM setloc command (%02X, %02X, %02X)\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1275 // MM must be BCD, SS must be BCD and <0x60, FF must be BCD and <0x75
1276 if (((cdr.Param[0] & 0x0F) > 0x09) || (cdr.Param[0] > 0x99) || ((cdr.Param[1] & 0x0F) > 0x09) || (cdr.Param[1] >= 0x60) || ((cdr.Param[2] & 0x0F) > 0x09) || (cdr.Param[2] >= 0x75))
1278 CDR_LOG("Invalid/out of range seek to %02X:%02X:%02X\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1282 for (i = 0; i < 3; i++)
1284 set_loc[i] = btoi(cdr.Param[i]);
1287 i = msf2sec(cdr.SetSectorPlay);
1288 i = abs(i - msf2sec(set_loc));
1290 cdr.Seeked = SEEK_PENDING;
1292 memcpy(cdr.SetSector, set_loc, 3);
1293 cdr.SetSector[3] = 0;
1294 cdr.SetlocPending = 1;
1307 cdr.Seeked = SEEK_DONE;
1313 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1315 cdr.Mode = cdr.Param[0];
1317 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1318 // - fixes choppy movie sound
1319 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1325 unsigned char cdrRead2(void) {
1328 if (cdr.Readed == 0) {
1334 CDR_LOG_IO("cdr r2: %02x\n", ret);
1338 void cdrWrite2(unsigned char rt) {
1339 CDR_LOG_IO("cdr w2: %02x\n", rt);
1341 switch (cdr.Ctrl & 3) {
1343 if (cdr.ParamC < 8) // FIXME: size and wrapping
1344 cdr.Param[cdr.ParamC++] = rt;
1351 cdr.AttenuatorLeftToLeftT = rt;
1354 cdr.AttenuatorRightToLeftT = rt;
1359 unsigned char cdrRead3(void) {
1361 psxHu8(0x1803) = cdr.Stat | 0xE0;
1363 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1365 CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1366 return psxHu8(0x1803);
1369 void cdrWrite3(unsigned char rt) {
1370 CDR_LOG_IO("cdr w3: %02x\n", rt);
1372 switch (cdr.Ctrl & 3) {
1382 cdr.AttenuatorLeftToRightT = rt;
1386 memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
1387 CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
1388 cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
1389 cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
1394 if ((rt & 0x80) && cdr.Readed == 0) {
1396 pTransfer = cdr.Transfer;
1398 switch (cdr.Mode & 0x30) {
1399 case MODE_SIZE_2328:
1404 case MODE_SIZE_2340:
1414 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1419 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1424 if (cdr.Readed == 0) {
1425 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1429 cdsize = (bcr & 0xffff) * 4;
1431 // Ape Escape: bcr = 0001 / 0000
1435 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
1436 case MODE_SIZE_2340: cdsize = 2340; break;
1437 case MODE_SIZE_2328: cdsize = 2328; break;
1439 case MODE_SIZE_2048: cdsize = 2048; break;
1444 ptr = (u8 *)PSXM(madr);
1446 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1451 GS CDX: Enhancement CD crash
1454 - Spams DMA3 and gets buffer overrun
1456 size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1461 memcpy(ptr, pTransfer, size);
1464 psxCpu->Clear(madr, cdsize / 4);
1465 pTransfer += cdsize;
1467 if( chcr == 0x11400100 ) {
1468 HW_DMA3_MADR = SWAPu32(madr + cdsize);
1469 CDRDMA_INT( (cdsize/4) / 4 );
1471 else if( chcr == 0x11000000 ) {
1472 // CDRDMA_INT( (cdsize/4) * 1 );
1474 psxRegs.cycle += (cdsize/4) * 24/2;
1480 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1484 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1488 void cdrDmaInterrupt()
1490 if (HW_DMA3_CHCR & SWAP32(0x01000000))
1492 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1497 static void getCdInfo(void)
1501 CDR_getTN(cdr.ResultTN);
1502 CDR_getTD(0, cdr.SetSectorEnd);
1503 tmp = cdr.SetSectorEnd[0];
1504 cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
1505 cdr.SetSectorEnd[2] = tmp;
1509 memset(&cdr, 0, sizeof(cdr));
1515 cdr.DriveState = DRIVESTATE_STANDBY;
1516 cdr.StatP = STATUS_ROTATING;
1517 pTransfer = cdr.Transfer;
1518 cdr.SetlocPending = 0;
1519 cdr.m_locationChanged = FALSE;
1521 // BIOS player - default values
1522 cdr.AttenuatorLeftToLeft = 0x80;
1523 cdr.AttenuatorLeftToRight = 0x00;
1524 cdr.AttenuatorRightToLeft = 0x00;
1525 cdr.AttenuatorRightToRight = 0x80;
1530 int cdrFreeze(void *f, int Mode) {
1534 if (Mode == 0 && !Config.Cdda)
1537 cdr.freeze_ver = 0x63647202;
1538 gzfreeze(&cdr, sizeof(cdr));
1541 cdr.ParamP = cdr.ParamC;
1542 tmp = pTransfer - cdr.Transfer;
1545 gzfreeze(&tmp, sizeof(tmp));
1550 pTransfer = cdr.Transfer + tmp;
1552 // read right sub data
1553 tmpp[0] = btoi(cdr.Prev[0]);
1554 tmpp[1] = btoi(cdr.Prev[1]);
1555 tmpp[2] = btoi(cdr.Prev[2]);
1560 if (cdr.freeze_ver < 0x63647202)
1561 memcpy(cdr.SetSectorPlay, cdr.SetSector, 3);
1563 Find_CurTrack(cdr.SetSectorPlay);
1565 CDR_play(cdr.SetSectorPlay);
1568 if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
1569 // old versions did not latch Reg2, have to fixup..
1570 if (cdr.Reg2 == 0) {
1571 SysPrintf("cdrom: fixing up old savestate\n");
1574 // also did not save Attenuator..
1575 if ((cdr.AttenuatorLeftToLeft | cdr.AttenuatorLeftToRight
1576 | cdr.AttenuatorRightToLeft | cdr.AttenuatorRightToRight) == 0)
1578 cdr.AttenuatorLeftToLeft = cdr.AttenuatorRightToRight = 0x80;
1586 void LidInterrupt() {
1589 cdrLidSeekInterrupt();