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;
49 static s16 read_buf[CD_FRAMESIZE_RAW/2];
51 /* CD-ROM magic numbers */
52 #define CdlSync 0 /* nocash documentation : "Uh, actually, returns error code 40h = Invalid Command...?" */
65 #define CdlSetfilter 13
67 #define CdlGetparam 15
75 #define CdlSetclock 23
76 #define CdlGetclock 24
84 char *CmdName[0x100]= {
85 "CdlSync", "CdlNop", "CdlSetloc", "CdlPlay",
86 "CdlForward", "CdlBackward", "CdlReadN", "CdlStandby",
87 "CdlStop", "CdlPause", "CdlReset", "CdlMute",
88 "CdlDemute", "CdlSetfilter", "CdlSetmode", "CdlGetparam",
89 "CdlGetlocL", "CdlGetlocP", "CdlReadT", "CdlGetTN",
90 "CdlGetTD", "CdlSeekL", "CdlSeekP", "CdlSetclock",
91 "CdlGetclock", "CdlTest", "CdlID", "CdlReadS",
92 "CdlInit", NULL, "CDlReadToc", NULL
95 unsigned char Test04[] = { 0 };
96 unsigned char Test05[] = { 0 };
97 unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
98 unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
99 unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
105 #define Acknowledge 3
110 #define MODE_SPEED (1<<7) // 0x80
111 #define MODE_STRSND (1<<6) // 0x40 ADPCM on/off
112 #define MODE_SIZE_2340 (1<<5) // 0x20
113 #define MODE_SIZE_2328 (1<<4) // 0x10
114 #define MODE_SIZE_2048 (0<<4) // 0x00
115 #define MODE_SF (1<<3) // 0x08 channel on/off
116 #define MODE_REPORT (1<<2) // 0x04
117 #define MODE_AUTOPAUSE (1<<1) // 0x02
118 #define MODE_CDDA (1<<0) // 0x01
121 #define STATUS_PLAY (1<<7) // 0x80
122 #define STATUS_SEEK (1<<6) // 0x40
123 #define STATUS_READ (1<<5) // 0x20
124 #define STATUS_SHELLOPEN (1<<4) // 0x10
125 #define STATUS_UNKNOWN3 (1<<3) // 0x08
126 #define STATUS_UNKNOWN2 (1<<2) // 0x04
127 #define STATUS_ROTATING (1<<1) // 0x02
128 #define STATUS_ERROR (1<<0) // 0x01
131 #define ERROR_NOTREADY (1<<7) // 0x80
132 #define ERROR_INVALIDCMD (1<<6) // 0x40
133 #define ERROR_INVALIDARG (1<<5) // 0x20
135 // 1x = 75 sectors per second
136 // PSXCLK = 1 sec in the ps
137 // so (PSXCLK / 75) = cdr read time (linuzappz)
138 #define cdReadTime (PSXCLK / 75)
141 DRIVESTATE_STANDBY = 0,
143 DRIVESTATE_RESCAN_CD,
144 DRIVESTATE_PREPARE_CD,
154 static struct CdrStat stat;
156 static unsigned int msf2sec(const u8 *msf) {
157 return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
160 // for that weird psemu API..
161 static unsigned int fsm2sec(const u8 *msf) {
162 return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
165 static void sec2msf(unsigned int s, u8 *msf) {
166 msf[0] = s / 75 / 60;
167 s = s - msf[0] * 75 * 60;
174 #define CDR_INT(eCycle) { \
175 psxRegs.interrupt |= (1 << PSXINT_CDR); \
176 psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
177 psxRegs.intCycle[PSXINT_CDR].sCycle = psxRegs.cycle; \
178 new_dyna_set_event(PSXINT_CDR, eCycle); \
182 #define CDREAD_INT(eCycle) { \
183 psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
184 psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
185 psxRegs.intCycle[PSXINT_CDREAD].sCycle = psxRegs.cycle; \
186 new_dyna_set_event(PSXINT_CDREAD, eCycle); \
189 // cdrLidSeekInterrupt
190 #define CDRLID_INT(eCycle) { \
191 psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
192 psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
193 psxRegs.intCycle[PSXINT_CDRLID].sCycle = psxRegs.cycle; \
194 new_dyna_set_event(PSXINT_CDRLID, eCycle); \
198 #define CDRMISC_INT(eCycle) { \
199 psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
200 psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
201 psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
202 new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
205 #define StopReading() { \
208 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
210 cdr.StatP &= ~(STATUS_READ|STATUS_SEEK);\
213 #define StopCdda() { \
215 if (!Config.Cdda) CDR_stop(); \
216 cdr.StatP &= ~STATUS_PLAY; \
218 cdr.FastForward = 0; \
219 cdr.FastBackward = 0; \
220 /*SPU_registerCallback( SPUirq );*/ \
224 #define SetResultSize(size) { \
226 cdr.ResultC = size; \
227 cdr.ResultReady = 1; \
230 static void setIrq(void)
232 if (cdr.Stat & cdr.Reg2)
233 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
236 // timing used in this function was taken from tests on real hardware
237 // (yes it's slow, but you probably don't want to modify it)
238 void cdrLidSeekInterrupt()
240 switch (cdr.DriveState) {
242 case DRIVESTATE_STANDBY:
243 cdr.StatP &= ~STATUS_SEEK;
245 if (CDR_getStatus(&stat) == -1)
248 if (stat.Status & STATUS_SHELLOPEN)
251 cdr.DriveState = DRIVESTATE_LID_OPEN;
256 case DRIVESTATE_LID_OPEN:
257 if (CDR_getStatus(&stat) == -1)
258 stat.Status &= ~STATUS_SHELLOPEN;
261 if (!(cdr.StatP & STATUS_SHELLOPEN)) {
263 cdr.StatP |= STATUS_SHELLOPEN;
265 // could generate error irq here, but real hardware
266 // only sometimes does that
267 // (not done when lots of commands are sent?)
269 CDRLID_INT(cdReadTime * 30);
272 else if (cdr.StatP & STATUS_ROTATING) {
273 cdr.StatP &= ~STATUS_ROTATING;
275 else if (!(stat.Status & STATUS_SHELLOPEN)) {
279 // cdr.StatP STATUS_SHELLOPEN is "sticky"
280 // and is only cleared by CdlNop
282 cdr.DriveState = DRIVESTATE_RESCAN_CD;
283 CDRLID_INT(cdReadTime * 105);
288 CDRLID_INT(cdReadTime * 3);
291 case DRIVESTATE_RESCAN_CD:
292 cdr.StatP |= STATUS_ROTATING;
293 cdr.DriveState = DRIVESTATE_PREPARE_CD;
295 // this is very long on real hardware, over 6 seconds
296 // make it a bit faster here...
297 CDRLID_INT(cdReadTime * 150);
300 case DRIVESTATE_PREPARE_CD:
301 cdr.StatP |= STATUS_SEEK;
303 cdr.DriveState = DRIVESTATE_STANDBY;
304 CDRLID_INT(cdReadTime * 26);
309 static void Find_CurTrack(const u8 *time)
313 current = msf2sec(time);
315 for (cdr.CurTrack = 1; cdr.CurTrack < cdr.ResultTN[1]; cdr.CurTrack++) {
316 CDR_getTD(cdr.CurTrack + 1, cdr.ResultTD);
317 sect = fsm2sec(cdr.ResultTD);
318 if (sect - current >= 150)
323 static void generate_subq(const u8 *time)
325 unsigned char start[3], next[3];
326 unsigned int this_s, start_s, next_s, pregap;
329 CDR_getTD(cdr.CurTrack, start);
330 if (cdr.CurTrack + 1 <= cdr.ResultTN[1]) {
332 CDR_getTD(cdr.CurTrack + 1, next);
335 // last track - cd size
337 next[0] = cdr.SetSectorEnd[2];
338 next[1] = cdr.SetSectorEnd[1];
339 next[2] = cdr.SetSectorEnd[0];
342 this_s = msf2sec(time);
343 start_s = fsm2sec(start);
344 next_s = fsm2sec(next);
346 cdr.TrackChanged = FALSE;
348 if (next_s - this_s < pregap) {
349 cdr.TrackChanged = TRUE;
356 relative_s = this_s - start_s;
357 if (relative_s < 0) {
359 relative_s = -relative_s;
361 sec2msf(relative_s, cdr.subq.Relative);
363 cdr.subq.Track = itob(cdr.CurTrack);
364 cdr.subq.Relative[0] = itob(cdr.subq.Relative[0]);
365 cdr.subq.Relative[1] = itob(cdr.subq.Relative[1]);
366 cdr.subq.Relative[2] = itob(cdr.subq.Relative[2]);
367 cdr.subq.Absolute[0] = itob(time[0]);
368 cdr.subq.Absolute[1] = itob(time[1]);
369 cdr.subq.Absolute[2] = itob(time[2]);
372 static void ReadTrack(const u8 *time) {
373 unsigned char tmp[3];
377 tmp[0] = itob(time[0]);
378 tmp[1] = itob(time[1]);
379 tmp[2] = itob(time[2]);
381 if (memcmp(cdr.Prev, tmp, 3) == 0)
384 CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
386 cdr.NoErr = CDR_readTrack(tmp);
387 memcpy(cdr.Prev, tmp, 3);
392 subq = (struct SubQ *)CDR_getBufferSub();
393 if (subq != NULL && cdr.CurTrack == 1) {
394 crc = calcCrc((u8 *)subq + 12, 10);
395 if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
396 cdr.subq.Track = subq->TrackNumber;
397 cdr.subq.Index = subq->IndexNumber;
398 memcpy(cdr.subq.Relative, subq->TrackRelativeAddress, 3);
399 memcpy(cdr.subq.Absolute, subq->AbsoluteAddress, 3);
402 CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
403 tmp[0], tmp[1], tmp[2]);
410 CDR_LOG(" -> %02x,%02x %02x:%02x:%02x %02x:%02x:%02x\n",
411 cdr.subq.Track, cdr.subq.Index,
412 cdr.subq.Relative[0], cdr.subq.Relative[1], cdr.subq.Relative[2],
413 cdr.subq.Absolute[0], cdr.subq.Absolute[1], cdr.subq.Absolute[2]);
416 static void AddIrqQueue(unsigned short irq, unsigned long ecycle) {
418 if (irq == cdr.Irq || irq + 0x100 == cdr.Irq) {
424 CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
433 static void cdrPlayInterrupt_Autopause()
436 boolean abs_lev_chselect;
439 if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
440 CDR_LOG( "CDDA STOP\n" );
442 // Magic the Gathering
443 // - looping territory cdda
446 //cdr.ResultReady = 1;
447 //cdr.Stat = DataReady;
453 else if (((cdr.Mode & MODE_REPORT) || cdr.FastForward || cdr.FastBackward)) {
454 CDR_readCDDA(cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2], (u8 *)read_buf);
455 cdr.Result[0] = cdr.StatP;
456 cdr.Result[1] = cdr.subq.Track;
457 cdr.Result[2] = cdr.subq.Index;
459 abs_lev_chselect = cdr.subq.Absolute[1] & 0x01;
461 /* 8 is a hack. For accuracy, it should be 588. */
462 for (i = 0; i < 8; i++)
464 abs_lev_max = MAX_VALUE(abs_lev_max, abs(read_buf[i * 2 + abs_lev_chselect]));
466 abs_lev_max = MIN_VALUE(abs_lev_max, 32767);
467 abs_lev_max |= abs_lev_chselect << 15;
469 if (cdr.subq.Absolute[2] & 0x10) {
470 cdr.Result[3] = cdr.subq.Relative[0];
471 cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
472 cdr.Result[5] = cdr.subq.Relative[2];
475 cdr.Result[3] = cdr.subq.Absolute[0];
476 cdr.Result[4] = cdr.subq.Absolute[1];
477 cdr.Result[5] = cdr.subq.Absolute[2];
480 cdr.Result[6] = abs_lev_max >> 0;
481 cdr.Result[7] = abs_lev_max >> 8;
483 // Rayman: Logo freeze (resultready + dataready)
485 cdr.Stat = DataReady;
493 void cdrPlayInterrupt()
495 if (cdr.Seeked == SEEK_PENDING) {
497 CDR_LOG_I("cdrom: seek stat hack\n");
502 cdr.StatP |= STATUS_ROTATING;
503 cdr.StatP &= ~STATUS_SEEK;
504 cdr.Result[0] = cdr.StatP;
505 cdr.Seeked = SEEK_DONE;
511 if (cdr.SetlocPending) {
512 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
513 cdr.SetlocPending = 0;
514 cdr.m_locationChanged = TRUE;
516 Find_CurTrack(cdr.SetSectorPlay);
517 ReadTrack(cdr.SetSectorPlay);
518 cdr.TrackChanged = FALSE;
521 if (!cdr.Play) return;
523 CDR_LOG( "CDDA - %d:%d:%d\n",
524 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
526 if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
528 cdr.TrackChanged = TRUE;
531 if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
532 cdrPlayInterrupt_Autopause();
534 if (!cdr.Play) return;
536 if (CDR_readCDDA && !cdr.Muted && cdr.Mode & MODE_REPORT) {
537 cdrAttenuate(read_buf, CD_FRAMESIZE_RAW / 4, 1);
538 if (SPU_playCDDAchannel)
539 SPU_playCDDAchannel(read_buf, CD_FRAMESIZE_RAW);
542 cdr.SetSectorPlay[2]++;
543 if (cdr.SetSectorPlay[2] == 75) {
544 cdr.SetSectorPlay[2] = 0;
545 cdr.SetSectorPlay[1]++;
546 if (cdr.SetSectorPlay[1] == 60) {
547 cdr.SetSectorPlay[1] = 0;
548 cdr.SetSectorPlay[0]++;
552 if (cdr.m_locationChanged)
554 CDRMISC_INT(cdReadTime * 30);
555 cdr.m_locationChanged = FALSE;
559 CDRMISC_INT(cdReadTime);
562 // update for CdlGetlocP/autopause
563 generate_subq(cdr.SetSectorPlay);
566 void cdrInterrupt() {
568 int no_busy_error = 0;
569 int start_rotating = 0;
572 unsigned int seekTime = 0;
576 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
585 cdr.Result[0] = cdr.StatP;
586 cdr.Stat = Acknowledge;
588 if (cdr.IrqRepeated) {
590 if (cdr.eCycle > psxRegs.cycle) {
600 if (cdr.DriveState != DRIVESTATE_LID_OPEN)
601 cdr.StatP &= ~STATUS_SHELLOPEN;
611 if (cdr.Seeked == SEEK_PENDING) {
612 // XXX: wrong, should seek instead..
613 cdr.Seeked = SEEK_DONE;
616 cdr.FastBackward = 0;
619 if (cdr.SetlocPending) {
620 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
621 cdr.SetlocPending = 0;
622 cdr.m_locationChanged = TRUE;
626 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
628 if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
629 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
630 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
634 int track = btoi( cdr.Param[0] );
636 if (track <= cdr.ResultTN[1])
637 cdr.CurTrack = track;
639 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
641 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
642 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
643 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
644 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
649 Rayman: detect track changes
652 Twisted Metal 2: skip PREGAP + starting accurate SubQ
653 - plays tracks without retry play
655 Wild 9: skip PREGAP + starting accurate SubQ
656 - plays tracks without retry play
658 Find_CurTrack(cdr.SetSectorPlay);
659 ReadTrack(cdr.SetSectorPlay);
660 cdr.TrackChanged = FALSE;
663 CDR_play(cdr.SetSectorPlay);
665 // Vib Ribbon: gameplay checks flag
666 cdr.StatP &= ~STATUS_SEEK;
667 cdr.Result[0] = cdr.StatP;
669 cdr.StatP |= STATUS_PLAY;
671 // BIOS player - set flag again
674 CDRMISC_INT( cdReadTime );
679 // TODO: error 80 if stopped
682 // GameShark CD Player: Calls 2x + Play 2x
684 cdr.FastBackward = 0;
690 // GameShark CD Player: Calls 2x + Play 2x
691 cdr.FastBackward = 1;
696 if (cdr.DriveState != DRIVESTATE_STOPPED) {
697 error = ERROR_INVALIDARG;
700 AddIrqQueue(CdlStandby + 0x100, cdReadTime * 125 / 2);
704 case CdlStandby + 0x100:
710 // grab time for current track
711 CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
713 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
714 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
715 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
722 if (cdr.DriveState == DRIVESTATE_STANDBY)
723 delay = cdReadTime * 30 / 2;
725 cdr.DriveState = DRIVESTATE_STOPPED;
726 AddIrqQueue(CdlStop + 0x100, delay);
729 case CdlStop + 0x100:
730 cdr.StatP &= ~STATUS_ROTATING;
731 cdr.Result[0] = cdr.StatP;
737 Gundam Battle Assault 2: much slower (*)
738 - Fixes boot, gameplay
740 Hokuto no Ken 2: slower
741 - Fixes intro + subtitles
743 InuYasha - Feudal Fairy Tale: slower
746 /* Gameblabla - Tightening the timings (as taken from Duckstation).
747 * The timings from Duckstation are based upon hardware tests.
748 * Mednafen's timing don't work for Gundam Battle Assault 2 in PAL/50hz mode,
749 * seems to be timing sensitive as it can depend on the CPU's clock speed.
751 if (cdr.DriveState != DRIVESTATE_STANDBY)
757 delay = (((cdr.Mode & MODE_SPEED) ? 2 : 1) * (1000000));
758 CDRMISC_INT((cdr.Mode & MODE_SPEED) ? cdReadTime / 2 : cdReadTime);
760 AddIrqQueue(CdlPause + 0x100, delay);
764 case CdlPause + 0x100:
765 cdr.StatP &= ~STATUS_READ;
766 cdr.Result[0] = cdr.StatP;
772 cdr.Mode = 0x20; /* This fixes This is Football 2, Pooh's Party lockups */
773 AddIrqQueue(CdlReset + 0x100, 4100000);
778 case CdlReset + 0x100:
791 cdr.File = cdr.Param[0];
792 cdr.Channel = cdr.Param[1];
800 /* Gameblabla : According to mednafen, Result size should be 5 and done this way. */
802 cdr.Result[1] = cdr.Mode;
804 cdr.Result[3] = cdr.File;
805 cdr.Result[4] = cdr.Channel;
811 memcpy(cdr.Result, cdr.Transfer, 8);
816 memcpy(&cdr.Result, &cdr.subq, 8);
818 if (!cdr.Play && !cdr.Reading)
819 cdr.Result[1] = 0; // HACK?
822 case CdlReadT: // SetSession?
824 AddIrqQueue(CdlReadT + 0x100, cdReadTime * 290 / 4);
828 case CdlReadT + 0x100:
834 if (CDR_getTN(cdr.ResultTN) == -1) {
835 cdr.Stat = DiskError;
836 cdr.Result[0] |= STATUS_ERROR;
838 cdr.Stat = Acknowledge;
839 cdr.Result[1] = itob(cdr.ResultTN[0]);
840 cdr.Result[2] = itob(cdr.ResultTN[1]);
845 cdr.Track = btoi(cdr.Param[0]);
847 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
848 cdr.Stat = DiskError;
849 cdr.Result[0] |= STATUS_ERROR;
851 cdr.Stat = Acknowledge;
852 cdr.Result[0] = cdr.StatP;
853 cdr.Result[1] = itob(cdr.ResultTD[2]);
854 cdr.Result[2] = itob(cdr.ResultTD[1]);
855 /* According to Nocash's documentation, the function doesn't care about ff.
856 * This can be seen also in Mednafen's implementation. */
857 //cdr.Result[3] = itob(cdr.ResultTD[0]);
865 cdr.StatP |= STATUS_SEEK;
868 Crusaders of Might and Magic = 0.5x-4x
869 - fix cutscene speech start
875 - fix cutscene speech
880 CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
881 cdr.Seeked = SEEK_PENDING;
886 switch (cdr.Param[0]) {
887 case 0x20: // System Controller ROM Version
889 memcpy(cdr.Result, Test20, 4);
893 memcpy(cdr.Result, Test22, 4);
895 case 0x23: case 0x24:
897 memcpy(cdr.Result, Test23, 4);
904 AddIrqQueue(CdlID + 0x100, 20480);
909 cdr.Result[0] = cdr.StatP;
914 // 0x10 - audio | 0x40 - disk missing | 0x80 - unlicensed
915 if (CDR_getStatus(&stat) == -1 || stat.Type == 0 || stat.Type == 0xff) {
916 cdr.Result[1] = 0xc0;
920 cdr.Result[1] |= 0x10;
921 if (CdromId[0] == '\0')
922 cdr.Result[1] |= 0x80;
924 cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
926 strncpy((char *)&cdr.Result[4], "PCSX", 4);
931 // yes, it really sets STATUS_SHELLOPEN
932 cdr.StatP |= STATUS_SHELLOPEN;
933 cdr.DriveState = DRIVESTATE_RESCAN_CD;
944 AddIrqQueue(CdlReadToc + 0x100, cdReadTime * 180 / 4);
949 case CdlReadToc + 0x100:
956 if (cdr.SetlocPending) {
957 seekTime = abs(msf2sec(cdr.SetSectorPlay) - msf2sec(cdr.SetSector)) * (cdReadTime / 200);
960 * It was originally set to 1000000 for Driver, however it is not high enough for Worms Pinball
961 * and was unreliable for that game.
962 * I also tested it against Mednafen and Driver's titlescreen music starts 25 frames later, not immediatly.
964 * Obviously, this isn't perfect but right now, it should be a bit better.
965 * Games to test this against if you change that setting :
966 * - Driver (titlescreen music delay and retry mission)
967 * - Worms Pinball (Will either not boot or crash in the memory card screen)
968 * - Viewpoint (short pauses if the delay in the ingame music is too long)
970 * It seems that 3386880 * 5 is too much for Driver's titlescreen and it starts skipping.
971 * However, 1000000 is not enough for Worms Pinball to reliably boot.
973 if(seekTime > 3386880 * 2) seekTime = 3386880 * 2;
974 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
975 cdr.SetlocPending = 0;
976 cdr.m_locationChanged = TRUE;
978 Find_CurTrack(cdr.SetSectorPlay);
980 if ((cdr.Mode & MODE_CDDA) && cdr.CurTrack > 1)
981 // Read* acts as play for cdda tracks in cdda mode
987 // Fighting Force 2 - update subq time immediately
989 ReadTrack(cdr.SetSectorPlay);
992 // Crusaders of Might and Magic - update getlocl now
993 // - fixes cutscene speech
995 u8 *buf = CDR_getBuffer();
997 memcpy(cdr.Transfer, buf, 8);
1001 Duke Nukem: Land of the Babes - seek then delay read for one frame
1003 C-12 - Final Resistance - doesn't like seek
1007 By nicolasnoble from PCSX Redux :
1008 "It LOOKS like this logic is wrong, therefore disabling it with `&& false` for now.
1009 For "PoPoLoCrois Monogatari II", the game logic will soft lock and will never issue GetLocP to detect
1010 the end of its XA streams, as it seems to assume ReadS will not return a status byte with the SEEK
1011 flag set. I think the reasonning is that since it's invalid to call GetLocP while seeking, the game
1012 tries to protect itself against errors by preventing from issuing a GetLocP while it knows the
1013 last status was "seek". But this makes the logic just softlock as it'll never get a notification
1014 about the fact the drive is done seeking and the read actually started.
1016 In other words, this state machine here is probably wrong in assuming the response to ReadS/ReadN is
1017 done right away. It's rather when it's done seeking, and the read has actually started. This probably
1018 requires a bit more work to make sure seek delays are processed properly.
1019 Checked with a few games, this seems to work fine."
1021 Gameblabla additional notes :
1022 This still needs the "+ seekTime" that PCSX Redux doesn't have for the Driver "retry" mission error.
1024 cdr.StatP |= STATUS_READ;
1025 cdr.StatP &= ~STATUS_SEEK;
1027 CDREAD_INT(((cdr.Mode & 0x80) ? (cdReadTime) : cdReadTime * 2) + seekTime);
1029 cdr.Result[0] = cdr.StatP;
1034 CDR_LOG_I("Invalid command: %02x\n", Irq);
1035 error = ERROR_INVALIDCMD;
1040 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
1041 cdr.Result[1] = error;
1042 cdr.Stat = DiskError;
1046 if (cdr.DriveState == DRIVESTATE_STOPPED && start_rotating) {
1047 cdr.DriveState = DRIVESTATE_STANDBY;
1048 cdr.StatP |= STATUS_ROTATING;
1051 if (!no_busy_error) {
1052 switch (cdr.DriveState) {
1053 case DRIVESTATE_LID_OPEN:
1054 case DRIVESTATE_RESCAN_CD:
1055 case DRIVESTATE_PREPARE_CD:
1057 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
1058 cdr.Result[1] = ERROR_NOTREADY;
1059 cdr.Stat = DiskError;
1068 #ifdef CDR_LOG_CMD_IRQ
1071 SysPrintf("CDR IRQ %d cmd %02x stat %02x: ",
1072 !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
1073 for (i = 0; i < cdr.ResultC; i++)
1074 SysPrintf("%02x ", cdr.Result[i]);
1081 #define ssat32_to_16(v) \
1082 asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
1084 #define ssat32_to_16(v) do { \
1085 if (v < -32768) v = -32768; \
1086 else if (v > 32767) v = 32767; \
1090 void cdrAttenuate(s16 *buf, int samples, int stereo)
1093 int ll = cdr.AttenuatorLeftToLeft;
1094 int lr = cdr.AttenuatorLeftToRight;
1095 int rl = cdr.AttenuatorRightToLeft;
1096 int rr = cdr.AttenuatorRightToRight;
1098 if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
1101 if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
1105 for (i = 0; i < samples; i++) {
1108 l = (l * ll + r * rl) >> 7;
1109 r = (r * rr + l * lr) >> 7;
1117 for (i = 0; i < samples; i++) {
1119 l = l * (ll + rl) >> 7;
1120 //r = r * (rr + lr) >> 7;
1128 void cdrReadInterrupt() {
1134 if (cdr.Irq || cdr.Stat) {
1135 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1142 cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1143 cdr.StatP &= ~STATUS_SEEK;
1144 cdr.Result[0] = cdr.StatP;
1145 cdr.Seeked = SEEK_DONE;
1147 ReadTrack(cdr.SetSectorPlay);
1149 buf = CDR_getBuffer();
1154 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1155 memset(cdr.Transfer, 0, DATA_SIZE);
1156 cdr.Stat = DiskError;
1157 cdr.Result[0] |= STATUS_ERROR;
1158 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1162 memcpy(cdr.Transfer, buf, DATA_SIZE);
1163 CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1166 CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1168 if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1169 // Firemen 2: Multi-XA files - briefings, cutscenes
1170 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1171 cdr.File = cdr.Transfer[4 + 0];
1172 cdr.Channel = cdr.Transfer[4 + 1];
1176 * Skips playing on channel 255.
1177 * Fixes missing audio in Blue's Clues : Blue's Big Musical. (Should also fix Taxi 2)
1178 * TODO : Check if this is the proper behaviour.
1180 if((cdr.Transfer[4 + 2] & 0x4) &&
1181 (cdr.Transfer[4 + 1] == cdr.Channel) &&
1182 (cdr.Transfer[4 + 0] == cdr.File) && cdr.Channel != 255) {
1183 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1185 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
1188 * This is a hack for Megaman X4, Castlevania etc...
1189 * that regressed from the new m_locationChanged and CDROM timings changes.
1190 * It is mostly noticeable in Castevania however and the stuttering can be very jarring.
1192 * According to PCSX redux authors, we shouldn't cause a location change if
1193 * the sector difference is too small.
1194 * I attempted to go with that approach but came empty handed.
1195 * So for now, let's just set cdr.m_locationChanged to false when playing back any ADPCM samples.
1196 * This does not regress Crash Team Racing's intro at least.
1198 cdr.m_locationChanged = FALSE;
1199 SPU_playADPCMchannel(&cdr.Xa);
1200 cdr.FirstSector = 0;
1202 else cdr.FirstSector = -1;
1206 cdr.SetSectorPlay[2]++;
1207 if (cdr.SetSectorPlay[2] == 75) {
1208 cdr.SetSectorPlay[2] = 0;
1209 cdr.SetSectorPlay[1]++;
1210 if (cdr.SetSectorPlay[1] == 60) {
1211 cdr.SetSectorPlay[1] = 0;
1212 cdr.SetSectorPlay[0]++;
1218 uint32_t delay = (cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime;
1219 if (cdr.m_locationChanged) {
1220 CDREAD_INT(delay * 30);
1221 cdr.m_locationChanged = FALSE;
1227 Croc 2: $40 - only FORM1 (*)
1228 Judge Dredd: $C8 - only FORM1 (*)
1229 Sim Theme Park - no adpcm at all (zero)
1232 if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
1233 cdr.Stat = DataReady;
1237 // update for CdlGetlocP
1238 ReadTrack(cdr.SetSectorPlay);
1247 bit 5 - 1 result ready
1249 bit 7 - 1 command being processed
1252 unsigned char cdrRead0(void) {
1253 if (cdr.ResultReady)
1261 // cdr.Ctrl &= ~0x40;
1263 // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1266 CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1268 return psxHu8(0x1800) = cdr.Ctrl;
1271 void cdrWrite0(unsigned char rt) {
1272 CDR_LOG_IO("cdr w0: %02x\n", rt);
1274 cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1277 unsigned char cdrRead1(void) {
1278 if ((cdr.ResultP & 0xf) < cdr.ResultC)
1279 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1283 if (cdr.ResultP == cdr.ResultC)
1284 cdr.ResultReady = 0;
1286 CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1288 return psxHu8(0x1801);
1291 void cdrWrite1(unsigned char rt) {
1295 CDR_LOG_IO("cdr w1: %02x\n", rt);
1297 switch (cdr.Ctrl & 3) {
1301 cdr.AttenuatorRightToRightT = rt;
1310 #ifdef CDR_LOG_CMD_IRQ
1311 SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
1313 SysPrintf(" Param[%d] = {", cdr.ParamC);
1314 for (i = 0; i < cdr.ParamC; i++)
1315 SysPrintf(" %x,", cdr.Param[i]);
1322 cdr.ResultReady = 0;
1324 // cdr.Stat = NoIntr;
1325 AddIrqQueue(cdr.Cmd, 0x800);
1329 CDR_LOG("CDROM setloc command (%02X, %02X, %02X)\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1331 // MM must be BCD, SS must be BCD and <0x60, FF must be BCD and <0x75
1332 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))
1334 CDR_LOG("Invalid/out of range seek to %02X:%02X:%02X\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1338 for (i = 0; i < 3; i++)
1340 set_loc[i] = btoi(cdr.Param[i]);
1343 i = msf2sec(cdr.SetSectorPlay);
1344 i = abs(i - msf2sec(set_loc));
1346 cdr.Seeked = SEEK_PENDING;
1348 memcpy(cdr.SetSector, set_loc, 3);
1349 cdr.SetSector[3] = 0;
1350 cdr.SetlocPending = 1;
1363 cdr.Seeked = SEEK_DONE;
1369 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1371 cdr.Mode = cdr.Param[0];
1373 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1374 // - fixes choppy movie sound
1375 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1381 unsigned char cdrRead2(void) {
1384 if (cdr.Readed == 0) {
1390 CDR_LOG_IO("cdr r2: %02x\n", ret);
1394 void cdrWrite2(unsigned char rt) {
1395 CDR_LOG_IO("cdr w2: %02x\n", rt);
1397 switch (cdr.Ctrl & 3) {
1399 if (cdr.ParamC < 8) // FIXME: size and wrapping
1400 cdr.Param[cdr.ParamC++] = rt;
1407 cdr.AttenuatorLeftToLeftT = rt;
1410 cdr.AttenuatorRightToLeftT = rt;
1415 unsigned char cdrRead3(void) {
1417 psxHu8(0x1803) = cdr.Stat | 0xE0;
1419 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1421 CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1422 return psxHu8(0x1803);
1425 void cdrWrite3(unsigned char rt) {
1426 CDR_LOG_IO("cdr w3: %02x\n", rt);
1428 switch (cdr.Ctrl & 3) {
1438 cdr.AttenuatorLeftToRightT = rt;
1442 memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
1443 CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
1444 cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
1445 cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
1450 if ((rt & 0x80) && cdr.Readed == 0) {
1452 pTransfer = cdr.Transfer;
1454 switch (cdr.Mode & 0x30) {
1455 case MODE_SIZE_2328:
1460 case MODE_SIZE_2340:
1470 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1475 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1480 if (cdr.Readed == 0) {
1481 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1485 cdsize = (bcr & 0xffff) * 4;
1487 // Ape Escape: bcr = 0001 / 0000
1491 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
1492 case MODE_SIZE_2340: cdsize = 2340; break;
1493 case MODE_SIZE_2328: cdsize = 2328; break;
1495 case MODE_SIZE_2048: cdsize = 2048; break;
1500 ptr = (u8 *)PSXM(madr);
1502 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1507 GS CDX: Enhancement CD crash
1510 - Spams DMA3 and gets buffer overrun
1512 size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1517 memcpy(ptr, pTransfer, size);
1520 psxCpu->Clear(madr, cdsize / 4);
1521 pTransfer += cdsize;
1523 if( chcr == 0x11400100 ) {
1524 HW_DMA3_MADR = SWAPu32(madr + cdsize);
1525 CDRDMA_INT( (cdsize/4) / 4 );
1527 else if( chcr == 0x11000000 ) {
1528 // CDRDMA_INT( (cdsize/4) * 1 );
1530 psxRegs.cycle += (cdsize/4) * 24/2;
1536 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1540 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1544 void cdrDmaInterrupt()
1546 if (HW_DMA3_CHCR & SWAP32(0x01000000))
1548 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1553 static void getCdInfo(void)
1557 CDR_getTN(cdr.ResultTN);
1558 CDR_getTD(0, cdr.SetSectorEnd);
1559 tmp = cdr.SetSectorEnd[0];
1560 cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
1561 cdr.SetSectorEnd[2] = tmp;
1565 memset(&cdr, 0, sizeof(cdr));
1571 cdr.DriveState = DRIVESTATE_STANDBY;
1572 cdr.StatP = STATUS_ROTATING;
1573 pTransfer = cdr.Transfer;
1575 // BIOS player - default values
1576 cdr.AttenuatorLeftToLeft = 0x80;
1577 cdr.AttenuatorLeftToRight = 0x00;
1578 cdr.AttenuatorRightToLeft = 0x00;
1579 cdr.AttenuatorRightToRight = 0x80;
1584 int cdrFreeze(void *f, int Mode) {
1588 if (Mode == 0 && !Config.Cdda)
1591 cdr.freeze_ver = 0x63647202;
1592 gzfreeze(&cdr, sizeof(cdr));
1595 cdr.ParamP = cdr.ParamC;
1596 tmp = pTransfer - cdr.Transfer;
1599 gzfreeze(&tmp, sizeof(tmp));
1604 pTransfer = cdr.Transfer + tmp;
1606 // read right sub data
1607 tmpp[0] = btoi(cdr.Prev[0]);
1608 tmpp[1] = btoi(cdr.Prev[1]);
1609 tmpp[2] = btoi(cdr.Prev[2]);
1614 if (cdr.freeze_ver < 0x63647202)
1615 memcpy(cdr.SetSectorPlay, cdr.SetSector, 3);
1617 Find_CurTrack(cdr.SetSectorPlay);
1619 CDR_play(cdr.SetSectorPlay);
1622 if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
1623 // old versions did not latch Reg2, have to fixup..
1624 if (cdr.Reg2 == 0) {
1625 SysPrintf("cdrom: fixing up old savestate\n");
1628 // also did not save Attenuator..
1629 if ((cdr.AttenuatorLeftToLeft | cdr.AttenuatorLeftToRight
1630 | cdr.AttenuatorRightToLeft | cdr.AttenuatorRightToRight) == 0)
1632 cdr.AttenuatorLeftToLeft = cdr.AttenuatorRightToRight = 0x80;
1640 void LidInterrupt() {
1643 cdrLidSeekInterrupt();