cdrom: set proper reset values
[pcsx_rearmed.git] / libpcsxcore / cdrom.c
index 0de7ecc..3117a9b 100644 (file)
 #include "ppf.h"
 #include "psxdma.h"
 
+/* logging */
+#if 0
+#define CDR_LOG SysPrintf
+#else
+#define CDR_LOG(...)
+#endif
+#if 0
+#define CDR_LOG_I SysPrintf
+#else
+#define CDR_LOG_I(...)
+#endif
+#if 0
+#define CDR_LOG_IO SysPrintf
+#else
+#define CDR_LOG_IO(...)
+#endif
+//#define CDR_LOG_CMD_IRQ
+
 cdrStruct cdr;
+static unsigned char *pTransfer;
 
 /* CD-ROM magic numbers */
 #define CdlSync        0
@@ -59,14 +78,6 @@ cdrStruct cdr;
 #define CdlReset       28
 #define CdlReadToc     30
 
-#define AUTOPAUSE      249
-#define READ_ACK       250
-#define READ           251
-#define REPPLAY_ACK    252
-#define REPPLAY        253
-#define ASYNC          254
-/* don't set 255, it's reserved */
-
 char *CmdName[0x100]= {
     "CdlSync",     "CdlNop",       "CdlSetloc",  "CdlPlay",
     "CdlForward",  "CdlBackward",  "CdlReadN",   "CdlStandby",
@@ -97,6 +108,7 @@ unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
 #define MODE_STRSND      (1<<6) // 0x40 ADPCM on/off
 #define MODE_SIZE_2340   (1<<5) // 0x20
 #define MODE_SIZE_2328   (1<<4) // 0x10
+#define MODE_SIZE_2048   (0<<4) // 0x00
 #define MODE_SF          (1<<3) // 0x08 channel on/off
 #define MODE_REPORT      (1<<2) // 0x04
 #define MODE_AUTOPAUSE   (1<<1) // 0x02
@@ -113,19 +125,29 @@ unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
 #define STATUS_ERROR     (1<<0) // 0x01
 
 
-
 // 1x = 75 sectors per second
 // PSXCLK = 1 sec in the ps
 // so (PSXCLK / 75) = cdr read time (linuzappz)
 #define cdReadTime (PSXCLK / 75)
 
+// for cdr.Seeked
+enum seeked_state {
+       SEEK_PENDING = 0,
+       SEEK_DONE = 1,
+};
+
 static struct CdrStat stat;
 
-static unsigned int msf2sec(char *msf) {
+static unsigned int msf2sec(const u8 *msf) {
        return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
 }
 
-static void sec2msf(unsigned int s, char *msf) {
+// for that weird psemu API..
+static unsigned int fsm2sec(const u8 *msf) {
+       return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
+}
+
+static void sec2msf(unsigned int s, u8 *msf) {
        msf[0] = s / 75 / 60;
        s = s - msf[0] * 75 * 60;
        msf[1] = s / 75;
@@ -133,7 +155,7 @@ static void sec2msf(unsigned int s, char *msf) {
        msf[2] = s;
 }
 
-
+// cdrInterrupt
 #define CDR_INT(eCycle) { \
        psxRegs.interrupt |= (1 << PSXINT_CDR); \
        psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
@@ -141,6 +163,7 @@ static void sec2msf(unsigned int s, char *msf) {
        new_dyna_set_event(PSXINT_CDR, eCycle); \
 }
 
+// cdrReadInterrupt
 #define CDREAD_INT(eCycle) { \
        psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
        psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
@@ -148,6 +171,7 @@ static void sec2msf(unsigned int s, char *msf) {
        new_dyna_set_event(PSXINT_CDREAD, eCycle); \
 }
 
+// cdrLidSeekInterrupt
 #define CDRLID_INT(eCycle) { \
        psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
        psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
@@ -155,20 +179,14 @@ static void sec2msf(unsigned int s, char *msf) {
        new_dyna_set_event(PSXINT_CDRLID, eCycle); \
 }
 
-#define CDRPLAY_INT(eCycle) { \
+// cdrPlayInterrupt
+#define CDRMISC_INT(eCycle) { \
        psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
        psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
        psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
        new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
 }
 
-#define StartReading(type, eCycle) { \
-       cdr.Reading = type; \
-       cdr.FirstSector = 1; \
-       cdr.Readed = 0xff; \
-       AddIrqQueue(READ_ACK, eCycle); \
-}
-
 #define StopReading() { \
        if (cdr.Reading) { \
                cdr.Reading = 0; \
@@ -189,11 +207,16 @@ static void sec2msf(unsigned int s, char *msf) {
 }
 
 #define SetResultSize(size) { \
-    cdr.ResultP = 0; \
+       cdr.ResultP = 0; \
        cdr.ResultC = size; \
        cdr.ResultReady = 1; \
 }
 
+static void setIrq(void)
+{
+       if (cdr.Stat & cdr.Reg2)
+               psxHu32ref(0x1070) |= SWAP32((u32)0x4);
+}
 
 void cdrLidSeekInterrupt()
 {
@@ -251,15 +274,12 @@ void cdrLidSeekInterrupt()
        }
 }
 
-
 static void Check_Shell( int Irq )
 {
        // check case open/close
        if (cdr.LidCheck > 0)
        {
-#ifdef CDR_LOG
                CDR_LOG( "LidCheck\n" );
-#endif
 
                // $20 = check lid state
                if( cdr.LidCheck == 0x20 )
@@ -315,8 +335,7 @@ static void Check_Shell( int Irq )
                                        if( cdr.Stat == NoIntr )
                                                cdr.Stat = Acknowledge;
 
-                                       psxHu32ref(0x1070) |= SWAP32((u32)0x4);
-
+                                       setIrq();
 
                                        // begin close-seek-ready cycle
                                        CDRLID_INT( cdReadTime * 3 );
@@ -356,221 +375,132 @@ static void Check_Shell( int Irq )
                        if( cdr.Stat == NoIntr )
                                cdr.Stat = Acknowledge;
 
-                       psxHu32ref(0x1070) |= SWAP32((u32)0x4);
-               }
-       }
-}
-
-
-void Find_CurTrack() {
-       cdr.CurTrack = 0;
-
-       if (CDR_getTN(cdr.ResultTN) != -1) {
-               int lcv;
-
-               for( lcv = 1; lcv <= cdr.ResultTN[1]; lcv++ ) {
-                       if (CDR_getTD((u8)(lcv), cdr.ResultTD) != -1) {
-                               u32 sect1, sect2;
-
-#ifdef CDR_LOG___0
-                               CDR_LOG( "curtrack %d %d %d | %d %d %d | %d\n",
-                                       cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2],
-                                       cdr.ResultTD[2], cdr.ResultTD[1], cdr.ResultTD[0],
-                                       cdr.CurTrack );
-#endif
-
-                               // find next track boundary - only need m:s accuracy
-                               sect1 = cdr.SetSectorPlay[0] * 60 * 75 + cdr.SetSectorPlay[1] * 75;
-                               sect2 = cdr.ResultTD[2] * 60 * 75 + cdr.ResultTD[1] * 75;
-
-                               // Twisted Metal 4 - psx cdda pregap (2-sec)
-                               // - fix in-game music
-                               sect2 -= 75 * 2;
-
-                               if( sect1 >= sect2 ) {
-                                       cdr.CurTrack++;
-                                       continue;
-                               }
-                       }
-
-                       break;
+                       setIrq();
                }
        }
 }
 
