gpu_neon: warning fix
[pcsx_rearmed.git] / libpcsxcore / cdrom.c
1 /***************************************************************************
2  *   Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team              *
3  *                                                                         *
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.                                   *
8  *                                                                         *
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.                          *
13  *                                                                         *
14  *   You should have received a copy of the GNU General Public License     *
15  *   along with this program; if not, write to the                         *
16  *   Free Software Foundation, Inc.,                                       *
17  *   51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA.           *
18  ***************************************************************************/
19
20 /* 
21 * Handles all CD-ROM registers and functions.
22 */
23
24 #include "cdrom.h"
25 #include "ppf.h"
26 #include "psxdma.h"
27
28 cdrStruct cdr;
29
30 /* CD-ROM magic numbers */
31 #define CdlSync        0
32 #define CdlNop         1
33 #define CdlSetloc      2
34 #define CdlPlay        3
35 #define CdlForward     4
36 #define CdlBackward    5
37 #define CdlReadN       6
38 #define CdlStandby     7
39 #define CdlStop        8
40 #define CdlPause       9
41 #define CdlInit        10
42 #define CdlMute        11
43 #define CdlDemute      12
44 #define CdlSetfilter   13
45 #define CdlSetmode     14
46 #define CdlGetmode     15
47 #define CdlGetlocL     16
48 #define CdlGetlocP     17
49 #define CdlReadT       18
50 #define CdlGetTN       19
51 #define CdlGetTD       20
52 #define CdlSeekL       21
53 #define CdlSeekP       22
54 #define CdlSetclock    23
55 #define CdlGetclock    24
56 #define CdlTest        25
57 #define CdlID          26
58 #define CdlReadS       27
59 #define CdlReset       28
60 #define CdlReadToc     30
61
62 #define AUTOPAUSE      249
63 #define READ_ACK       250
64 #define READ           251
65 #define REPPLAY_ACK    252
66 #define REPPLAY        253
67 #define ASYNC          254
68 /* don't set 255, it's reserved */
69
70 char *CmdName[0x100]= {
71     "CdlSync",     "CdlNop",       "CdlSetloc",  "CdlPlay",
72     "CdlForward",  "CdlBackward",  "CdlReadN",   "CdlStandby",
73     "CdlStop",     "CdlPause",     "CdlInit",    "CdlMute",
74     "CdlDemute",   "CdlSetfilter", "CdlSetmode", "CdlGetmode",
75     "CdlGetlocL",  "CdlGetlocP",   "CdlReadT",   "CdlGetTN",
76     "CdlGetTD",    "CdlSeekL",     "CdlSeekP",   "CdlSetclock",
77     "CdlGetclock", "CdlTest",      "CdlID",      "CdlReadS",
78     "CdlReset",    NULL,           "CDlReadToc", NULL
79 };
80
81 unsigned char Test04[] = { 0 };
82 unsigned char Test05[] = { 0 };
83 unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
84 unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
85 unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
86
87 // cdr.Stat:
88 #define NoIntr          0
89 #define DataReady       1
90 #define Complete        2
91 #define Acknowledge     3
92 #define DataEnd         4
93 #define DiskError       5
94
95 /* Modes flags */
96 #define MODE_SPEED       (1<<7) // 0x80
97 #define MODE_STRSND      (1<<6) // 0x40 ADPCM on/off
98 #define MODE_SIZE_2340   (1<<5) // 0x20
99 #define MODE_SIZE_2328   (1<<4) // 0x10
100 #define MODE_SF          (1<<3) // 0x08 channel on/off
101 #define MODE_REPORT      (1<<2) // 0x04
102 #define MODE_AUTOPAUSE   (1<<1) // 0x02
103 #define MODE_CDDA        (1<<0) // 0x01
104
105 /* Status flags */
106 #define STATUS_PLAY      (1<<7) // 0x80
107 #define STATUS_SEEK      (1<<6) // 0x40
108 #define STATUS_READ      (1<<5) // 0x20
109 #define STATUS_SHELLOPEN (1<<4) // 0x10
110 #define STATUS_UNKNOWN3  (1<<3) // 0x08
111 #define STATUS_UNKNOWN2  (1<<2) // 0x04
112 #define STATUS_ROTATING  (1<<1) // 0x02
113 #define STATUS_ERROR     (1<<0) // 0x01
114
115
116
117 // 1x = 75 sectors per second
118 // PSXCLK = 1 sec in the ps
119 // so (PSXCLK / 75) = cdr read time (linuzappz)
120 #define cdReadTime (PSXCLK / 75)
121
122 static struct CdrStat stat;
123
124 static unsigned int msf2sec(char *msf) {
125         return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
126 }
127
128 static void sec2msf(unsigned int s, char *msf) {
129         msf[0] = s / 75 / 60;
130         s = s - msf[0] * 75 * 60;
131         msf[1] = s / 75;
132         s = s - msf[1] * 75;
133         msf[2] = s;
134 }
135
136
137 #define CDR_INT(eCycle) { \
138         psxRegs.interrupt |= (1 << PSXINT_CDR); \
139         psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
140         psxRegs.intCycle[PSXINT_CDR].sCycle = psxRegs.cycle; \
141         new_dyna_set_event(PSXINT_CDR, eCycle); \
142 }
143
144 #define CDREAD_INT(eCycle) { \
145         psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
146         psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
147         psxRegs.intCycle[PSXINT_CDREAD].sCycle = psxRegs.cycle; \
148         new_dyna_set_event(PSXINT_CDREAD, eCycle); \
149 }
150
151 #define CDRLID_INT(eCycle) { \
152         psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
153         psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
154         psxRegs.intCycle[PSXINT_CDRLID].sCycle = psxRegs.cycle; \
155         new_dyna_set_event(PSXINT_CDRLID, eCycle); \
156 }
157
158 #define CDRPLAY_INT(eCycle) { \
159         psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
160         psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
161         psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
162         new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
163 }
164
165 #define StartReading(type, eCycle) { \
166         cdr.Reading = type; \
167         cdr.FirstSector = 1; \
168         cdr.Readed = 0xff; \
169         AddIrqQueue(READ_ACK, eCycle); \
170 }
171
172 #define StopReading() { \
173         if (cdr.Reading) { \
174                 cdr.Reading = 0; \
175                 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
176         } \
177         cdr.StatP &= ~STATUS_READ;\
178 }
179
180 #define StopCdda() { \
181         if (cdr.Play) { \
182                 if (!Config.Cdda) CDR_stop(); \
183                 cdr.StatP &= ~STATUS_PLAY; \
184                 cdr.Play = FALSE; \
185                 cdr.FastForward = 0; \
186                 cdr.FastBackward = 0; \
187                 /*SPU_registerCallback( SPUirq );*/ \
188         } \
189 }
190
191 #define SetResultSize(size) { \
192     cdr.ResultP = 0; \
193         cdr.ResultC = size; \
194         cdr.ResultReady = 1; \
195 }
196
197
198 void cdrLidSeekInterrupt()
199 {
200         // turn back on checking
201         if( cdr.LidCheck == 0x10 )
202         {
203                 cdr.LidCheck = 0;
204         }
205
206         // official lid close
207         else if( cdr.LidCheck == 0x30 )
208         {
209                 // GS CDX 3.3: $13
210                 cdr.StatP |= STATUS_ROTATING;
211
212
213                 // GS CDX 3.3 - ~50 getlocp tries
214                 CDRLID_INT( cdReadTime * 3 );
215                 cdr.LidCheck = 0x40;
216         }
217
218         // turn off ready
219         else if( cdr.LidCheck == 0x40 )
220         {
221                 // GS CDX 3.3: $01
222                 cdr.StatP &= ~STATUS_SHELLOPEN;
223                 cdr.StatP &= ~STATUS_ROTATING;
224
225
226                 // GS CDX 3.3 - ~50 getlocp tries
227                 CDRLID_INT( cdReadTime * 3 );
228                 cdr.LidCheck = 0x50;
229         }
230
231         // now seek
232         else if( cdr.LidCheck == 0x50 )
233         {
234                 // GameShark Lite: Start seeking ($42)
235                 cdr.StatP |= STATUS_SEEK;
236                 cdr.StatP |= STATUS_ROTATING;
237                 cdr.StatP &= ~STATUS_ERROR;
238
239
240                 CDRLID_INT( cdReadTime * 3 );
241                 cdr.LidCheck = 0x60;
242         }
243
244         // done = cd ready
245         else if( cdr.LidCheck == 0x60 )
246         {
247                 // GameShark Lite: Seek detection done ($02)
248                 cdr.StatP &= ~STATUS_SEEK;
249
250                 cdr.LidCheck = 0;
251         }
252 }
253
254
255 static void Check_Shell( int Irq )
256 {
257         // check case open/close
258         if (cdr.LidCheck > 0)
259         {
260 #ifdef CDR_LOG
261                 CDR_LOG( "LidCheck\n" );
262 #endif
263
264                 // $20 = check lid state
265                 if( cdr.LidCheck == 0x20 )
266                 {
267                         u32 i;
268
269                         i = stat.Status;
270                         if (CDR_getStatus(&stat) != -1)
271                         {
272                                 // BIOS hangs + BIOS error messages
273                                 //if (stat.Type == 0xff)
274                                         //cdr.Stat = DiskError;
275
276                                 // case now open
277                                 if (stat.Status & STATUS_SHELLOPEN)
278                                 {
279                                         // Vib Ribbon: pre-CD swap
280                                         StopCdda();
281
282
283                                         // GameShark Lite: Death if DiskError happens
284                                         //
285                                         // Vib Ribbon: Needs DiskError for CD swap
286
287                                         if (Irq != CdlNop)
288                                         {
289                                                 cdr.Stat = DiskError;
290
291                                                 cdr.StatP |= STATUS_ERROR;
292                                                 cdr.Result[0] |= STATUS_ERROR;
293                                         }
294
295                                         // GameShark Lite: Wants -exactly- $10
296                                         cdr.StatP |= STATUS_SHELLOPEN;
297                                         cdr.StatP &= ~STATUS_ROTATING;
298
299
300                                         CDRLID_INT( cdReadTime * 3 );
301                                         cdr.LidCheck = 0x10;
302
303
304                                         // GS CDX 3.3 = $11
305                                 }
306
307                                 // case just closed
308                                 else if ( i & STATUS_SHELLOPEN )
309                                 {
310                                         cdr.StatP |= STATUS_ROTATING;
311
312                                         CheckCdrom();
313
314
315                                         if( cdr.Stat == NoIntr )
316                                                 cdr.Stat = Acknowledge;
317
318                                         psxHu32ref(0x1070) |= SWAP32((u32)0x4);
319
320
321                                         // begin close-seek-ready cycle
322                                         CDRLID_INT( cdReadTime * 3 );
323                                         cdr.LidCheck = 0x30;
324
325
326                                         // GameShark Lite: Wants -exactly- $42, then $02
327                                         // GS CDX 3.3: Wants $11/$80, $13/$80, $01/$00
328                                 }
329
330                                 // case still closed - wait for recheck
331                                 else
332                                 {
333                                         CDRLID_INT( cdReadTime * 3 );
334                                         cdr.LidCheck = 0x10;
335                                 }
336                         }
337                 }
338
339
340                 // GS CDX: clear all values but #1,#2
341                 if( (cdr.LidCheck >= 0x30) || (cdr.StatP & STATUS_SHELLOPEN) )
342                 {
343                         SetResultSize(16);
344                         memset( cdr.Result, 0, 16 );
345
346                         cdr.Result[0] = cdr.StatP;
347
348
349                         // GS CDX: special return value
350                         if( cdr.StatP & STATUS_SHELLOPEN )
351                         {
352                                 cdr.Result[1] = 0x80;
353                         }
354
355
356                         if( cdr.Stat == NoIntr )
357                                 cdr.Stat = Acknowledge;
358
359                         psxHu32ref(0x1070) |= SWAP32((u32)0x4);
360                 }
361         }
362 }
363
364
365 void Find_CurTrack() {
366         cdr.CurTrack = 0;
367
368         if (CDR_getTN(cdr.ResultTN) != -1) {
369                 int lcv;
370
371                 for( lcv = 1; lcv <= cdr.ResultTN[1]; lcv++ ) {
372                         if (CDR_getTD((u8)(lcv), cdr.ResultTD) != -1) {
373                                 u32 sect1, sect2;
374
375 #ifdef CDR_LOG___0
376                                 CDR_LOG( "curtrack %d %d %d | %d %d %d | %d\n",
377                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2],
378                                         cdr.ResultTD[2], cdr.ResultTD[1], cdr.ResultTD[0],
379                                         cdr.CurTrack );
380 #endif
381
382                                 // find next track boundary - only need m:s accuracy
383                                 sect1 = cdr.SetSectorPlay[0] * 60 * 75 + cdr.SetSectorPlay[1] * 75;
384                                 sect2 = cdr.ResultTD[2] * 60 * 75 + cdr.ResultTD[1] * 75;
385
386                                 // Twisted Metal 4 - psx cdda pregap (2-sec)
387                                 // - fix in-game music
388                                 sect2 -= 75 * 2;
389
390                                 if( sect1 >= sect2 ) {
391                                         cdr.CurTrack++;
392                                         continue;
393                                 }
394                         }
395
396                         break;
397                 }
398         }
399 }
400
401 static void ReadTrack( u8 *time ) {
402         cdr.Prev[0] = itob( time[0] );
403         cdr.Prev[1] = itob( time[1] );
404         cdr.Prev[2] = itob( time[2] );
405
406 #ifdef CDR_LOG
407         CDR_LOG("ReadTrack() Log: KEY *** %x:%x:%x\n", cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
408 #endif
409         cdr.RErr = CDR_readTrack(cdr.Prev);
410 }
411
412
413 void AddIrqQueue(unsigned char irq, unsigned long ecycle) {
414         cdr.Irq = irq;
415         cdr.eCycle = ecycle;
416
417         // Doom: Force rescheduling
418         // - Fixes boot
419         CDR_INT(ecycle);
420 }
421
422
423 void Set_Track()
424 {
425         if (CDR_getTN(cdr.ResultTN) != -1) {
426                 int lcv;
427
428                 for( lcv = 1; lcv < cdr.ResultTN[1]; lcv++ ) {
429                         if (CDR_getTD((u8)(lcv), cdr.ResultTD) != -1) {
430 #ifdef CDR_LOG___0
431                                 CDR_LOG( "settrack %d %d %d | %d %d %d | %d\n",
432                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2],
433                                         cdr.ResultTD[2], cdr.ResultTD[1], cdr.ResultTD[0],
434                                         cdr.CurTrack );
435 #endif
436
437                                 // check if time matches track start (only need min, sec accuracy)
438                                 // - m:s:f vs f:s:m
439                                 if( cdr.SetSectorPlay[0] == cdr.ResultTD[2] &&
440                                                 cdr.SetSectorPlay[1] == cdr.ResultTD[1] ) {
441                                         // skip pregap frames
442                                         if( cdr.SetSectorPlay[2] < cdr.ResultTD[0] )
443                                                 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
444
445                                         break;
446                                 }
447                                 else if( cdr.SetSectorPlay[0] < cdr.ResultTD[2] )
448                                         break;
449                         }
450                 }
451         }
452 }
453
454
455 static u8 fake_subq_local[3], fake_subq_real[3], fake_subq_index, fake_subq_change;
456 static void Create_Fake_Subq()
457 {
458         u8 temp_cur[3], temp_next[3], temp_start[3], pregap;
459         int diff;
460
461         if (CDR_getTN(cdr.ResultTN) == -1) return;
462         if( cdr.CurTrack+1 <= cdr.ResultTN[1] ) {
463                 pregap = 150;
464                 if( CDR_getTD(cdr.CurTrack+1, cdr.ResultTD) == -1 ) return;
465         } else {
466                 // last track - cd size
467                 pregap = 0;
468                 if( CDR_getTD(0, cdr.ResultTD) == -1 ) return;
469         }
470
471         if( cdr.Play == TRUE ) {
472                 temp_cur[0] = cdr.SetSectorPlay[0];
473                 temp_cur[1] = cdr.SetSectorPlay[1];
474                 temp_cur[2] = cdr.SetSectorPlay[2];
475         } else {
476                 temp_cur[0] = btoi( cdr.Prev[0] );
477                 temp_cur[1] = btoi( cdr.Prev[1] );
478                 temp_cur[2] = btoi( cdr.Prev[2] );
479         }
480
481         fake_subq_real[0] = temp_cur[0];
482         fake_subq_real[1] = temp_cur[1];
483         fake_subq_real[2] = temp_cur[2];
484
485         temp_next[0] = cdr.ResultTD[2];
486         temp_next[1] = cdr.ResultTD[1];
487         temp_next[2] = cdr.ResultTD[0];
488
489
490         // flag- next track
491         if( msf2sec(temp_cur) >= msf2sec( temp_next )-pregap ) {
492                 fake_subq_change = 1;
493
494                 cdr.CurTrack++;
495
496                 // end cd
497                 if( pregap == 0 ) StopCdda();
498         }
499
500         //////////////////////////////////////////////////
501         //////////////////////////////////////////////////
502
503         // repair
504         if( cdr.CurTrack <= cdr.ResultTN[1] ) {
505                 if( CDR_getTD(cdr.CurTrack, cdr.ResultTD) == -1 ) return;
506         } else {
507                 // last track - cd size
508                 if( CDR_getTD(0, cdr.ResultTD) == -1 ) return;
509         }
510         
511         temp_start[0] = cdr.ResultTD[2];
512         temp_start[1] = cdr.ResultTD[1];
513         temp_start[2] = cdr.ResultTD[0];
514
515
516 #ifdef CDR_LOG
517         CDR_LOG( "CDDA FAKE SUB - %d:%d:%d / %d:%d:%d / %d:%d:%d\n",
518                 temp_cur[0], temp_cur[1], temp_cur[2],
519                 temp_start[0], temp_start[1], temp_start[2],
520                 temp_next[0], temp_next[1], temp_next[2]);
521 #endif
522
523
524
525         // local time - pregap / real
526         diff = msf2sec(temp_cur) - msf2sec( temp_start );
527         if( diff < 0 ) {
528                 fake_subq_index = 0;
529
530                 sec2msf( -diff, fake_subq_local );
531         } else {
532                 fake_subq_index = 1;
533
534                 sec2msf( diff, fake_subq_local );
535         }
536 }
537
538
539 static void cdrPlayInterrupt_Autopause()
540 {
541         struct SubQ *subq = (struct SubQ *)CDR_getBufferSub();
542         if (subq != NULL ) {
543 #ifdef CDR_LOG
544                 CDR_LOG( "CDDA SUB - %X:%X:%X\n",
545                         subq->AbsoluteAddress[0], subq->AbsoluteAddress[1], subq->AbsoluteAddress[2] );
546 #endif
547
548                 /*
549                 CDDA Autopause
550
551                 Silhouette Mirage ($3)
552                 Tomb Raider 1 ($7)
553                 */
554
555                 if( cdr.CurTrack >= btoi( subq->TrackNumber ) )
556                         return;
557         } else {
558                 Create_Fake_Subq();
559 #ifdef CDR_LOG___0
560                 CDR_LOG( "CDDA FAKE SUB - %d:%d:%d\n",
561                         fake_subq_real[0], fake_subq_real[1], fake_subq_real[2] );
562 #endif
563
564                 if( !fake_subq_change )
565                         return;
566
567                 fake_subq_change = 0;
568         }
569
570         if (cdr.Mode & MODE_AUTOPAUSE) {
571 #ifdef CDR_LOG
572                 CDR_LOG( "CDDA STOP\n" );
573 #endif
574
575                 // Magic the Gathering
576                 // - looping territory cdda
577
578                 // ...?
579                 //cdr.ResultReady = 1;
580                 //cdr.Stat = DataReady;
581                 cdr.Stat = DataEnd;
582                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
583
584                 StopCdda();
585         }
586         if (cdr.Mode & MODE_REPORT) {
587                 // rearmed note: PCSX-Reloaded does this for every sector,
588                 // but we try to get away with only track change here.
589                 memset( cdr.Result, 0, 8 );
590                 cdr.Result[0] |= 0x10;
591
592                 if (subq != NULL) {
593 #ifdef CDR_LOG
594                         CDR_LOG( "REPPLAY SUB - %X:%X:%X\n",
595                                 subq->AbsoluteAddress[0], subq->AbsoluteAddress[1], subq->AbsoluteAddress[2] );
596 #endif
597                         cdr.CurTrack = btoi( subq->TrackNumber );
598
599                         // BIOS CD Player: data already BCD format
600                         cdr.Result[1] = subq->TrackNumber;
601                         cdr.Result[2] = subq->IndexNumber;
602
603                         cdr.Result[3] = subq->AbsoluteAddress[0];
604                         cdr.Result[4] = subq->AbsoluteAddress[1];
605                         cdr.Result[5] = subq->AbsoluteAddress[2];
606                 } else {
607 #ifdef CDR_LOG___0
608                         CDR_LOG( "REPPLAY FAKE - %d:%d:%d\n",
609                                 fake_subq_real[0], fake_subq_real[1], fake_subq_real[2] );
610 #endif
611
612                         // track # / index #
613                         cdr.Result[1] = itob(cdr.CurTrack);
614                         cdr.Result[2] = itob(fake_subq_index);
615                         // absolute
616                         cdr.Result[3] = itob( fake_subq_real[0] );
617                         cdr.Result[4] = itob( fake_subq_real[1] );
618                         cdr.Result[5] = itob( fake_subq_real[2] );
619                 }
620
621                 // Rayman: Logo freeze (resultready + dataready)
622                 cdr.ResultReady = 1;
623                 cdr.Stat = DataReady;
624
625                 SetResultSize(8);
626                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
627         }
628 }
629
630 void cdrPlayInterrupt()
631 {
632         if( !cdr.Play ) return;
633
634 #ifdef CDR_LOG
635         CDR_LOG( "CDDA - %d:%d:%d\n",
636                 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
637 #endif
638         CDRPLAY_INT( cdReadTime );
639
640         if (!cdr.Irq && !cdr.Stat && (cdr.Mode & MODE_CDDA) && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
641                 cdrPlayInterrupt_Autopause();
642
643         cdr.SetSectorPlay[2]++;
644         if (cdr.SetSectorPlay[2] == 75) {
645                 cdr.SetSectorPlay[2] = 0;
646                 cdr.SetSectorPlay[1]++;
647                 if (cdr.SetSectorPlay[1] == 60) {
648                         cdr.SetSectorPlay[1] = 0;
649                         cdr.SetSectorPlay[0]++;
650                 }
651         }
652
653         //Check_Shell(0);
654 }
655
656 void cdrInterrupt() {
657         int i;
658         unsigned char Irq = cdr.Irq;
659         struct SubQ *subq;
660
661         // Reschedule IRQ
662         if (cdr.Stat) {
663                 CDR_INT( 0x100 );
664                 return;
665         }
666
667         cdr.Irq = 0xff;
668         cdr.Ctrl &= ~0x80;
669
670         switch (Irq) {
671                 case CdlSync:
672                         SetResultSize(1);
673                         cdr.StatP |= STATUS_ROTATING;
674                         cdr.Result[0] = cdr.StatP;
675                         cdr.Stat = Acknowledge; 
676                         break;
677
678                 case CdlNop:
679                         SetResultSize(1);
680                         cdr.Result[0] = cdr.StatP;
681                         cdr.Stat = Acknowledge;
682
683                         if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
684                         break;
685
686                 case CdlSetloc:
687                         cdr.CmdProcess = 0;
688                         SetResultSize(1);
689                         cdr.StatP |= STATUS_ROTATING;
690                         cdr.Result[0] = cdr.StatP;
691                         cdr.Stat = Acknowledge;
692                         break;
693
694                 case CdlPlay:
695                         fake_subq_change = 0;
696
697                         if( cdr.Seeked == FALSE ) {
698                                 memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
699                                 cdr.Seeked = TRUE;
700                         }
701
702                         /*
703                         Rayman: detect track changes
704                         - fixes logo freeze
705
706                         Twisted Metal 2: skip PREGAP + starting accurate SubQ
707                         - plays tracks without retry play
708
709                         Wild 9: skip PREGAP + starting accurate SubQ
710                         - plays tracks without retry play
711                         */
712                         /* unneeded with correct cdriso?
713                         Set_Track();
714                         */
715                         Find_CurTrack();
716                         ReadTrack( cdr.SetSectorPlay );
717
718                         // GameShark CD Player: Calls 2x + Play 2x
719                         if( cdr.FastBackward || cdr.FastForward ) {
720                                 if( cdr.FastForward ) cdr.FastForward--;
721                                 if( cdr.FastBackward ) cdr.FastBackward--;
722
723                                 if( cdr.FastBackward == 0 && cdr.FastForward == 0 ) {
724                                         if( cdr.Play && CDR_getStatus(&stat) != -1 ) {
725                                                 cdr.SetSectorPlay[0] = stat.Time[0];
726                                                 cdr.SetSectorPlay[1] = stat.Time[1];
727                                                 cdr.SetSectorPlay[2] = stat.Time[2];
728                                         }
729                                 }
730                         }
731
732
733                         if (!Config.Cdda) {
734                                 // BIOS CD Player
735                                 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
736
737                                 // GameShark CD Player: Resume play
738                                 if( cdr.ParamC == 0 ) {
739 #ifdef CDR_LOG___0
740                                         CDR_LOG( "PLAY Resume @ %d:%d:%d\n",
741                                                 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
742 #endif
743
744                                         //CDR_play( cdr.SetSectorPlay );
745                                 }
746                                 else
747                                 {
748                                         // BIOS CD Player: Resume play
749                                         if( cdr.Param[0] == 0 ) {
750 #ifdef CDR_LOG___0
751                                                 CDR_LOG( "PLAY Resume T0 @ %d:%d:%d\n",
752                                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
753 #endif
754
755                                                 //CDR_play( cdr.SetSectorPlay );
756                                         }
757                                         else {
758 #ifdef CDR_LOG___0
759                                                 CDR_LOG( "PLAY Resume Td @ %d:%d:%d\n",
760                                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
761 #endif
762
763                                                 // BIOS CD Player: Allow track replaying
764                                                 StopCdda();
765
766
767                                                 cdr.CurTrack = btoi( cdr.Param[0] );
768
769                                                 if (CDR_getTN(cdr.ResultTN) != -1) {
770                                                         // check last track
771                                                         if (cdr.CurTrack > cdr.ResultTN[1])
772                                                                 cdr.CurTrack = cdr.ResultTN[1];
773
774                                                         if (CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD) != -1) {
775                                                                 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
776                                                                 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
777                                                                 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
778
779                                                                 // reset data
780                                                                 Set_Track();
781                                                                 Find_CurTrack();
782                                                                 ReadTrack( cdr.SetSectorPlay );
783
784                                                                 //CDR_play(cdr.SetSectorPlay);
785                                                         }
786                                                 }
787                                         }
788                                 }
789                         }
790
791
792                         // Vib Ribbon: gameplay checks flag
793                         cdr.StatP &= ~STATUS_SEEK;
794
795
796                         cdr.CmdProcess = 0;
797                         SetResultSize(1);
798                         cdr.StatP |= STATUS_ROTATING;
799                         cdr.Result[0] = cdr.StatP;
800                         cdr.Stat = Acknowledge;
801
802                         cdr.StatP |= STATUS_PLAY;
803
804                         
805                         // BIOS player - set flag again
806                         cdr.Play = TRUE;
807
808                         CDRPLAY_INT( cdReadTime );
809                         break;
810
811                 case CdlForward:
812                         cdr.CmdProcess = 0;
813                         SetResultSize(1);
814                         cdr.StatP |= STATUS_ROTATING;
815                         cdr.Result[0] = cdr.StatP;
816                         cdr.Stat = Complete;
817
818
819                         // GameShark CD Player: Calls 2x + Play 2x
820                         if( cdr.FastForward == 0 ) cdr.FastForward = 2;
821                         else cdr.FastForward++;
822
823                         cdr.FastBackward = 0;
824                         break;
825
826                 case CdlBackward:
827                         cdr.CmdProcess = 0;
828                         SetResultSize(1);
829                         cdr.StatP |= STATUS_ROTATING;
830                         cdr.Result[0] = cdr.StatP;
831                         cdr.Stat = Complete;
832
833
834                         // GameShark CD Player: Calls 2x + Play 2x
835                         if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
836                         else cdr.FastBackward++;
837
838                         cdr.FastForward = 0;
839                         break;
840
841                 case CdlStandby:
842                         cdr.CmdProcess = 0;
843                         SetResultSize(1);
844                         cdr.StatP |= STATUS_ROTATING;
845                         cdr.Result[0] = cdr.StatP;
846                         cdr.Stat = Complete;
847                         break;
848
849                 case CdlStop:
850                         cdr.CmdProcess = 0;
851                         SetResultSize(1);
852                         cdr.StatP &= ~STATUS_ROTATING;
853                         cdr.Result[0] = cdr.StatP;
854                         cdr.Stat = Complete;
855 //                      cdr.Stat = Acknowledge;
856
857                         if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
858                         break;
859
860                 case CdlPause:
861                         SetResultSize(1);
862                         cdr.Result[0] = cdr.StatP;
863                         cdr.Stat = Acknowledge;
864
865                         /*
866                         Gundam Battle Assault 2: much slower (*)
867                         - Fixes boot, gameplay
868
869                         Hokuto no Ken 2: slower
870                         - Fixes intro + subtitles
871
872                         InuYasha - Feudal Fairy Tale: slower
873                         - Fixes battles
874                         */
875                         AddIrqQueue(CdlPause + 0x20, cdReadTime * 3);
876                         cdr.Ctrl |= 0x80;
877                         break;
878
879                 case CdlPause + 0x20:
880                         SetResultSize(1);
881                         cdr.StatP &= ~STATUS_READ;
882                         cdr.StatP |= STATUS_ROTATING;
883                         cdr.Result[0] = cdr.StatP;
884                         cdr.Stat = Complete;
885                         break;
886
887                 case CdlInit:
888                         SetResultSize(1);
889                         cdr.StatP = STATUS_ROTATING;
890                         cdr.Result[0] = cdr.StatP;
891                         cdr.Stat = Acknowledge;
892 //                      if (!cdr.Init) {
893                                 AddIrqQueue(CdlInit + 0x20, 0x800);
894 //                      }
895                 break;
896
897                 case CdlInit + 0x20:
898                         SetResultSize(1);
899                         cdr.Result[0] = cdr.StatP;
900                         cdr.Stat = Complete;
901                         cdr.Init = 1;
902                         break;
903
904                 case CdlMute:
905                         SetResultSize(1);
906                         cdr.StatP |= STATUS_ROTATING;
907                         cdr.Result[0] = cdr.StatP;
908                         cdr.Stat = Acknowledge;
909                         break;
910
911                 case CdlDemute:
912                         SetResultSize(1);
913                         cdr.StatP |= STATUS_ROTATING;
914                         cdr.Result[0] = cdr.StatP;
915                         cdr.Stat = Acknowledge;
916                         break;
917
918                 case CdlSetfilter:
919                         SetResultSize(1);
920                         cdr.StatP |= STATUS_ROTATING;
921                         cdr.Result[0] = cdr.StatP;
922                         cdr.Stat = Acknowledge; 
923                         break;
924
925                 case CdlSetmode:
926                         SetResultSize(1);
927                         cdr.StatP |= STATUS_ROTATING;
928                         cdr.Result[0] = cdr.StatP;
929                         cdr.Stat = Acknowledge;
930                         break;
931
932                 case CdlGetmode:
933                         SetResultSize(6);
934                         cdr.StatP |= STATUS_ROTATING;
935                         cdr.Result[0] = cdr.StatP;
936                         cdr.Result[1] = cdr.Mode;
937                         cdr.Result[2] = cdr.File;
938                         cdr.Result[3] = cdr.Channel;
939                         cdr.Result[4] = 0;
940                         cdr.Result[5] = 0;
941                         cdr.Stat = Acknowledge;
942                         break;
943
944                 case CdlGetlocL:
945                         SetResultSize(8);
946                         for (i = 0; i < 8; i++)
947                                 cdr.Result[i] = cdr.Transfer[i];
948                         cdr.Stat = Acknowledge;
949                         break;
950
951                 case CdlGetlocP:
952                         // GameShark CDX CD Player: uses 17 bytes output (wraps around)
953                         SetResultSize(17);
954                         memset( cdr.Result, 0, 16 );
955
956                         subq = (struct SubQ *)CDR_getBufferSub();
957
958                         if (subq != NULL) {
959                                 cdr.Result[0] = subq->TrackNumber;
960                                 cdr.Result[1] = subq->IndexNumber;
961                                 memcpy(cdr.Result + 2, subq->TrackRelativeAddress, 3);
962                                 memcpy(cdr.Result + 5, subq->AbsoluteAddress, 3);
963
964
965                                 // subQ integrity check - data only (skip audio)
966                                 if( subq->TrackNumber == 1 && stat.Type == 0x01 ) {
967                                 if (calcCrc((u8 *)subq + 12, 10) != (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
968                                         memset(cdr.Result + 2, 0, 3 + 3); // CRC wrong, wipe out time data
969                                 }
970                                 }
971                         } else {
972                                 if( cdr.Play == FALSE || !(cdr.Mode & MODE_CDDA) || !(cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)) )
973                                         Create_Fake_Subq();
974
975
976                                 // track # / index #
977                                 cdr.Result[0] = itob(cdr.CurTrack);
978                                 cdr.Result[1] = itob(fake_subq_index);
979
980                                 // local
981                                 cdr.Result[2] = itob( fake_subq_local[0] );
982                                 cdr.Result[3] = itob( fake_subq_local[1] );
983                                 cdr.Result[4] = itob( fake_subq_local[2] );
984
985                                 // absolute
986                                 cdr.Result[5] = itob( fake_subq_real[0] );
987                                 cdr.Result[6] = itob( fake_subq_real[1] );
988                                 cdr.Result[7] = itob( fake_subq_real[2] );
989                         }
990
991                         // redump.org - wipe time
992                         if( !cdr.Play && CheckSBI(cdr.Result+5) ) {
993                                 memset( cdr.Result+2, 0, 6 );
994                         }
995
996                         cdr.Stat = Acknowledge;
997                         break;
998
999                 case CdlGetTN:
1000                         // 5-Star Racing: don't stop CDDA
1001                         //
1002                         // Vib Ribbon: CD swap
1003                         StopReading();
1004
1005                         cdr.CmdProcess = 0;
1006                         SetResultSize(3);
1007                         cdr.StatP |= STATUS_ROTATING;
1008                         cdr.Result[0] = cdr.StatP;
1009                         if (CDR_getTN(cdr.ResultTN) == -1) {
1010                                 cdr.Stat = DiskError;
1011                                 cdr.Result[0] |= STATUS_ERROR;
1012                         } else {
1013                                 cdr.Stat = Acknowledge;
1014                                 cdr.Result[1] = itob(cdr.ResultTN[0]);
1015                                 cdr.Result[2] = itob(cdr.ResultTN[1]);
1016                         }
1017                         break;
1018
1019                 case CdlGetTD:
1020                         cdr.CmdProcess = 0;
1021                         cdr.Track = btoi(cdr.Param[0]);
1022                         SetResultSize(4);
1023                         cdr.StatP |= STATUS_ROTATING;
1024                         if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
1025                                 cdr.Stat = DiskError;
1026                                 cdr.Result[0] |= STATUS_ERROR;
1027                         } else {
1028                                 cdr.Stat = Acknowledge;
1029                                 cdr.Result[0] = cdr.StatP;
1030                                 cdr.Result[1] = itob(cdr.ResultTD[2]);
1031                                 cdr.Result[2] = itob(cdr.ResultTD[1]);
1032                                 cdr.Result[3] = itob(cdr.ResultTD[0]);
1033                         }
1034                         break;
1035
1036                 case CdlSeekL:
1037                         SetResultSize(1);
1038                         cdr.StatP |= STATUS_ROTATING;
1039                         cdr.Result[0] = cdr.StatP;
1040                         cdr.StatP |= STATUS_SEEK;
1041                         cdr.Stat = Acknowledge;
1042
1043                         /*
1044                         Crusaders of Might and Magic = 0.5x-4x
1045                         - fix cutscene speech start
1046
1047                         Eggs of Steel = 2x-?
1048                         - fix new game
1049
1050                         Medievil = ?-4x
1051                         - fix cutscene speech
1052
1053                         Rockman X5 = 0.5-4x
1054                         - fix capcom logo
1055                         */
1056                         AddIrqQueue(CdlSeekL + 0x20, cdReadTime * 4);
1057                         break;
1058
1059                 case CdlSeekL + 0x20:
1060                         SetResultSize(1);
1061                         cdr.StatP |= STATUS_ROTATING;
1062                         cdr.StatP &= ~STATUS_SEEK;
1063                         cdr.Result[0] = cdr.StatP;
1064                         cdr.Seeked = TRUE;
1065                         cdr.Stat = Complete;
1066
1067
1068                         // Mega Man Legends 2: must update read cursor for getlocp
1069                         ReadTrack( cdr.SetSector );
1070                         break;
1071
1072                 case CdlSeekP:
1073                         SetResultSize(1);
1074                         cdr.StatP |= STATUS_ROTATING;
1075                         cdr.Result[0] = cdr.StatP;
1076                         cdr.StatP |= STATUS_SEEK;
1077                         cdr.Stat = Acknowledge;
1078                         AddIrqQueue(CdlSeekP + 0x20, cdReadTime * 1);
1079                         break;
1080
1081                 case CdlSeekP + 0x20:
1082                         SetResultSize(1);
1083                         cdr.StatP |= STATUS_ROTATING;
1084                         cdr.StatP &= ~STATUS_SEEK;
1085                         cdr.Result[0] = cdr.StatP;
1086                         cdr.Stat = Complete;
1087                         cdr.Seeked = TRUE;
1088
1089                         // GameShark Music Player
1090                         memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
1091
1092                         // Tomb Raider 2: must update read cursor for getlocp
1093                         Find_CurTrack();
1094                         ReadTrack( cdr.SetSectorPlay );
1095                         break;
1096
1097                 case CdlTest:
1098                         cdr.Stat = Acknowledge;
1099                         switch (cdr.Param[0]) {
1100                                 case 0x20: // System Controller ROM Version
1101                                         SetResultSize(4);
1102                                         memcpy(cdr.Result, Test20, 4);
1103                                         break;
1104                                 case 0x22:
1105                                         SetResultSize(8);
1106                                         memcpy(cdr.Result, Test22, 4);
1107                                         break;
1108                                 case 0x23: case 0x24:
1109                                         SetResultSize(8);
1110                                         memcpy(cdr.Result, Test23, 4);
1111                                         break;
1112                         }
1113                         break;
1114
1115                 case CdlID:
1116                         SetResultSize(1);
1117                         cdr.StatP |= STATUS_ROTATING;
1118                         cdr.Result[0] = cdr.StatP;
1119                         cdr.Stat = Acknowledge;
1120                         AddIrqQueue(CdlID + 0x20, 0x800);
1121                         break;
1122
1123                 case CdlID + 0x20:
1124                         SetResultSize(8);
1125
1126                         if (CDR_getStatus(&stat) == -1) {
1127                                 cdr.Result[0] = 0x00; // 0x08 and cdr.Result[1]|0x10 : audio cd, enters cd player
1128                                 cdr.Result[1] = 0x80; // 0x80 leads to the menu in the bios, else loads CD
1129                         }
1130                         else {
1131                                 if (stat.Type == 2) {
1132                                         // Music CD
1133                                         cdr.Result[0] = 0x08;
1134                                         cdr.Result[1] = 0x10;
1135
1136                                         cdr.Result[1] |= 0x80;
1137                                 }
1138                                 else {
1139                                         // Data CD
1140                                         if (CdromId[0] == '\0') {
1141                                                 cdr.Result[0] = 0x00;
1142                                                 cdr.Result[1] = 0x80;
1143                                         }
1144                                         else {
1145                                                 cdr.Result[0] = 0x08;
1146                                                 cdr.Result[1] = 0x00;
1147                                         }
1148                                 }
1149                         }
1150
1151                         cdr.Result[2] = 0x00;
1152                         cdr.Result[3] = 0x00;
1153                         strncpy((char *)&cdr.Result[4], "PCSX", 4);
1154                         cdr.Stat = Complete;
1155                         break;
1156
1157                 case CdlReset:
1158                         SetResultSize(1);
1159                         cdr.StatP = STATUS_ROTATING;
1160                         cdr.Result[0] = cdr.StatP;
1161                         cdr.Stat = Acknowledge;
1162                         break;
1163
1164                 case CdlReadT:
1165                         SetResultSize(1);
1166                         cdr.StatP |= STATUS_ROTATING;
1167                         cdr.Result[0] = cdr.StatP;
1168                         cdr.Stat = Acknowledge;
1169                         AddIrqQueue(CdlReadT + 0x20, 0x800);
1170                         break;
1171
1172                 case CdlReadT + 0x20:
1173                         SetResultSize(1);
1174                         cdr.StatP |= STATUS_ROTATING;
1175                         cdr.Result[0] = cdr.StatP;
1176                         cdr.Stat = Complete;
1177                         break;
1178
1179                 case CdlReadToc:
1180                         SetResultSize(1);
1181                         cdr.StatP |= STATUS_ROTATING;
1182                         cdr.Result[0] = cdr.StatP;
1183                         cdr.Stat = Acknowledge;
1184                         AddIrqQueue(CdlReadToc + 0x20, 0x800);
1185                         break;
1186
1187                 case CdlReadToc + 0x20:
1188                         SetResultSize(1);
1189                         cdr.StatP |= STATUS_ROTATING;
1190                         cdr.Result[0] = cdr.StatP;
1191                         cdr.Stat = Complete;
1192                         break;
1193
1194                 case AUTOPAUSE:
1195                         cdr.OCUP = 0;
1196 /*                      SetResultSize(1);
1197                         StopCdda();
1198                         StopReading();
1199                         cdr.OCUP = 0;
1200                         cdr.StatP&=~0x20;
1201                         cdr.StatP|= 0x2;
1202                         cdr.Result[0] = cdr.StatP;
1203                         cdr.Stat = DataEnd;
1204 */                      AddIrqQueue(CdlPause, 0x800);
1205                         break;
1206
1207                 case READ_ACK:
1208                         if (!cdr.Reading) return;
1209
1210
1211                         // Fighting Force 2 - update subq time immediately
1212                         // - fixes new game
1213                         ReadTrack( cdr.SetSector );
1214
1215
1216                         // Crusaders of Might and Magic - update getlocl now
1217                         // - fixes cutscene speech
1218                         {
1219                                 u8 *buf = CDR_getBuffer();
1220                                 if (buf != NULL)
1221                                         memcpy(cdr.Transfer, buf, 8);
1222                         }
1223                         
1224                         
1225                         /*
1226                         Duke Nukem: Land of the Babes - seek then delay read for one frame
1227                         - fixes cutscenes
1228                         C-12 - Final Resistance - doesn't like seek
1229                         */
1230
1231                         if (!cdr.Seeked) {
1232                                 cdr.Seeked = TRUE;
1233
1234                                 cdr.StatP |= STATUS_SEEK;
1235                                 cdr.StatP &= ~STATUS_READ;
1236
1237                                 // Crusaders of Might and Magic - use short time
1238                                 // - fix cutscene speech (startup)
1239
1240                                 // ??? - use more accurate seek time later
1241                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1242                         } else {
1243                                 cdr.StatP |= STATUS_READ;
1244                                 cdr.StatP &= ~STATUS_SEEK;
1245
1246                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1247                         }
1248
1249                         SetResultSize(1);
1250                         cdr.StatP |= STATUS_ROTATING;
1251                         cdr.Result[0] = cdr.StatP;
1252                         cdr.Stat = Acknowledge;
1253                         break;
1254
1255                 case 0xff:
1256                         return;
1257
1258                 default:
1259                         cdr.Stat = Complete;
1260                         break;
1261         }
1262
1263         Check_Shell( Irq );
1264
1265         if (cdr.Stat != NoIntr && cdr.Reg2 != 0x18) {
1266                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
1267         }
1268
1269 #ifdef CDR_LOG
1270         CDR_LOG("cdrInterrupt() Log: CDR Interrupt IRQ %x\n", Irq);
1271 #endif
1272 }
1273
1274 void cdrReadInterrupt() {
1275         u8 *buf;
1276
1277         if (!cdr.Reading)
1278                 return;
1279
1280         if (cdr.Irq || cdr.Stat) {
1281                 CDREAD_INT(0x100);
1282                 return;
1283         }
1284
1285 #ifdef CDR_LOG
1286         CDR_LOG("cdrReadInterrupt() Log: KEY END");
1287 #endif
1288
1289         cdr.OCUP = 1;
1290         SetResultSize(1);
1291         cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1292         cdr.StatP &= ~STATUS_SEEK;
1293         cdr.Result[0] = cdr.StatP;
1294
1295         ReadTrack( cdr.SetSector );
1296
1297         buf = CDR_getBuffer();
1298         if (buf == NULL)
1299                 cdr.RErr = -1;
1300
1301         if (cdr.RErr == -1) {
1302 #ifdef CDR_LOG
1303                 fprintf(emuLog, "cdrReadInterrupt() Log: err\n");
1304 #endif
1305                 memset(cdr.Transfer, 0, DATA_SIZE);
1306                 cdr.Stat = DiskError;
1307                 cdr.Result[0] |= STATUS_ERROR;
1308                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1309                 return;
1310         }
1311
1312         memcpy(cdr.Transfer, buf, DATA_SIZE);
1313         CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1314
1315
1316 #ifdef CDR_LOG
1317         fprintf(emuLog, "cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1318 #endif
1319
1320         if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1321                 // Firemen 2: Multi-XA files - briefings, cutscenes
1322                 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1323                         cdr.File = cdr.Transfer[4 + 0];
1324                         cdr.Channel = cdr.Transfer[4 + 1];
1325                 }
1326
1327                 if ((cdr.Transfer[4 + 2] & 0x4) &&
1328                          (cdr.Transfer[4 + 1] == cdr.Channel) &&
1329                         (cdr.Transfer[4 + 0] == cdr.File)) {
1330                         int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1331
1332                         if (!ret) {
1333                                 // only handle attenuator basic channel switch for now
1334                                 if (cdr.Xa.stereo) {
1335                                         int i;
1336                                         if ((cdr.AttenuatorLeft[0] | cdr.AttenuatorLeft[1])
1337                                             && !(cdr.AttenuatorRight[0] | cdr.AttenuatorRight[1]))
1338                                         {
1339                                                 for (i = 0; i < cdr.Xa.nsamples; i++)
1340                                                         cdr.Xa.pcm[i*2 + 1] = cdr.Xa.pcm[i*2];
1341                                         }
1342                                         else if (!(cdr.AttenuatorLeft[0] | cdr.AttenuatorLeft[1])
1343                                             && (cdr.AttenuatorRight[0] | cdr.AttenuatorRight[1]))
1344                                         {
1345                                                 for (i = 0; i < cdr.Xa.nsamples; i++)
1346                                                         cdr.Xa.pcm[i*2] = cdr.Xa.pcm[i*2 + 1];
1347                                         }
1348                                 }
1349
1350                                 SPU_playADPCMchannel(&cdr.Xa);
1351                                 cdr.FirstSector = 0;
1352
1353 #if 0
1354                                 // Crash Team Racing: music, speech
1355                                 // - done using cdda decoded buffer (spu irq)
1356                                 // - don't do here
1357
1358                                 // signal ADPCM data ready
1359                                 psxHu32ref(0x1070) |= SWAP32((u32)0x200);
1360 #endif
1361                         }
1362                         else cdr.FirstSector = -1;
1363                 }
1364         }
1365
1366         cdr.SetSector[2]++;
1367         if (cdr.SetSector[2] == 75) {
1368                 cdr.SetSector[2] = 0;
1369                 cdr.SetSector[1]++;
1370                 if (cdr.SetSector[1] == 60) {
1371                         cdr.SetSector[1] = 0;
1372                         cdr.SetSector[0]++;
1373                 }
1374         }
1375
1376         cdr.Readed = 0;
1377
1378         // G-Police: Don't autopause ADPCM even if mode set (music)
1379         if ((cdr.Transfer[4 + 2] & 0x80) && (cdr.Mode & MODE_AUTOPAUSE) &&
1380                         (cdr.Transfer[4 + 2] & 0x4) != 0x4 ) { // EOF
1381 #ifdef CDR_LOG
1382                 CDR_LOG("cdrReadInterrupt() Log: Autopausing read\n");
1383 #endif
1384 //              AddIrqQueue(AUTOPAUSE, 0x2000);
1385                 AddIrqQueue(CdlPause, 0x2000);
1386         }
1387         else {
1388                 CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
1389         }
1390
1391         /*
1392         Croc 2: $40 - only FORM1 (*)
1393         Judge Dredd: $C8 - only FORM1 (*)
1394         Sim Theme Park - no adpcm at all (zero)
1395         */
1396
1397         if( (cdr.Mode & MODE_STRSND) == 0 || (cdr.Transfer[4+2] & 0x4) != 0x4 ) {
1398                 cdr.Stat = DataReady;
1399         } else {
1400                 // Breath of Fire 3 - fix inn sleeping
1401                 // Rockman X5 - no music restart problem
1402                 cdr.Stat = NoIntr;
1403         }
1404         psxHu32ref(0x1070) |= SWAP32((u32)0x4);
1405
1406         Check_Shell(0);
1407 }
1408
1409 /*
1410 cdrRead0:
1411         bit 0 - 0 REG1 command send / 1 REG1 data read
1412         bit 1 - 0 data transfer finish / 1 data transfer ready/in progress
1413         bit 2 - unknown
1414         bit 3 - unknown
1415         bit 4 - unknown
1416         bit 5 - 1 result ready
1417         bit 6 - 1 dma ready
1418         bit 7 - 1 command being processed
1419 */
1420
1421 unsigned char cdrRead0(void) {
1422         if (cdr.ResultReady)
1423                 cdr.Ctrl |= 0x20;
1424         else
1425                 cdr.Ctrl &= ~0x20;
1426
1427         if (cdr.OCUP)
1428                 cdr.Ctrl |= 0x40;
1429 //  else
1430 //              cdr.Ctrl &= ~0x40;
1431
1432         // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1433         cdr.Ctrl |= 0x18;
1434
1435 #ifdef CDR_LOG
1436         CDR_LOG("cdrRead0() Log: CD0 Read: %x\n", cdr.Ctrl);
1437 #endif
1438
1439         return psxHu8(0x1800) = cdr.Ctrl;
1440 }
1441
1442 /*
1443 cdrWrite0:
1444         0 - to send a command / 1 - to get the result
1445 */
1446
1447 void cdrWrite0(unsigned char rt) {
1448 #ifdef CDR_LOG
1449         CDR_LOG("cdrWrite0() Log: CD0 write: %x\n", rt);
1450 #endif
1451         cdr.Ctrl = rt | (cdr.Ctrl & ~0x3);
1452
1453         if (rt == 0) {
1454                 cdr.ParamP = 0;
1455                 cdr.ParamC = 0;
1456                 cdr.ResultReady = 0;
1457         }
1458 }
1459
1460 unsigned char cdrRead1(void) {
1461     if (cdr.ResultReady) { // && cdr.Ctrl & 0x1) {
1462                 // GameShark CDX CD Player: uses 17 bytes output (wraps around)
1463                 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1464                 cdr.ResultP++;
1465                 if (cdr.ResultP == cdr.ResultC)
1466                         cdr.ResultReady = 0;
1467         } else {
1468                 psxHu8(0x1801) = 0;
1469         }
1470 #ifdef CDR_LOG
1471         CDR_LOG("cdrRead1() Log: CD1 Read: %x\n", psxHu8(0x1801));
1472 #endif
1473         return psxHu8(0x1801);
1474 }
1475
1476 void cdrWrite1(unsigned char rt) {
1477         char set_loc[3];
1478         int i;
1479
1480 #ifdef CDR_LOG
1481         CDR_LOG("cdrWrite1() Log: CD1 write: %x (%s)\n", rt, CmdName[rt]);
1482 #endif
1483
1484
1485         // Tekken: CDXA fade-out
1486         if( (cdr.Ctrl & 3) == 3 ) {
1487                 cdr.AttenuatorRight[0] = rt;
1488         }
1489
1490
1491 //      psxHu8(0x1801) = rt;
1492         cdr.Cmd = rt;
1493         cdr.OCUP = 0;
1494
1495 #ifdef CDRCMD_DEBUG
1496         SysPrintf("cdrWrite1() Log: CD1 write: %x (%s)", rt, CmdName[rt]);
1497         if (cdr.ParamC) {
1498                 SysPrintf(" Param[%d] = {", cdr.ParamC);
1499                 for (i = 0; i < cdr.ParamC; i++)
1500                         SysPrintf(" %x,", cdr.Param[i]);
1501                 SysPrintf("}\n");
1502         } else {
1503                 SysPrintf("\n");
1504         }
1505 #endif
1506
1507         if (cdr.Ctrl & 0x1) return;
1508
1509         switch (cdr.Cmd) {
1510         case CdlSync:
1511                 cdr.Ctrl |= 0x80;
1512                 cdr.Stat = NoIntr; 
1513                 AddIrqQueue(cdr.Cmd, 0x800);
1514                 break;
1515
1516         case CdlNop:
1517                 cdr.Ctrl |= 0x80;
1518                 cdr.Stat = NoIntr; 
1519
1520                 // Twisted Metal 3 - fix music
1521                 AddIrqQueue(cdr.Cmd, 0x800);
1522                 break;
1523
1524         case CdlSetloc:
1525                 StopReading();
1526                 for (i = 0; i < 3; i++)
1527                         set_loc[i] = btoi(cdr.Param[i]);
1528                 i = abs(msf2sec(cdr.SetSector) - msf2sec(set_loc));
1529                 if (i > 16)
1530                         cdr.Seeked = FALSE;
1531                 memcpy(cdr.SetSector, set_loc, 3);
1532                 cdr.SetSector[3] = 0;
1533
1534                 /*
1535                    if ((cdr.SetSector[0] | cdr.SetSector[1] | cdr.SetSector[2]) == 0) {
1536                  *(u32 *)cdr.SetSector = *(u32 *)cdr.SetSectorSeek;
1537                  }*/
1538
1539                 cdr.Ctrl |= 0x80;
1540                 cdr.Stat = NoIntr;
1541                 AddIrqQueue(cdr.Cmd, 0x800);
1542                 break;
1543
1544         case CdlPlay:
1545                 // Vib Ribbon: try same track again
1546                 StopCdda();
1547
1548                 if (!cdr.SetSector[0] & !cdr.SetSector[1] & !cdr.SetSector[2]) {
1549                         if (CDR_getTN(cdr.ResultTN) != -1) {
1550                                 if (cdr.CurTrack > cdr.ResultTN[1])
1551                                         cdr.CurTrack = cdr.ResultTN[1];
1552                                 if (CDR_getTD((unsigned char)(cdr.CurTrack), cdr.ResultTD) != -1) {
1553                                         int tmp = cdr.ResultTD[2];
1554                                         cdr.ResultTD[2] = cdr.ResultTD[0];
1555                                         cdr.ResultTD[0] = tmp;
1556                                         if (!Config.Cdda) CDR_play(cdr.ResultTD);
1557                                 }
1558                         }
1559                 } else if (!Config.Cdda) {
1560                         CDR_play(cdr.SetSector);
1561                 }
1562
1563                 // Vib Ribbon - decoded buffer IRQ for CDDA reading
1564                 // - fixes ribbon timing + music CD mode
1565                 //TODO?
1566                 //CDRDBUF_INT( PSXCLK / 44100 * 0x100 );
1567
1568
1569                 cdr.Play = TRUE;
1570
1571                 cdr.StatP |= STATUS_SEEK;
1572                 cdr.StatP &= ~STATUS_ROTATING;
1573
1574                 cdr.Ctrl |= 0x80;
1575                 cdr.Stat = NoIntr; 
1576                 AddIrqQueue(cdr.Cmd, 0x800);
1577                 break;
1578
1579         case CdlForward:
1580                 //if (cdr.CurTrack < 0xaa)
1581                 //      cdr.CurTrack++;
1582                 cdr.Ctrl |= 0x80;
1583                 cdr.Stat = NoIntr; 
1584                 AddIrqQueue(cdr.Cmd, 0x800);
1585                 break;
1586
1587         case CdlBackward:
1588                 //if (cdr.CurTrack > 1)
1589                 //cdr.CurTrack--;
1590                 cdr.Ctrl |= 0x80;
1591                 cdr.Stat = NoIntr; 
1592                 AddIrqQueue(cdr.Cmd, 0x800);
1593                 break;
1594
1595         case CdlReadN:
1596                 cdr.Irq = 0;
1597                 StopReading();
1598                 cdr.Ctrl|= 0x80;
1599                 cdr.Stat = NoIntr; 
1600                 StartReading(1, 0x800);
1601                 break;
1602
1603         case CdlStandby:
1604                 StopCdda();
1605                 StopReading();
1606                 cdr.Ctrl |= 0x80;
1607                 cdr.Stat = NoIntr;
1608                 AddIrqQueue(cdr.Cmd, 0x800);
1609                 break;
1610
1611         case CdlStop:
1612                 // GameShark CD Player: Reset CDDA to track start
1613                 if( cdr.Play && CDR_getStatus(&stat) != -1 ) {
1614                         cdr.SetSectorPlay[0] = stat.Time[0];
1615                         cdr.SetSectorPlay[1] = stat.Time[1];
1616                         cdr.SetSectorPlay[2] = stat.Time[2];
1617
1618                         Find_CurTrack();
1619
1620
1621                         // grab time for current track
1622                         CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
1623
1624                         cdr.SetSectorPlay[0] = cdr.ResultTD[2];
1625                         cdr.SetSectorPlay[1] = cdr.ResultTD[1];
1626                         cdr.SetSectorPlay[2] = cdr.ResultTD[0];
1627                 }
1628
1629                 StopCdda();
1630                 StopReading();
1631
1632                 cdr.Ctrl |= 0x80;
1633                 cdr.Stat = NoIntr;
1634                 AddIrqQueue(cdr.Cmd, 0x800);
1635                 break;
1636
1637         case CdlPause:
1638                 /*
1639                    GameShark CD Player: save time for resume
1640
1641                    Twisted Metal - World Tour: don't mix Setloc / CdlPlay cursors
1642                 */
1643
1644                 StopCdda();
1645                 StopReading();
1646                 cdr.Ctrl |= 0x80;
1647                 cdr.Stat = NoIntr;
1648
1649                 AddIrqQueue(cdr.Cmd, 0x800);
1650                 break;
1651
1652         case CdlReset:
1653         case CdlInit:
1654                 StopCdda();
1655                 StopReading();
1656                 cdr.Ctrl |= 0x80;
1657                 cdr.Stat = NoIntr; 
1658                 AddIrqQueue(cdr.Cmd, 0x800);
1659                 break;
1660
1661         case CdlMute:
1662                 cdr.Muted = TRUE;
1663                 cdr.Ctrl |= 0x80;
1664                 cdr.Stat = NoIntr; 
1665                 AddIrqQueue(cdr.Cmd, 0x800);
1666
1667                         // Duke Nukem - Time to Kill
1668                         // - do not directly set cd-xa volume
1669                         //SPU_writeRegister( H_CDLeft, 0x0000 );
1670                         //SPU_writeRegister( H_CDRight, 0x0000 );
1671                 break;
1672
1673         case CdlDemute:
1674                 cdr.Muted = FALSE;
1675                 cdr.Ctrl |= 0x80;
1676                 cdr.Stat = NoIntr; 
1677                 AddIrqQueue(cdr.Cmd, 0x800);
1678
1679                         // Duke Nukem - Time to Kill
1680                         // - do not directly set cd-xa volume
1681                         //SPU_writeRegister( H_CDLeft, 0x7f00 );
1682                         //SPU_writeRegister( H_CDRight, 0x7f00 );
1683                 break;
1684
1685         case CdlSetfilter:
1686                 cdr.File = cdr.Param[0];
1687                 cdr.Channel = cdr.Param[1];
1688                 cdr.Ctrl |= 0x80;
1689                 cdr.Stat = NoIntr; 
1690                 AddIrqQueue(cdr.Cmd, 0x800);
1691                 break;
1692
1693         case CdlSetmode:
1694 #ifdef CDR_LOG
1695                 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1696 #endif 
1697                 cdr.Mode = cdr.Param[0];
1698                 cdr.Ctrl |= 0x80;
1699                 cdr.Stat = NoIntr; 
1700                 AddIrqQueue(cdr.Cmd, 0x800);
1701
1702                 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1703                 // - fixes choppy movie sound
1704                 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1705                         StopCdda();
1706                 break;
1707
1708         case CdlGetmode:
1709                 cdr.Ctrl |= 0x80;
1710                 cdr.Stat = NoIntr; 
1711                 AddIrqQueue(cdr.Cmd, 0x800);
1712                 break;
1713
1714         case CdlGetlocL:
1715                 cdr.Ctrl |= 0x80;
1716                 cdr.Stat = NoIntr; 
1717
1718                 // Crusaders of Might and Magic - cutscene speech
1719                 AddIrqQueue(cdr.Cmd, 0x800);
1720                 break;
1721
1722         case CdlGetlocP:
1723                 cdr.Ctrl |= 0x80;
1724                 cdr.Stat = NoIntr; 
1725
1726                 // GameShark CDX / Lite Player: pretty narrow time window
1727                 // - doesn't always work due to time inprecision
1728                 //AddIrqQueue(cdr.Cmd, 0x28);
1729
1730                 // Tomb Raider 2 - cdda
1731                 //AddIrqQueue(cdr.Cmd, 0x40);
1732
1733                 // rearmed: the above works in pcsxr-svn, but breaks here
1734                 // (TOCA world touring cars), perhaps some other code is not merged yet
1735                 AddIrqQueue(cdr.Cmd, 0x1000);
1736                 break;
1737
1738         case CdlGetTN:
1739                 cdr.Ctrl |= 0x80;
1740                 cdr.Stat = NoIntr; 
1741                 //AddIrqQueue(cdr.Cmd, 0x800);
1742
1743                 // GameShark CDX CD Player: very long time
1744                 AddIrqQueue(cdr.Cmd, 0x100000);
1745                 break;
1746
1747         case CdlGetTD:
1748                 cdr.Ctrl |= 0x80;
1749                 cdr.Stat = NoIntr; 
1750                 AddIrqQueue(cdr.Cmd, 0x800);
1751                 break;
1752
1753         case CdlSeekL:
1754 //                      ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
1755                 cdr.Ctrl |= 0x80;
1756                 cdr.Stat = NoIntr; 
1757                 AddIrqQueue(cdr.Cmd, 0x800);
1758
1759                 StopCdda();
1760                 StopReading();
1761
1762                 break;
1763
1764         case CdlSeekP:
1765 //              ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
1766                 cdr.Ctrl |= 0x80;
1767                 cdr.Stat = NoIntr; 
1768
1769                 // Tomb Raider 2 - reset cdda
1770                 StopCdda();
1771                 StopReading();
1772
1773                 AddIrqQueue(cdr.Cmd, 0x800);
1774                 break;
1775
1776         // Destruction Derby: read TOC? GetTD after this
1777         case CdlReadT:
1778                 cdr.Ctrl |= 0x80;
1779                 cdr.Stat = NoIntr;
1780                 AddIrqQueue(cdr.Cmd, 0x800);
1781                 break;
1782
1783         case CdlTest:
1784                 cdr.Ctrl |= 0x80;
1785                 cdr.Stat = NoIntr; 
1786                 AddIrqQueue(cdr.Cmd, 0x800);
1787                 break;
1788
1789         case CdlID:
1790                 cdr.Ctrl |= 0x80;
1791                 cdr.Stat = NoIntr; 
1792                 AddIrqQueue(cdr.Cmd, 0x800);
1793                 break;
1794
1795         case CdlReadS:
1796                 cdr.Irq = 0;
1797                 StopReading();
1798                 cdr.Ctrl |= 0x80;
1799                 cdr.Stat = NoIntr; 
1800                 StartReading(2, 0x800);
1801                 break;
1802
1803         case CdlReadToc:
1804                 cdr.Ctrl |= 0x80;
1805                 cdr.Stat = NoIntr; 
1806                 AddIrqQueue(cdr.Cmd, 0x800);
1807                 break;
1808
1809         default:
1810 #ifdef CDR_LOG
1811                 CDR_LOG("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
1812 #endif
1813                 return;
1814         }
1815         if (cdr.Stat != NoIntr) {
1816                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
1817         }
1818 }
1819
1820 unsigned char cdrRead2(void) {
1821         unsigned char ret;
1822
1823         if (cdr.Readed == 0) {
1824                 ret = 0;
1825         } else {
1826                 ret = *cdr.pTransfer++;
1827         }
1828
1829 #ifdef CDR_LOG
1830         CDR_LOG("cdrRead2() Log: CD2 Read: %x\n", ret);
1831 #endif
1832         return ret;
1833 }
1834
1835 void cdrWrite2(unsigned char rt) {
1836 #ifdef CDR_LOG
1837         CDR_LOG("cdrWrite2() Log: CD2 write: %x\n", rt);
1838 #endif
1839
1840         // Tekken: CDXA fade-out
1841         if( (cdr.Ctrl & 3) == 2 ) {
1842                 cdr.AttenuatorLeft[0] = rt;
1843         }
1844         else if( (cdr.Ctrl & 3) == 3 ) {
1845                 cdr.AttenuatorRight[1] = rt;
1846         }
1847
1848
1849         if (cdr.Ctrl & 0x1) {
1850                 switch (rt) {
1851                         case 0x07:
1852                                 cdr.ParamP = 0;
1853                                 cdr.ParamC = 0;
1854                                 cdr.ResultReady = 1; //0;
1855                                 cdr.Ctrl &= ~3; //cdr.Ctrl = 0;
1856                                 break;
1857
1858                         default:
1859                                 cdr.Reg2 = rt;
1860                                 break;
1861                 }
1862         } else if (!(cdr.Ctrl & 0x1) && cdr.ParamP < 8) {
1863                 cdr.Param[cdr.ParamP++] = rt;
1864                 cdr.ParamC++;
1865         }
1866 }
1867
1868 unsigned char cdrRead3(void) {
1869         if (cdr.Stat) {
1870                 if (cdr.Ctrl & 0x1)
1871                         psxHu8(0x1803) = cdr.Stat | 0xE0;
1872                 else
1873                         psxHu8(0x1803) = 0xff;
1874         } else {
1875                 psxHu8(0x1803) = 0;
1876         }
1877 #ifdef CDR_LOG
1878         CDR_LOG("cdrRead3() Log: CD3 Read: %x\n", psxHu8(0x1803));
1879 #endif
1880         return psxHu8(0x1803);
1881 }
1882
1883 void cdrWrite3(unsigned char rt) {
1884 #ifdef CDR_LOG
1885         CDR_LOG("cdrWrite3() Log: CD3 write: %x\n", rt);
1886 #endif
1887
1888         // Tekken: CDXA fade-out
1889         if( (cdr.Ctrl & 3) == 2 ) {
1890                 cdr.AttenuatorLeft[1] = rt;
1891         }
1892         else if( (cdr.Ctrl & 3) == 3 && rt == 0x20 ) {
1893 #ifdef CDR_LOG
1894                 CDR_LOG( "CD-XA Volume: %X %X | %X %X\n",
1895                         cdr.AttenuatorLeft[0], cdr.AttenuatorLeft[1],
1896                         cdr.AttenuatorRight[0], cdr.AttenuatorRight[1] );
1897 #endif
1898         }
1899
1900
1901         // GameShark CDX CD Player: Irq timing mania
1902         if( rt == 0 &&
1903                         cdr.Irq != 0 && cdr.Irq != 0xff &&
1904                         cdr.ResultReady == 0 ) {
1905
1906                 // GS CDX: ~0x28 cycle timing - way too precise
1907                 if( cdr.Irq == CdlGetlocP ) {
1908                         cdrInterrupt();
1909
1910                         psxRegs.interrupt &= ~(1 << PSXINT_CDR);
1911                 }
1912         }
1913
1914
1915         if (rt == 0x07 && cdr.Ctrl & 0x1) {
1916                 cdr.Stat = 0;
1917
1918                 if (cdr.Irq == 0xff) {
1919                         cdr.Irq = 0;
1920                         return;
1921                 }
1922
1923                 // XA streaming - incorrect timing because of this reschedule
1924                 // - Final Fantasy Tactics
1925                 // - various other games
1926
1927                 if (cdr.Reading && !cdr.ResultReady) {
1928                         int left = psxRegs.intCycle[PSXINT_CDREAD].sCycle + psxRegs.intCycle[PSXINT_CDREAD].cycle - psxRegs.cycle;
1929                         int time = (cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime;
1930                         if (Config.CdrReschedule != 2)
1931                         if (left < time / 2 || Config.CdrReschedule) { // rearmed guesswork hack
1932                                 //printf("-- resched %d -> %d\n", left, time);
1933                                 CDREAD_INT(time);
1934                         }
1935                 }
1936
1937                 return;
1938         }
1939
1940         if (rt == 0x80 && !(cdr.Ctrl & 0x1) && cdr.Readed == 0) {
1941                 cdr.Readed = 1;
1942                 cdr.pTransfer = cdr.Transfer;
1943
1944                 switch (cdr.Mode & 0x30) {
1945                         case MODE_SIZE_2328:
1946                         case 0x00:
1947                                 cdr.pTransfer += 12;
1948                                 break;
1949
1950                         case MODE_SIZE_2340:
1951                                 cdr.pTransfer += 0;
1952                                 break;
1953
1954                         default:
1955                                 break;
1956                 }
1957         }
1958 }
1959
1960 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1961         u32 cdsize;
1962         int size;
1963         u8 *ptr;
1964
1965 #ifdef CDR_LOG
1966         CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1967 #endif
1968
1969         switch (chcr) {
1970                 case 0x11000000:
1971                 case 0x11400100:
1972                         if (cdr.Readed == 0) {
1973 #ifdef CDR_LOG
1974                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1975 #endif
1976                                 break;
1977                         }
1978
1979                         cdsize = (bcr & 0xffff) * 4;
1980
1981                         // Ape Escape: bcr = 0001 / 0000
1982                         // - fix boot
1983                         if( cdsize == 0 )
1984                         {
1985                                 switch (cdr.Mode & 0x30) {
1986                                         case 0x00: cdsize = 2048; break;
1987                                         case MODE_SIZE_2328: cdsize = 2328; break;
1988                                         case MODE_SIZE_2340: cdsize = 2340; break;
1989                                 }
1990                         }
1991
1992
1993                         ptr = (u8 *)PSXM(madr);
1994                         if (ptr == NULL) {
1995 #ifdef CPU_LOG
1996                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1997 #endif
1998                                 break;
1999                         }
2000
2001                         /*
2002                         GS CDX: Enhancement CD crash
2003                         - Setloc 0:0:0
2004                         - CdlPlay
2005                         - Spams DMA3 and gets buffer overrun
2006                         */
2007                         size = CD_FRAMESIZE_RAW - (cdr.pTransfer - cdr.Transfer);
2008                         if (size > cdsize)
2009                                 size = cdsize;
2010                         if (size > 0)
2011                         {
2012                                 memcpy(ptr, cdr.pTransfer, size);
2013                         }
2014
2015                         psxCpu->Clear(madr, cdsize / 4);
2016                         cdr.pTransfer += cdsize;
2017
2018
2019                         // burst vs normal
2020                         if( chcr == 0x11400100 ) {
2021                                 CDRDMA_INT( (cdsize/4) / 4 );
2022                         }
2023                         else if( chcr == 0x11000000 ) {
2024                                 CDRDMA_INT( (cdsize/4) * 1 );
2025                         }
2026                         return;
2027
2028                 default:
2029 #ifdef CDR_LOG
2030                         CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
2031 #endif
2032                         break;
2033         }
2034
2035         HW_DMA3_CHCR &= SWAP32(~0x01000000);
2036         DMA_INTERRUPT(3);
2037 }
2038
2039 void cdrDmaInterrupt()
2040 {
2041         if (HW_DMA3_CHCR & SWAP32(0x01000000))
2042         {
2043                 HW_DMA3_CHCR &= SWAP32(~0x01000000);
2044                 DMA_INTERRUPT(3);
2045         }
2046 }
2047
2048 void cdrReset() {
2049         memset(&cdr, 0, sizeof(cdr));
2050         cdr.CurTrack = 1;
2051         cdr.File = 1;
2052         cdr.Channel = 1;
2053
2054         // BIOS player - default values
2055         cdr.AttenuatorLeft[0] = 0x80;
2056         cdr.AttenuatorLeft[1] = 0x00;
2057         cdr.AttenuatorRight[0] = 0x80;
2058         cdr.AttenuatorRight[1] = 0x00;
2059 }
2060
2061 int cdrFreeze(gzFile f, int Mode) {
2062         uintptr_t tmp;
2063
2064
2065         if( Mode == 0 ) {
2066                 StopCdda();
2067         }
2068         
2069         gzfreeze(&cdr, sizeof(cdr));
2070         
2071         if (Mode == 1)
2072                 tmp = cdr.pTransfer - cdr.Transfer;
2073
2074         gzfreeze(&tmp, sizeof(tmp));
2075
2076         if (Mode == 0) {
2077                 cdr.pTransfer = cdr.Transfer + tmp;
2078
2079                 if (cdr.Play && !Config.Cdda)
2080                         CDR_play(cdr.SetSectorPlay);
2081         }
2082
2083         return 0;
2084 }
2085
2086 void LidInterrupt() {
2087         cdr.LidCheck = 0x20; // start checker
2088
2089         CDRLID_INT( cdReadTime * 3 );
2090         
2091         // generate interrupt if none active - open or close
2092         if (cdr.Irq == 0 || cdr.Irq == 0xff) {
2093                 cdr.Ctrl |= 0x80;
2094                 cdr.Stat = NoIntr;
2095                 AddIrqQueue(CdlNop, 0x800);
2096         }
2097 }