-static void ReadTrack( u8 *time ) {
-       cdr.Prev[0] = itob( time[0] );
-       cdr.Prev[1] = itob( time[1] );
-       cdr.Prev[2] = itob( time[2] );
-
-#ifdef CDR_LOG
-       CDR_LOG("ReadTrack() Log: KEY *** %x:%x:%x\n", cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
-#endif
-       cdr.RErr = CDR_readTrack(cdr.Prev);
-}
-
-
-void AddIrqQueue(unsigned char irq, unsigned long ecycle) {
-       cdr.Irq = irq;
-       cdr.eCycle = ecycle;
-
-       // Doom: Force rescheduling
-       // - Fixes boot
-       CDR_INT(ecycle);
-}
-
-
-void Set_Track()
+static void Find_CurTrack(const u8 *time)
 {
-       if (CDR_getTN(cdr.ResultTN) != -1) {
-               int lcv;
-
-               for( lcv = 1; lcv < cdr.ResultTN[1]; lcv++ ) {
-                       if (CDR_getTD((u8)(lcv), cdr.ResultTD) != -1) {
-#ifdef CDR_LOG___0
-                               CDR_LOG( "settrack %d %d %d | %d %d %d | %d\n",
-                                       cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2],
-                                       cdr.ResultTD[2], cdr.ResultTD[1], cdr.ResultTD[0],
-                                       cdr.CurTrack );
-#endif
+       int current, sect;
 
-                               // check if time matches track start (only need min, sec accuracy)
-                               // - m:s:f vs f:s:m
-                               if( cdr.SetSectorPlay[0] == cdr.ResultTD[2] &&
-                                               cdr.SetSectorPlay[1] == cdr.ResultTD[1] ) {
-                                       // skip pregap frames
-                                       if( cdr.SetSectorPlay[2] < cdr.ResultTD[0] )
-                                               cdr.SetSectorPlay[2] = cdr.ResultTD[0];
+       current = msf2sec(time);
 
-                                       break;
-                               }
-                               else if( cdr.SetSectorPlay[0] < cdr.ResultTD[2] )
-                                       break;
-                       }
-               }
+       for (cdr.CurTrack = 1; cdr.CurTrack < cdr.ResultTN[1]; cdr.CurTrack++) {
+               CDR_getTD(cdr.CurTrack + 1, cdr.ResultTD);
+               sect = fsm2sec(cdr.ResultTD);
+               if (sect - current >= 150)
+                       break;
        }
 }
 
-
-static u8 fake_subq_local[3], fake_subq_real[3], fake_subq_index, fake_subq_change;
-static void Create_Fake_Subq()
+static void generate_subq(const u8 *time)
 {
-       u8 temp_cur[3], temp_next[3], temp_start[3], pregap;
-       int diff;
+       unsigned char start[3], next[3];
+       unsigned int this_s, start_s, next_s, pregap;
+       int relative_s;
 
-       if (CDR_getTN(cdr.ResultTN) == -1) return;
-       if( cdr.CurTrack+1 <= cdr.ResultTN[1] ) {
+       CDR_getTD(cdr.CurTrack, start);
+       if (cdr.CurTrack + 1 <= cdr.ResultTN[1]) {
                pregap = 150;
-               if( CDR_getTD(cdr.CurTrack+1, cdr.ResultTD) == -1 ) return;
-       } else {
+               CDR_getTD(cdr.CurTrack + 1, next);
+       }
+       else {
                // last track - cd size
                pregap = 0;
-               if( CDR_getTD(0, cdr.ResultTD) == -1 ) return;
+               next[0] = cdr.SetSectorEnd[2];
+               next[1] = cdr.SetSectorEnd[1];
+               next[2] = cdr.SetSectorEnd[0];
        }
 
-       if( cdr.Play == TRUE ) {
-               temp_cur[0] = cdr.SetSectorPlay[0];
-               temp_cur[1] = cdr.SetSectorPlay[1];
-               temp_cur[2] = cdr.SetSectorPlay[2];
-       } else {
-               temp_cur[0] = btoi( cdr.Prev[0] );
-               temp_cur[1] = btoi( cdr.Prev[1] );
-               temp_cur[2] = btoi( cdr.Prev[2] );
-       }
-
-       fake_subq_real[0] = temp_cur[0];
-       fake_subq_real[1] = temp_cur[1];
-       fake_subq_real[2] = temp_cur[2];
-
-       temp_next[0] = cdr.ResultTD[2];
-       temp_next[1] = cdr.ResultTD[1];
-       temp_next[2] = cdr.ResultTD[0];
+       this_s = msf2sec(time);
+       start_s = fsm2sec(start);
+       next_s = fsm2sec(next);
 
+       cdr.TrackChanged = FALSE;
 
-       // flag- next track
-       if( msf2sec(temp_cur) >= msf2sec( temp_next )-pregap ) {
-               fake_subq_change = 1;
-
+       if (next_s - this_s < pregap) {
+               cdr.TrackChanged = TRUE;
                cdr.CurTrack++;
-
-               // end cd
-               if( pregap == 0 ) StopCdda();
+               start_s = next_s;
        }
 
-       //////////////////////////////////////////////////
-       //////////////////////////////////////////////////
+       cdr.subq.Index = 1;
 
-       // repair
-       if( cdr.CurTrack <= cdr.ResultTN[1] ) {
-               if( CDR_getTD(cdr.CurTrack, cdr.ResultTD) == -1 ) return;
-       } else {
-               // last track - cd size
-               if( CDR_getTD(0, cdr.ResultTD) == -1 ) return;
+       relative_s = this_s - start_s;
+       if (relative_s < 0) {
+               cdr.subq.Index = 0;
+               relative_s = -relative_s;
        }
-       
-       temp_start[0] = cdr.ResultTD[2];
-       temp_start[1] = cdr.ResultTD[1];
-       temp_start[2] = cdr.ResultTD[0];
+       sec2msf(relative_s, cdr.subq.Relative);
+
+       cdr.subq.Track = itob(cdr.CurTrack);
+       cdr.subq.Relative[0] = itob(cdr.subq.Relative[0]);
+       cdr.subq.Relative[1] = itob(cdr.subq.Relative[1]);
+       cdr.subq.Relative[2] = itob(cdr.subq.Relative[2]);
+       cdr.subq.Absolute[0] = itob(time[0]);
+       cdr.subq.Absolute[1] = itob(time[1]);
+       cdr.subq.Absolute[2] = itob(time[2]);
+}
 
+static void ReadTrack(const u8 *time) {
+       unsigned char tmp[3];
+       struct SubQ *subq;
+       u16 crc;
 
-#ifdef CDR_LOG
-       CDR_LOG( "CDDA FAKE SUB - %d:%d:%d / %d:%d:%d / %d:%d:%d\n",
-               temp_cur[0], temp_cur[1], temp_cur[2],
-               temp_start[0], temp_start[1], temp_start[2],
-               temp_next[0], temp_next[1], temp_next[2]);
-#endif
+       tmp[0] = itob(time[0]);
+       tmp[1] = itob(time[1]);
+       tmp[2] = itob(time[2]);
 
+       if (memcmp(cdr.Prev, tmp, 3) == 0)
+               return;
 
+       CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
 
-       // local time - pregap / real
-       diff = msf2sec(temp_cur) - msf2sec( temp_start );
-       if( diff < 0 ) {
-               fake_subq_index = 0;
+       cdr.RErr = CDR_readTrack(tmp);
+       memcpy(cdr.Prev, tmp, 3);
 
-               sec2msf( -diff, fake_subq_local );
-       } else {
-               fake_subq_index = 1;
+       if (CheckSBI(time))
+               return;
 
-               sec2msf( diff, fake_subq_local );
+       subq = (struct SubQ *)CDR_getBufferSub();
+       if (subq != NULL && cdr.CurTrack == 1) {
+               crc = calcCrc((u8 *)subq + 12, 10);
+               if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
+                       cdr.subq.Track = subq->TrackNumber;
+                       cdr.subq.Index = subq->IndexNumber;
+                       memcpy(cdr.subq.Relative, subq->TrackRelativeAddress, 3);
+                       memcpy(cdr.subq.Absolute, subq->AbsoluteAddress, 3);
+               }
+               else {
+                       CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
+                               tmp[0], tmp[1], tmp[2]);
+               }
+       }
+       else {
+               generate_subq(time);
        }
-}
-
-
-static void cdrPlayInterrupt_Autopause()
-{
-       struct SubQ *subq = (struct SubQ *)CDR_getBufferSub();
-       if (subq != NULL ) {
-#ifdef CDR_LOG
-               CDR_LOG( "CDDA SUB - %X:%X:%X\n",
-                       subq->AbsoluteAddress[0], subq->AbsoluteAddress[1], subq->AbsoluteAddress[2] );
-#endif
 
-               /*
-               CDDA Autopause
+       CDR_LOG(" -> %02x,%02x %02x:%02x:%02x %02x:%02x:%02x\n",
+               cdr.subq.Track, cdr.subq.Index,
+               cdr.subq.Relative[0], cdr.subq.Relative[1], cdr.subq.Relative[2],
+               cdr.subq.Absolute[0], cdr.subq.Absolute[1], cdr.subq.Absolute[2]);
+}
 
-               Silhouette Mirage ($3)
-               Tomb Raider 1 ($7)
-               */
+static void AddIrqQueue(unsigned char irq, unsigned long ecycle) {
+       if (cdr.Irq != 0)
+               CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
 
-               if( cdr.CurTrack >= btoi( subq->TrackNumber ) )
-                       return;
-       } else {
-               Create_Fake_Subq();
-#ifdef CDR_LOG___0
-               CDR_LOG( "CDDA FAKE SUB - %d:%d:%d\n",
-                       fake_subq_real[0], fake_subq_real[1], fake_subq_real[2] );
-#endif
-
-               if( !fake_subq_change )
-                       return;
+       cdr.Irq = irq;
+       cdr.eCycle = ecycle;
 
-               fake_subq_change = 0;
-       }
+       CDR_INT(ecycle);
+}
 
-       if (cdr.Mode & MODE_AUTOPAUSE) {
-#ifdef CDR_LOG
+static void cdrPlayInterrupt_Autopause()
+{
+       if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
                CDR_LOG( "CDDA STOP\n" );
-#endif
 
                // Magic the Gathering
                // - looping territory cdda
@@ -579,67 +509,79 @@ static void cdrPlayInterrupt_Autopause()
                //cdr.ResultReady = 1;
                //cdr.Stat = DataReady;
                cdr.Stat = DataEnd;
-               psxHu32ref(0x1070) |= SWAP32((u32)0x4);
+               setIrq();
 
                StopCdda();
        }
-       if (cdr.Mode & MODE_REPORT) {
-               // rearmed note: PCSX-Reloaded does this for every sector,
-               // but we try to get away with only track change here.
-               memset( cdr.Result, 0, 8 );
-               cdr.Result[0] |= 0x10;
-
-               if (subq != NULL) {
-#ifdef CDR_LOG
-                       CDR_LOG( "REPPLAY SUB - %X:%X:%X\n",
-                               subq->AbsoluteAddress[0], subq->AbsoluteAddress[1], subq->AbsoluteAddress[2] );
-#endif
-                       cdr.CurTrack = btoi( subq->TrackNumber );
-
-                       // BIOS CD Player: data already BCD format
-                       cdr.Result[1] = subq->TrackNumber;
-                       cdr.Result[2] = subq->IndexNumber;
-
-                       cdr.Result[3] = subq->AbsoluteAddress[0];
-                       cdr.Result[4] = subq->AbsoluteAddress[1];
-                       cdr.Result[5] = subq->AbsoluteAddress[2];
-               } else {
-#ifdef CDR_LOG___0
-                       CDR_LOG( "REPPLAY FAKE - %d:%d:%d\n",
-                               fake_subq_real[0], fake_subq_real[1], fake_subq_real[2] );
-#endif
+       else if (cdr.Mode & MODE_REPORT) {
+
+               cdr.Result[0] = cdr.StatP;
+               cdr.Result[1] = cdr.subq.Track;
+               cdr.Result[2] = cdr.subq.Index;
 
-                       // track # / index #
-                       cdr.Result[1] = itob(cdr.CurTrack);
-                       cdr.Result[2] = itob(fake_subq_index);
-                       // absolute
-                       cdr.Result[3] = itob( fake_subq_real[0] );
-                       cdr.Result[4] = itob( fake_subq_real[1] );
-                       cdr.Result[5] = itob( fake_subq_real[2] );
+               if (cdr.subq.Absolute[2] & 0x10) {
+                       cdr.Result[3] = cdr.subq.Relative[0];
+                       cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
+                       cdr.Result[5] = cdr.subq.Relative[2];
                }
+               else {
+                       cdr.Result[3] = cdr.subq.Absolute[0];
+                       cdr.Result[4] = cdr.subq.Absolute[1];
+                       cdr.Result[5] = cdr.subq.Absolute[2];
+               }
+
+               cdr.Result[6] = 0;
+               cdr.Result[7] = 0;
 
                // Rayman: Logo freeze (resultready + dataready)
                cdr.ResultReady = 1;
                cdr.Stat = DataReady;
 
                SetResultSize(8);
-               psxHu32ref(0x1070) |= SWAP32((u32)0x4);
+               setIrq();
        }
 }
 
+// also handles seek
 void cdrPlayInterrupt()
 {
-       if( !cdr.Play ) return;
+       if (cdr.Seeked == SEEK_PENDING) {
+               if (cdr.Stat) {
+                       CDR_LOG_I("cdrom: seek stat hack\n");
+                       CDRMISC_INT(0x1000);
+                       return;
+               }
+               SetResultSize(1);
+               cdr.StatP |= STATUS_ROTATING;
+               cdr.StatP &= ~STATUS_SEEK;
+               cdr.Result[0] = cdr.StatP;
+               cdr.Seeked = SEEK_DONE;
+               if (cdr.Irq == 0) {
+                       cdr.Stat = Complete;
+                       setIrq();
+               }
+
+               memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
+               Find_CurTrack(cdr.SetSectorPlay);
+               ReadTrack(cdr.SetSectorPlay);
+               cdr.TrackChanged = FALSE;
+       }
+
+       if (!cdr.Play) return;
 
-#ifdef CDR_LOG
        CDR_LOG( "CDDA - %d:%d:%d\n",
                cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
-#endif
-       CDRPLAY_INT( cdReadTime );
 
-       if (!cdr.Irq && !cdr.Stat && (cdr.Mode & MODE_CDDA) && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
+       if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
+               StopCdda();
+               cdr.TrackChanged = TRUE;
+       }
+
+       if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
                cdrPlayInterrupt_Autopause();
 
+       if (!cdr.Play) return;
+
        cdr.SetSectorPlay[2]++;
        if (cdr.SetSectorPlay[2] == 75) {
                cdr.SetSectorPlay[2] = 0;
@@ -650,21 +592,24 @@ void cdrPlayInterrupt()
                }
        }
 
-       //Check_Shell(0);
+       CDRMISC_INT(cdReadTime);
+
+       // update for CdlGetlocP/autopause
+       generate_subq(cdr.SetSectorPlay);
 }
 
 void cdrInterrupt() {
        int i;
        unsigned char Irq = cdr.Irq;
-       struct SubQ *subq;
 
        // Reschedule IRQ
        if (cdr.Stat) {
-               CDR_INT( 0x100 );
+               CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
+               CDR_INT(0x1000);
                return;
        }
 
-       cdr.Irq = 0xff;
+       cdr.Irq = 0;
        cdr.Ctrl &= ~0x80;
 
        switch (Irq) {
@@ -672,7 +617,7 @@ void cdrInterrupt() {
                        SetResultSize(1);
                        cdr.StatP |= STATUS_ROTATING;
                        cdr.Result[0] = cdr.StatP;
-                       cdr.Stat = Acknowledge; 
+                       cdr.Stat = Acknowledge;
                        break;
 
                case CdlNop:
@@ -692,11 +637,33 @@ void cdrInterrupt() {
                        break;
 
                case CdlPlay:
-                       fake_subq_change = 0;
-
-                       if( cdr.Seeked == FALSE ) {
+                       if (cdr.Seeked == SEEK_PENDING) {
+                               // XXX: wrong, should seek instead..
                                memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
-                               cdr.Seeked = TRUE;
+                               cdr.Seeked = SEEK_DONE;
+                       }
+
+                       // BIOS CD Player
+                       // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
+
+                       if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
+                               CDR_LOG("PLAY Resume @ %d:%d:%d\n",
+                                       cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
+                       }
+                       else
+                       {
+                               int track = btoi( cdr.Param[0] );
+
+                               if (track <= cdr.ResultTN[1])
+                                       cdr.CurTrack = track;
+
+                               CDR_LOG("PLAY track %d\n", cdr.CurTrack);
+
+                               if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
+                                       cdr.SetSectorPlay[0] = cdr.ResultTD[2];
+                                       cdr.SetSectorPlay[1] = cdr.ResultTD[1];
+                                       cdr.SetSectorPlay[2] = cdr.ResultTD[0];
+                               }
                        }
 
                        /*
@@ -709,89 +676,16 @@ void cdrInterrupt() {
                        Wild 9: skip PREGAP + starting accurate SubQ
                        - plays tracks without retry play
                        */
-                       Set_Track();
-                       Find_CurTrack();
-                       ReadTrack( cdr.SetSectorPlay );
-
-
-                       // GameShark CD Player: Calls 2x + Play 2x
-                       if( cdr.FastBackward || cdr.FastForward ) {
-                               if( cdr.FastForward ) cdr.FastForward--;
-                               if( cdr.FastBackward ) cdr.FastBackward--;
-
-                               if( cdr.FastBackward == 0 && cdr.FastForward == 0 ) {
-                                       if( cdr.Play && CDR_getStatus(&stat) != -1 ) {
-                                               cdr.SetSectorPlay[0] = stat.Time[0];
-                                               cdr.SetSectorPlay[1] = stat.Time[1];
-                                               cdr.SetSectorPlay[2] = stat.Time[2];
-                                       }
-                               }
-                       }
-
-
-                       if (!Config.Cdda) {
-                               // BIOS CD Player
-                               // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
-
-                               // GameShark CD Player: Resume play
-                               if( cdr.ParamC == 0 ) {
-#ifdef CDR_LOG___0
-                                       CDR_LOG( "PLAY Resume @ %d:%d:%d\n",
-                                               cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
-#endif
-
-                                       //CDR_play( cdr.SetSectorPlay );
-                               }
-                               else
-                               {
-                                       // BIOS CD Player: Resume play
-                                       if( cdr.Param[0] == 0 ) {
-#ifdef CDR_LOG___0
-                                               CDR_LOG( "PLAY Resume T0 @ %d:%d:%d\n",
-                                                       cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
-#endif
-
-                                               //CDR_play( cdr.SetSectorPlay );
-                                       }
-                                       else {
-#ifdef CDR_LOG___0
-                                               CDR_LOG( "PLAY Resume Td @ %d:%d:%d\n",
-                                                       cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
-#endif
-
-                                               // BIOS CD Player: Allow track replaying
-                                               StopCdda();
-
-
-                                               cdr.CurTrack = btoi( cdr.Param[0] );
-
-                                               if (CDR_getTN(cdr.ResultTN) != -1) {
-                                                       // check last track
-                                                       if (cdr.CurTrack > cdr.ResultTN[1])
-                                                               cdr.CurTrack = cdr.ResultTN[1];
-
-                                                       if (CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD) != -1) {
-                                                               cdr.SetSectorPlay[0] = cdr.ResultTD[2];
-                                                               cdr.SetSectorPlay[1] = cdr.ResultTD[1];
-                                                               cdr.SetSectorPlay[2] = cdr.ResultTD[0];
-
-                                                               // reset data
-                                                               Set_Track();
-                                                               Find_CurTrack();
-                                                               ReadTrack( cdr.SetSectorPlay );
-
-                                                               //CDR_play(cdr.SetSectorPlay);
-                                                       }
-                                               }
-                                       }
-                               }
-                       }
+                       Find_CurTrack(cdr.SetSectorPlay);
+                       ReadTrack(cdr.SetSectorPlay);
+                       cdr.TrackChanged = FALSE;
 
+                       if (!Config.Cdda)
+                               CDR_play(cdr.SetSectorPlay);
 
                        // Vib Ribbon: gameplay checks flag
                        cdr.StatP &= ~STATUS_SEEK;
 
-
                        cdr.CmdProcess = 0;
                        SetResultSize(1);
                        cdr.StatP |= STATUS_ROTATING;
@@ -804,7 +698,7 @@ void cdrInterrupt() {
                        // BIOS player - set flag again
                        cdr.Play = TRUE;
 
-                       CDRPLAY_INT( cdReadTime );
+                       CDRMISC_INT( cdReadTime );
                        break;
 
                case CdlForward:
@@ -948,50 +842,11 @@ void cdrInterrupt() {
                        break;
 
                case CdlGetlocP:
-                       // GameShark CDX CD Player: uses 17 bytes output (wraps around)
-                       SetResultSize(17);
-                       memset( cdr.Result, 0, 16 );
-
-                       subq = (struct SubQ *)CDR_getBufferSub();
-
-                       if (subq != NULL) {
-                               cdr.Result[0] = subq->TrackNumber;
-                               cdr.Result[1] = subq->IndexNumber;
-                               memcpy(cdr.Result + 2, subq->TrackRelativeAddress, 3);
-                               memcpy(cdr.Result + 5, subq->AbsoluteAddress, 3);
-
-
-                               // subQ integrity check - data only (skip audio)
-                               if( subq->TrackNumber == 1 && stat.Type == 0x01 ) {
-                               if (calcCrc((u8 *)subq + 12, 10) != (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
-                                       memset(cdr.Result + 2, 0, 3 + 3); // CRC wrong, wipe out time data
-                               }
-                               }
-                       } else {
-                               if( cdr.Play == FALSE || !(cdr.Mode & MODE_CDDA) || !(cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)) )
-                                       Create_Fake_Subq();
-
-
-                               // track # / index #
-                               cdr.Result[0] = itob(cdr.CurTrack);
-                               cdr.Result[1] = itob(fake_subq_index);
-
-                               // local
-                               cdr.Result[2] = itob( fake_subq_local[0] );
-                               cdr.Result[3] = itob( fake_subq_local[1] );
-                               cdr.Result[4] = itob( fake_subq_local[2] );
-
-                               // absolute
-                               cdr.Result[5] = itob( fake_subq_real[0] );
-                               cdr.Result[6] = itob( fake_subq_real[1] );
-                               cdr.Result[7] = itob( fake_subq_real[2] );
-                       }
+                       SetResultSize(8);
+                       memcpy(&cdr.Result, &cdr.subq, 8);
 
-                       // redump.org - wipe time
-                       /*if( !cdr.Play && CheckSBI(cdr.Result+5) ) {
-                               memset( cdr.Result+2, 0, 6 );
-                       }
-                       */
+                       if (!cdr.Play && !cdr.Reading)
+                               cdr.Result[1] = 0; // HACK?
 
                        cdr.Stat = Acknowledge;
                        break;
@@ -1034,6 +889,7 @@ void cdrInterrupt() {
                        break;
 
                case CdlSeekL:
+               case CdlSeekP:
                        SetResultSize(1);
                        cdr.StatP |= STATUS_ROTATING;
                        cdr.Result[0] = cdr.StatP;
@@ -1053,45 +909,8 @@ void cdrInterrupt() {
                        Rockman X5 = 0.5-4x
                        - fix capcom logo
                        */
-                       AddIrqQueue(CdlSeekL + 0x20, cdReadTime * 4);
-                       break;
-
-               case CdlSeekL + 0x20:
-                       SetResultSize(1);
-                       cdr.StatP |= STATUS_ROTATING;
-                       cdr.StatP &= ~STATUS_SEEK;
-                       cdr.Result[0] = cdr.StatP;
-                       cdr.Seeked = TRUE;
-                       cdr.Stat = Complete;
-
-
-                       // Mega Man Legends 2: must update read cursor for getlocp
-                       ReadTrack( cdr.SetSector );
-                       break;
-
-               case CdlSeekP:
-                       SetResultSize(1);
-                       cdr.StatP |= STATUS_ROTATING;
-                       cdr.Result[0] = cdr.StatP;
-                       cdr.StatP |= STATUS_SEEK;
-                       cdr.Stat = Acknowledge;
-                       AddIrqQueue(CdlSeekP + 0x20, cdReadTime * 1);
-                       break;
-
-               case CdlSeekP + 0x20:
-                       SetResultSize(1);
-                       cdr.StatP |= STATUS_ROTATING;
-                       cdr.StatP &= ~STATUS_SEEK;
-                       cdr.Result[0] = cdr.StatP;
-                       cdr.Stat = Complete;
-                       cdr.Seeked = TRUE;
-
-                       // GameShark Music Player
-                       memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
-
-                       // Tomb Raider 2: must update read cursor for getlocp
-                       Find_CurTrack();
-                       ReadTrack( cdr.SetSectorPlay );
+                       CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
+                       cdr.Seeked = SEEK_PENDING;
                        break;
 
                case CdlTest:
@@ -1122,34 +941,23 @@ void cdrInterrupt() {
 
                case CdlID + 0x20:
                        SetResultSize(8);
+                       cdr.Result[0] = cdr.StatP;
+                       cdr.Result[1] = 0;
+                       cdr.Result[2] = 0;
+                       cdr.Result[3] = 0;
 
+                       // 0x10 - audio | 0x80 - unlicensed
                        if (CDR_getStatus(&stat) == -1) {
-                               cdr.Result[0] = 0x00; // 0x08 and cdr.Result[1]|0x10 : audio cd, enters cd player
                                cdr.Result[1] = 0x80; // 0x80 leads to the menu in the bios, else loads CD
                        }
                        else {
-                               if (stat.Type == 2) {
-                                       // Music CD
-                                       cdr.Result[0] = 0x08;
-                                       cdr.Result[1] = 0x10;
-
+                               if (stat.Type == 2)
+                                       cdr.Result[1] |= 0x10;
+                               if (CdromId[0] == '\0')
                                        cdr.Result[1] |= 0x80;
-                               }
-                               else {
-                                       // Data CD
-                                       if (CdromId[0] == '\0') {
-                                               cdr.Result[0] = 0x00;
-                                               cdr.Result[1] = 0x80;
-                                       }
-                                       else {
-                                               cdr.Result[0] = 0x08;
-                                               cdr.Result[1] = 0x00;
-                                       }
-                               }
                        }
+                       cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
 
-                       cdr.Result[2] = 0x00;
-                       cdr.Result[3] = 0x00;
                        strncpy((char *)&cdr.Result[4], "PCSX", 4);
                        cdr.Stat = Complete;
                        break;
@@ -1181,7 +989,7 @@ void cdrInterrupt() {
                        cdr.StatP |= STATUS_ROTATING;
                        cdr.Result[0] = cdr.StatP;
                        cdr.Stat = Acknowledge;
-                       AddIrqQueue(CdlReadToc + 0x20, 0x800);
+                       AddIrqQueue(CdlReadToc + 0x20, cdReadTime * 16);
                        break;
 
                case CdlReadToc + 0x20:
@@ -1191,44 +999,31 @@ void cdrInterrupt() {
                        cdr.Stat = Complete;
                        break;
 
-               case AUTOPAUSE:
-                       cdr.OCUP = 0;
-/*                     SetResultSize(1);
-                       StopCdda();
-                       StopReading();
-                       cdr.OCUP = 0;
-                       cdr.StatP&=~0x20;
-                       cdr.StatP|= 0x2;
-                       cdr.Result[0] = cdr.StatP;
-                       cdr.Stat = DataEnd;
-*/                     AddIrqQueue(CdlPause, 0x800);
-                       break;
-
-               case READ_ACK:
+               case CdlReadN:
+               case CdlReadS:
                        if (!cdr.Reading) return;
 
-
                        // Fighting Force 2 - update subq time immediately
                        // - fixes new game
-                       ReadTrack( cdr.SetSector );
+                       Find_CurTrack(cdr.SetSector);
+                       ReadTrack(cdr.SetSector);
 
 
                        // Crusaders of Might and Magic - update getlocl now
                        // - fixes cutscene speech
                        {
                                u8 *buf = CDR_getBuffer();
-                               memcpy(cdr.Transfer, buf, 8);
+                               if (buf != NULL)
+                                       memcpy(cdr.Transfer, buf, 8);
                        }
-                       
-                       
+
                        /*
                        Duke Nukem: Land of the Babes - seek then delay read for one frame
                        - fixes cutscenes
+                       C-12 - Final Resistance - doesn't like seek
                        */
 
-                       if (!cdr.Seeked) {
-                               cdr.Seeked = TRUE;
-
+                       if (cdr.Seeked != SEEK_DONE) {
                                cdr.StatP |= STATUS_SEEK;
                                cdr.StatP &= ~STATUS_READ;
 
@@ -1250,9 +1045,6 @@ void cdrInterrupt() {
                        cdr.Stat = Acknowledge;
                        break;
 
-               case 0xff:
-                       return;
-
                default:
                        cdr.Stat = Complete;
                        break;
@@ -1260,15 +1052,67 @@ void cdrInterrupt() {
 
        Check_Shell( Irq );
 
-       if (cdr.Stat != NoIntr && cdr.Reg2 != 0x18) {
-               psxHu32ref(0x1070) |= SWAP32((u32)0x4);
-       }
+       cdr.ParamC = 0;
+
+       setIrq();
 
-#ifdef CDR_LOG
-       CDR_LOG("cdrInterrupt() Log: CDR Interrupt IRQ %x\n", Irq);
+#ifdef CDR_LOG_CMD_IRQ
+       SysPrintf("IRQ %d cmd %02x stat %02x: ",
+               !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
+       for (i = 0; i < cdr.ResultC; i++)
+               SysPrintf("%02x ", cdr.Result[i]);
+       SysPrintf("\n");
 #endif
 }
 
+#ifdef __ARM_ARCH_7A__
+ #define ssat32_to_16(v) \
+  asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
+#else
+ #define ssat32_to_16(v) do { \
+  if (v < -32768) v = -32768; \
+  else if (v > 32767) v = 32767; \
+ } while (0)
+#endif
+
+void cdrAttenuate(s16 *buf, int samples, int stereo)
+{
+       int i, l, r;
+       int ll = cdr.AttenuatorLeftToLeft;
+       int lr = cdr.AttenuatorLeftToRight;
+       int rl = cdr.AttenuatorRightToLeft;
+       int rr = cdr.AttenuatorRightToRight;
+
+       if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
+               return;
+
+       if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
+               return;
+
+       if (stereo) {
+               for (i = 0; i < samples; i++) {
+                       l = buf[i * 2];
+                       r = buf[i * 2 + 1];
+                       l = (l * ll + r * rl) >> 7;
+                       r = (r * rr + l * lr) >> 7;
+                       ssat32_to_16(l);
+                       ssat32_to_16(r);
+                       buf[i * 2] = l;
+                       buf[i * 2 + 1] = r;
+               }
+       }
+       else {
+               for (i = 0; i < samples; i++) {
+                       l = buf[i];
+                       l = l * (ll + rl) >> 7;
+                       //r = r * (rr + lr) >> 7;
+                       ssat32_to_16(l);
+                       //ssat32_to_16(r);
+                       buf[i] = l;
+               }
+       }
+}
+
 void cdrReadInterrupt() {
        u8 *buf;
 
@@ -1276,30 +1120,26 @@ void cdrReadInterrupt() {
                return;
 
        if (cdr.Irq || cdr.Stat) {
-               CDREAD_INT(0x100);
+               CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
+               CDREAD_INT(0x1000);
                return;
        }
 
-#ifdef CDR_LOG
-       CDR_LOG("cdrReadInterrupt() Log: KEY END");
-#endif
-
        cdr.OCUP = 1;
        SetResultSize(1);
        cdr.StatP |= STATUS_READ|STATUS_ROTATING;
        cdr.StatP &= ~STATUS_SEEK;
        cdr.Result[0] = cdr.StatP;
+       cdr.Seeked = SEEK_DONE;
 
-       ReadTrack( cdr.SetSector );
+       ReadTrack(cdr.SetSector);
 
        buf = CDR_getBuffer();
        if (buf == NULL)
                cdr.RErr = -1;
 
        if (cdr.RErr == -1) {
-#ifdef CDR_LOG
-               fprintf(emuLog, "cdrReadInterrupt() Log: err\n");
-#endif
+               CDR_LOG_I("cdrReadInterrupt() Log: err\n");
                memset(cdr.Transfer, 0, DATA_SIZE);
                cdr.Stat = DiskError;
                cdr.Result[0] |= STATUS_ERROR;
@@ -1311,9 +1151,7 @@ void cdrReadInterrupt() {
        CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
 
 
-#ifdef CDR_LOG
-       fprintf(emuLog, "cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
-#endif
+       CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
 
        if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
                // Firemen 2: Multi-XA files - briefings, cutscenes
@@ -1322,20 +1160,14 @@ void cdrReadInterrupt() {
                        cdr.Channel = cdr.Transfer[4 + 1];
                }
 
-               if ((cdr.Transfer[4 + 2] & 0x4) &&
+               if((cdr.Transfer[4 + 2] & 0x4) &&
                         (cdr.Transfer[4 + 1] == cdr.Channel) &&
-                       (cdr.Transfer[4 + 0] == cdr.File)) {
+                        (cdr.Transfer[4 + 0] == cdr.File)) {
                        int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
-
                        if (!ret) {
+                               cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
                                SPU_playADPCMchannel(&cdr.Xa);
                                cdr.FirstSector = 0;
-
-
-                               // Crash Team Racing: music, speech
-
-                               // signal ADPCM data ready
-                               psxHu32ref(0x1070) |= SWAP32((u32)0x200);
                        }
                        else cdr.FirstSector = -1;
                }
@@ -1353,18 +1185,7 @@ void cdrReadInterrupt() {
 
        cdr.Readed = 0;
 
-       // G-Police: Don't autopause ADPCM even if mode set (music)
-       if ((cdr.Transfer[4 + 2] & 0x80) && (cdr.Mode & MODE_AUTOPAUSE) &&
-                       (cdr.Transfer[4 + 2] & 0x4) != 0x4 ) { // EOF
-#ifdef CDR_LOG
-               CDR_LOG("cdrReadInterrupt() Log: Autopausing read\n");
-#endif
-//             AddIrqQueue(AUTOPAUSE, 0x2000);
-               AddIrqQueue(CdlPause, 0x2000);
-       }
-       else {
-               CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
-       }
+       CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
 
        /*
        Croc 2: $40 - only FORM1 (*)
@@ -1372,22 +1193,20 @@ void cdrReadInterrupt() {
        Sim Theme Park - no adpcm at all (zero)
        */
 
-       if( (cdr.Mode & MODE_STRSND) == 0 || (cdr.Transfer[4+2] & 0x4) != 0x4 ) {
+       if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
                cdr.Stat = DataReady;
-       } else {
-               // Breath of Fire 3 - fix inn sleeping
-               // Rockman X5 - no music restart problem
-               cdr.Stat = NoIntr;
+               setIrq();
        }
-       psxHu32ref(0x1070) |= SWAP32((u32)0x4);
+
+       // update for CdlGetlocP
+       ReadTrack(cdr.SetSector);
 
        Check_Shell(0);
 }
 
 /*
 cdrRead0:
-       bit 0 - 0 REG1 command send / 1 REG1 data read
-       bit 1 - 0 data transfer finish / 1 data transfer ready/in progress
+       bit 0,1 - mode
        bit 2 - unknown
        bit 3 - unknown
        bit 4 - unknown
@@ -1410,67 +1229,52 @@ unsigned char cdrRead0(void) {
        // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
        cdr.Ctrl |= 0x18;
 
-#ifdef CDR_LOG
-       CDR_LOG("cdrRead0() Log: CD0 Read: %x\n", cdr.Ctrl);
-#endif
+       CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
 
        return psxHu8(0x1800) = cdr.Ctrl;
 }
 
-/*
-cdrWrite0:
-       0 - to send a command / 1 - to get the result
-*/
-
 void cdrWrite0(unsigned char rt) {
-#ifdef CDR_LOG
-       CDR_LOG("cdrWrite0() Log: CD0 write: %x\n", rt);
-#endif
-       cdr.Ctrl = rt | (cdr.Ctrl & ~0x3);
+       CDR_LOG_IO("cdr w0: %02x\n", rt);
 
-       if (rt == 0) {
-               cdr.ParamP = 0;
-               cdr.ParamC = 0;
-               cdr.ResultReady = 0;
-       }
+       cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
 }
 
 unsigned char cdrRead1(void) {
-    if (cdr.ResultReady) { // && cdr.Ctrl & 0x1) {
-               // GameShark CDX CD Player: uses 17 bytes output (wraps around)
+       if ((cdr.ResultP & 0xf) < cdr.ResultC)
                psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
-               cdr.ResultP++;
-               if (cdr.ResultP == cdr.ResultC)
-                       cdr.ResultReady = 0;
-       } else {
+       else
                psxHu8(0x1801) = 0;
-       }
-#ifdef CDR_LOG
-       CDR_LOG("cdrRead1() Log: CD1 Read: %x\n", psxHu8(0x1801));
-#endif
+       cdr.ResultP++;
+       if (cdr.ResultP == cdr.ResultC)
+               cdr.ResultReady = 0;
+
+       CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
+
        return psxHu8(0x1801);
 }
 
 void cdrWrite1(unsigned char rt) {
+       u8 set_loc[3];
        int i;
 
-#ifdef CDR_LOG
-       CDR_LOG("cdrWrite1() Log: CD1 write: %x (%s)\n", rt, CmdName[rt]);
-#endif
-
+       CDR_LOG_IO("cdr w1: %02x\n", rt);
 
-       // Tekken: CDXA fade-out
-       if( (cdr.Ctrl & 3) == 3 ) {
-               //cdr.AttenuatorRight[0] = rt;
+       switch (cdr.Ctrl & 3) {
+       case 0:
+               break;
+       case 3:
+               cdr.AttenuatorRightToRightT = rt;
+               return;
+       default:
+               return;
        }
 
-
-//     psxHu8(0x1801) = rt;
        cdr.Cmd = rt;
        cdr.OCUP = 0;
 
-#ifdef CDRCMD_DEBUG
-       SysPrintf("cdrWrite1() Log: CD1 write: %x (%s)", rt, CmdName[rt]);
+#ifdef CDR_LOG_CMD_IRQ
+       SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
        if (cdr.ParamC) {
                SysPrintf(" Param[%d] = {", cdr.ParamC);
                for (i = 0; i < cdr.ParamC; i++)
@@ -1481,117 +1285,74 @@ void cdrWrite1(unsigned char rt) {
        }
 #endif
 
-       if (cdr.Ctrl & 0x1) return;
+       cdr.ResultReady = 0;
+       cdr.Ctrl |= 0x80;
+       // cdr.Stat = NoIntr; 
+       AddIrqQueue(cdr.Cmd, 0x800);
 
        switch (cdr.Cmd) {
-       case CdlSync:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlNop:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-
-               // Twisted Metal 3 - fix music
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
+       case CdlSync:
+       case CdlNop:
+       case CdlForward:
+       case CdlBackward:
+       case CdlReadT:
+       case CdlTest:
+       case CdlID:
+       case CdlReadToc:
+       case CdlGetmode:
+       case CdlGetlocL:
+       case CdlGetlocP:
+       case CdlGetTD:
+               break;
 
-       case CdlSetloc:
+       case CdlSetloc:
                StopReading();
-               cdr.Seeked = FALSE;
                for (i = 0; i < 3; i++)
-                       cdr.SetSector[i] = btoi(cdr.Param[i]);
-               cdr.SetSector[3] = 0;
+                       set_loc[i] = btoi(cdr.Param[i]);
 
-               /*
-                  if ((cdr.SetSector[0] | cdr.SetSector[1] | cdr.SetSector[2]) == 0) {
-                *(u32 *)cdr.SetSector = *(u32 *)cdr.SetSectorSeek;
-                }*/
+               // FIXME: clean up this SetSector/SetSectorPlay mess,
+               // there should be single var tracking current sector pos
+               if (cdr.Play)
+                       i = msf2sec(cdr.SetSectorPlay);
+               else
+                       i = msf2sec(cdr.SetSector);
+               i = abs(i - msf2sec(set_loc));
+               if (i > 16)
+                       cdr.Seeked = SEEK_PENDING;
 
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr;
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
+               memcpy(cdr.SetSector, set_loc, 3);
+               cdr.SetSector[3] = 0;
+               break;
 
-       case CdlPlay:
+       case CdlPlay:
                // Vib Ribbon: try same track again
                StopCdda();
 
-               if (!cdr.SetSector[0] & !cdr.SetSector[1] & !cdr.SetSector[2]) {
-                       if (CDR_getTN(cdr.ResultTN) != -1) {
-                               if (cdr.CurTrack > cdr.ResultTN[1])
-                                       cdr.CurTrack = cdr.ResultTN[1];
-                               if (CDR_getTD((unsigned char)(cdr.CurTrack), cdr.ResultTD) != -1) {
-                                       int tmp = cdr.ResultTD[2];
-                                       cdr.ResultTD[2] = cdr.ResultTD[0];
-                                       cdr.ResultTD[0] = tmp;
-                                       if (!Config.Cdda) CDR_play(cdr.ResultTD);
-                               }
-                       }
-               } else if (!Config.Cdda) {
-                       CDR_play(cdr.SetSector);
-               }
-
                // Vib Ribbon - decoded buffer IRQ for CDDA reading
                // - fixes ribbon timing + music CD mode
-               //TODO?
                //CDRDBUF_INT( PSXCLK / 44100 * 0x100 );
 
-
                cdr.Play = TRUE;
 
                cdr.StatP |= STATUS_SEEK;
                cdr.StatP &= ~STATUS_ROTATING;
+               break;
 
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlForward:
-               //if (cdr.CurTrack < 0xaa)
-               //      cdr.CurTrack++;
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlBackward:
-               //if (cdr.CurTrack > 1)
-               //cdr.CurTrack--;
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlReadN:
-               cdr.Irq = 0;
+       case CdlReadN:
                StopReading();
-               cdr.Ctrl|= 0x80;
-               cdr.Stat = NoIntr; 
-               StartReading(1, 0x800);
+               cdr.Reading = 1;
+               cdr.FirstSector = 1;
+               cdr.Readed = 0xff;
                break;
 
-       case CdlStandby:
+       case CdlStandby:
                StopCdda();
                StopReading();
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr;
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
+               break;
 
-       case CdlStop:
+       case CdlStop:
                // GameShark CD Player: Reset CDDA to track start
-               if( cdr.Play && CDR_getStatus(&stat) != -1 ) {
-                       cdr.SetSectorPlay[0] = stat.Time[0];
-                       cdr.SetSectorPlay[1] = stat.Time[1];
-                       cdr.SetSectorPlay[2] = stat.Time[2];
-
-                       Find_CurTrack();
-
-
+               if (cdr.Play) {
                        // grab time for current track
                        CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
 
@@ -1602,13 +1363,9 @@ void cdrWrite1(unsigned char rt) {
 
                StopCdda();
                StopReading();
+               break;
 
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr;
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlPause:
+       case CdlPause:
                /*
                   GameShark CD Player: save time for resume
 
@@ -1617,61 +1374,41 @@ void cdrWrite1(unsigned char rt) {
 
                StopCdda();
                StopReading();
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr;
-
-               AddIrqQueue(cdr.Cmd, 0x800);
                break;
 
        case CdlReset:
-       case CdlInit:
+       case CdlInit:
+               cdr.Seeked = SEEK_DONE;
                StopCdda();
                StopReading();
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlMute:
-               cdr.Muted = TRUE;
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
+               break;
 
+       case CdlMute:
+               cdr.Muted = TRUE;
                        // Duke Nukem - Time to Kill
                        // - do not directly set cd-xa volume
                        //SPU_writeRegister( H_CDLeft, 0x0000 );
                        //SPU_writeRegister( H_CDRight, 0x0000 );
-               break;
+               break;
 
-       case CdlDemute:
-               cdr.Muted = FALSE;
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
+       case CdlDemute:
+               cdr.Muted = FALSE;
 
                        // Duke Nukem - Time to Kill
                        // - do not directly set cd-xa volume
                        //SPU_writeRegister( H_CDLeft, 0x7f00 );
                        //SPU_writeRegister( H_CDRight, 0x7f00 );
-               break;
+               break;
 
        case CdlSetfilter:
                cdr.File = cdr.Param[0];
                cdr.Channel = cdr.Param[1];
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
                break;
 
        case CdlSetmode:
-#ifdef CDR_LOG
                CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
-#endif 
+
                cdr.Mode = cdr.Param[0];
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
 
                // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
                // - fixes choppy movie sound
@@ -1679,116 +1416,32 @@ void cdrWrite1(unsigned char rt) {
                        StopCdda();
                break;
 
-       case CdlGetmode:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlGetlocL:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-
-               // Crusaders of Might and Magic - cutscene speech
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlGetlocP:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-
-               // GameShark CDX / Lite Player: pretty narrow time window
-               // - doesn't always work due to time inprecision
-               //AddIrqQueue(cdr.Cmd, 0x28);
-
-               // Tomb Raider 2 - cdda
-               //AddIrqQueue(cdr.Cmd, 0x40);
-
-               // rearmed: the above works in pcsxr-svn, but breaks here
-               // (TOCA world touring cars), perhaps some other code is not merged yet
-               AddIrqQueue(cdr.Cmd, 0x1000);
-               break;
-
        case CdlGetTN:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
                //AddIrqQueue(cdr.Cmd, 0x800);
 
                // GameShark CDX CD Player: very long time
                AddIrqQueue(cdr.Cmd, 0x100000);
                break;
 
-       case CdlGetTD:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
        case CdlSeekL:
-//                     ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-
-               StopCdda();
-               StopReading();
-
-               break;
-
        case CdlSeekP:
-//             ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-
                // Tomb Raider 2 - reset cdda
                StopCdda();
                StopReading();
-
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       // Destruction Derby: read TOC? GetTD after this
-       case CdlReadT:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr;
-               AddIrqQueue(cdr.Cmd, 0x800);
                break;
 
-       case CdlTest:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       case CdlID:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
        case CdlReadS:
-               cdr.Irq = 0;
                StopReading();
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               StartReading(2, 0x800);
+               cdr.Reading = 2;
+               cdr.FirstSector = 1;
+               cdr.Readed = 0xff;
                break;
 
-       case CdlReadToc:
-               cdr.Ctrl |= 0x80;
-               cdr.Stat = NoIntr; 
-               AddIrqQueue(cdr.Cmd, 0x800);
-               break;
-
-       default:
-#ifdef CDR_LOG
-               CDR_LOG("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
-#endif
+       default:
+               cdr.ParamC = 0;
+               CDR_LOG_I("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
                return;
        }
-       if (cdr.Stat != NoIntr) {
-               psxHu32ref(0x1070) |= SWAP32((u32)0x4);
-       }
 }
 
 unsigned char cdrRead2(void) {
@@ -1797,128 +1450,81 @@ unsigned char cdrRead2(void) {
        if (cdr.Readed == 0) {
                ret = 0;
        } else {
-               ret = *cdr.pTransfer++;
+               ret = *pTransfer++;
        }
 
-#ifdef CDR_LOG
-       CDR_LOG("cdrRead2() Log: CD2 Read: %x\n", ret);
-#endif
+       CDR_LOG_IO("cdr r2: %02x\n", ret);
        return ret;
 }
 
 void cdrWrite2(unsigned char rt) {
-#ifdef CDR_LOG
-       CDR_LOG("cdrWrite2() Log: CD2 write: %x\n", rt);
-#endif
-
-       // Tekken: CDXA fade-out
-       if( (cdr.Ctrl & 3) == 2 ) {
-               //cdr.AttenuatorLeft[0] = rt;
-       }
-       else if( (cdr.Ctrl & 3) == 3 ) {
-               //cdr.AttenuatorRight[1] = rt;
-       }
-
+       CDR_LOG_IO("cdr w2: %02x\n", rt);
 
-       if (cdr.Ctrl & 0x1) {
-               switch (rt) {
-                       case 0x07:
-                               cdr.ParamP = 0;
-                               cdr.ParamC = 0;
-                               cdr.ResultReady = 1; //0;
-                               cdr.Ctrl &= ~3; //cdr.Ctrl = 0;
-                               break;
-
-                       default:
-                               cdr.Reg2 = rt;
-                               break;
-               }
-       } else if (!(cdr.Ctrl & 0x1) && cdr.ParamP < 8) {
-               cdr.Param[cdr.ParamP++] = rt;
-               cdr.ParamC++;
+       switch (cdr.Ctrl & 3) {
+       case 0:
+               if (cdr.ParamC < 8) // FIXME: size and wrapping
+                       cdr.Param[cdr.ParamC++] = rt;
+               return;
+       case 1:
+               cdr.Reg2 = rt;
+               setIrq();
+               return;
+       case 2:
+               cdr.AttenuatorLeftToLeftT = rt;
+               return;
+       case 3:
+               cdr.AttenuatorRightToLeftT = rt;
+               return;
        }
 }
 
 unsigned char cdrRead3(void) {
-       if (cdr.Stat) {
-               if (cdr.Ctrl & 0x1)
-                       psxHu8(0x1803) = cdr.Stat | 0xE0;
-               else
-                       psxHu8(0x1803) = 0xff;
-       } else {
-               psxHu8(0x1803) = 0;
-       }
-#ifdef CDR_LOG
-       CDR_LOG("cdrRead3() Log: CD3 Read: %x\n", psxHu8(0x1803));
-#endif
+       if (cdr.Ctrl & 0x1)
+               psxHu8(0x1803) = cdr.Stat | 0xE0;
+       else
+               psxHu8(0x1803) = cdr.Reg2 | 0xE0;
+
+       CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
        return psxHu8(0x1803);
 }
 
 void cdrWrite3(unsigned char rt) {
-#ifdef CDR_LOG
-       CDR_LOG("cdrWrite3() Log: CD3 write: %x\n", rt);
-#endif
-/*
-       // Tekken: CDXA fade-out
-       if( (cdr.Ctrl & 3) == 2 ) {
-               cdr.AttenuatorLeft[1] = rt;
-       }
-       else if( (cdr.Ctrl & 3) == 3 && rt == 0x20 ) {
-#ifdef CDR_LOG
-               CDR_LOG( "CD-XA Volume: %X %X | %X %X\n",
-                       cdr.AttenuatorLeft[0], cdr.AttenuatorLeft[1],
-                       cdr.AttenuatorRight[0], cdr.AttenuatorRight[1] );
-#endif
-       }
-*/
+       CDR_LOG_IO("cdr w3: %02x\n", rt);
 
-       // GameShark CDX CD Player: Irq timing mania
-       if( rt == 0 &&
-                       cdr.Irq != 0 && cdr.Irq != 0xff &&
-                       cdr.ResultReady == 0 ) {
+       switch (cdr.Ctrl & 3) {
+       case 0:
+               break; // transfer
+       case 1:
+               cdr.Stat &= ~rt;
 
-               // GS CDX: ~0x28 cycle timing - way too precise
-               if( cdr.Irq == CdlGetlocP ) {
-                       cdrInterrupt();
-
-                       psxRegs.interrupt &= ~(1 << PSXINT_CDR);
-               }
-       }
-
-
-       if (rt == 0x07 && cdr.Ctrl & 0x1) {
-               cdr.Stat = 0;
-
-               if (cdr.Irq == 0xff) {
-                       cdr.Irq = 0;
-                       return;
-               }
-
-               // XA streaming - incorrect timing because of this reschedule
-               // - Final Fantasy Tactics
-               // - various other games
-
-               /*
-               if (cdr.Reading && !cdr.ResultReady) {
-                       CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
+               if (rt & 0x40)
+                       cdr.ParamC = 0;
+               return;
+       case 2:
+               cdr.AttenuatorLeftToRightT = rt;
+               return;
+       case 3:
+               if (rt & 0x20) {
+                       memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
+                       CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
+                               cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
+                               cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
                }
-               */
-
                return;
        }
 
-       if (rt == 0x80 && !(cdr.Ctrl & 0x1) && cdr.Readed == 0) {
+       if ((rt & 0x80) && cdr.Readed == 0) {
                cdr.Readed = 1;
-               cdr.pTransfer = cdr.Transfer;
+               pTransfer = cdr.Transfer;
 
                switch (cdr.Mode & 0x30) {
                        case MODE_SIZE_2328:
                        case 0x00:
-                               cdr.pTransfer += 12;
+                               pTransfer += 12;
                                break;
 
                        case MODE_SIZE_2340:
-                               cdr.pTransfer += 0;
+                               pTransfer += 0;
                                break;
 
                        default:
@@ -1929,19 +1535,16 @@ void cdrWrite3(unsigned char rt) {
 
 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
        u32 cdsize;
+       int size;
        u8 *ptr;
 
-#ifdef CDR_LOG
        CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
-#endif
 
        switch (chcr) {
                case 0x11000000:
                case 0x11400100:
                        if (cdr.Readed == 0) {
-#ifdef CDR_LOG
                                CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
-#endif
                                break;
                        }
 
@@ -1951,19 +1554,18 @@ void psxDma3(u32 madr, u32 bcr, u32 chcr) {
                        // - fix boot
                        if( cdsize == 0 )
                        {
-                               switch (cdr.Mode & 0x30) {
-                                       case 0x00: cdsize = 2048; break;
-                                       case MODE_SIZE_2328: cdsize = 2328; break;
+                               switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
                                        case MODE_SIZE_2340: cdsize = 2340; break;
+                                       case MODE_SIZE_2328: cdsize = 2328; break;
+                                       default:
+                                       case MODE_SIZE_2048: cdsize = 2048; break;
                                }
                        }
 
 
                        ptr = (u8 *)PSXM(madr);
                        if (ptr == NULL) {
-#ifdef CPU_LOG
                                CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
-#endif
                                break;
                        }
 
@@ -1973,19 +1575,16 @@ void psxDma3(u32 madr, u32 bcr, u32 chcr) {
                        - CdlPlay
                        - Spams DMA3 and gets buffer overrun
                        */
-
-                       if( (cdr.pTransfer-cdr.Transfer) + cdsize > 2352 )
+                       size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
+                       if (size > cdsize)
+                               size = cdsize;
+                       if (size > 0)
                        {
-                               // avoid crash - probably should wrap here
-                               //memcpy(ptr, cdr.pTransfer, cdsize);
-                       }
-                       else
-                       {
-                               memcpy(ptr, cdr.pTransfer, cdsize);
+                               memcpy(ptr, pTransfer, size);
                        }
 
                        psxCpu->Clear(madr, cdsize / 4);
-                       cdr.pTransfer += cdsize;
+                       pTransfer += cdsize;
 
 
                        // burst vs normal
@@ -1998,9 +1597,7 @@ void psxDma3(u32 madr, u32 bcr, u32 chcr) {
                        return;
 
                default:
-#ifdef CDR_LOG
                        CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
-#endif
                        break;
        }
 
@@ -2010,8 +1607,22 @@ void psxDma3(u32 madr, u32 bcr, u32 chcr) {
 
 void cdrDmaInterrupt()
 {
-       HW_DMA3_CHCR &= SWAP32(~0x01000000);
-       DMA_INTERRUPT(3);
+       if (HW_DMA3_CHCR & SWAP32(0x01000000))
+       {
+               HW_DMA3_CHCR &= SWAP32(~0x01000000);
+               DMA_INTERRUPT(3);
+       }
+}
+
+static void getCdInfo(void)
+{
+       u8 tmp;
+
+       CDR_getTN(cdr.ResultTN);
+       CDR_getTD(0, cdr.SetSectorEnd);
+       tmp = cdr.SetSectorEnd[0];
+       cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
+       cdr.SetSectorEnd[2] = tmp;
 }
 
 void cdrReset() {
@@ -2019,25 +1630,60 @@ void cdrReset() {
        cdr.CurTrack = 1;
        cdr.File = 1;
        cdr.Channel = 1;
-}
+       cdr.Reg2 = 0x1f;
+       cdr.Stat = NoIntr;
+       pTransfer = cdr.Transfer;
+
+       // BIOS player - default values
+       cdr.AttenuatorLeftToLeft = 0x80;
+       cdr.AttenuatorLeftToRight = 0x00;
+       cdr.AttenuatorRightToLeft = 0x00;
+       cdr.AttenuatorRightToRight = 0x80;
 
-int cdrFreeze(gzFile f, int Mode) {
-       uintptr_t tmp;
+       getCdInfo();
+}
 
+int cdrFreeze(void *f, int Mode) {
+       u32 tmp;
+       u8 tmpp[3];
 
-       if( Mode == 0 ) {
-               StopCdda();
-       }
+       if (Mode == 0 && !Config.Cdda)
+               CDR_stop();
        
+       cdr.freeze_ver = 0x63647201;
        gzfreeze(&cdr, sizeof(cdr));
        
-       if (Mode == 1)
-               tmp = cdr.pTransfer - cdr.Transfer;
+       if (Mode == 1) {
+               cdr.ParamP = cdr.ParamC;
+               tmp = pTransfer - cdr.Transfer;
+       }
 
        gzfreeze(&tmp, sizeof(tmp));
 
-       if (Mode == 0)
-               cdr.pTransfer = cdr.Transfer + tmp;
+       if (Mode == 0) {
+               getCdInfo();
+
+               pTransfer = cdr.Transfer + tmp;
+
+               // read right sub data
+               memcpy(tmpp, cdr.Prev, 3);
+               cdr.Prev[0]++;
+               ReadTrack(tmpp);
+
+               if (cdr.Play) {
+                       Find_CurTrack(cdr.SetSectorPlay);
+                       if (!Config.Cdda)
+                               CDR_play(cdr.SetSectorPlay);
+               }
+
+               if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
+                       // old versions did not latch Reg2, have to fixup..
+                       if (cdr.Reg2 == 0) {
+                               SysPrintf("cdrom: fixing up old savestate\n");
+                               cdr.Reg2 = 7;
+                       }
+               }
+       }
 
        return 0;
 }
@@ -2045,8 +1691,11 @@ int cdrFreeze(gzFile f, int Mode) {
 void LidInterrupt() {
        cdr.LidCheck = 0x20; // start checker
 
+       getCdInfo();
+       
+       StopCdda();
        CDRLID_INT( cdReadTime * 3 );
-       
+
        // generate interrupt if none active - open or close
        if (cdr.Irq == 0 || cdr.Irq == 0xff) {
                cdr.Ctrl |= 0x80;