frontend: bios warning bugfix
[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                         Set_Track();
713                         Find_CurTrack();
714                         ReadTrack( cdr.SetSectorPlay );
715
716
717                         // GameShark CD Player: Calls 2x + Play 2x
718                         if( cdr.FastBackward || cdr.FastForward ) {
719                                 if( cdr.FastForward ) cdr.FastForward--;
720                                 if( cdr.FastBackward ) cdr.FastBackward--;
721
722                                 if( cdr.FastBackward == 0 && cdr.FastForward == 0 ) {
723                                         if( cdr.Play && CDR_getStatus(&stat) != -1 ) {
724                                                 cdr.SetSectorPlay[0] = stat.Time[0];
725                                                 cdr.SetSectorPlay[1] = stat.Time[1];
726                                                 cdr.SetSectorPlay[2] = stat.Time[2];
727                                         }
728                                 }
729                         }
730
731
732                         if (!Config.Cdda) {
733                                 // BIOS CD Player
734                                 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
735
736                                 // GameShark CD Player: Resume play
737                                 if( cdr.ParamC == 0 ) {
738 #ifdef CDR_LOG___0
739                                         CDR_LOG( "PLAY Resume @ %d:%d:%d\n",
740                                                 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
741 #endif
742
743                                         //CDR_play( cdr.SetSectorPlay );
744                                 }
745                                 else
746                                 {
747                                         // BIOS CD Player: Resume play
748                                         if( cdr.Param[0] == 0 ) {
749 #ifdef CDR_LOG___0
750                                                 CDR_LOG( "PLAY Resume T0 @ %d:%d:%d\n",
751                                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
752 #endif
753
754                                                 //CDR_play( cdr.SetSectorPlay );
755                                         }
756                                         else {
757 #ifdef CDR_LOG___0
758                                                 CDR_LOG( "PLAY Resume Td @ %d:%d:%d\n",
759                                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
760 #endif
761
762                                                 // BIOS CD Player: Allow track replaying
763                                                 StopCdda();
764
765
766                                                 cdr.CurTrack = btoi( cdr.Param[0] );
767
768                                                 if (CDR_getTN(cdr.ResultTN) != -1) {
769                                                         // check last track
770                                                         if (cdr.CurTrack > cdr.ResultTN[1])
771                                                                 cdr.CurTrack = cdr.ResultTN[1];
772
773                                                         if (CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD) != -1) {
774                                                                 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
775                                                                 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
776                                                                 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
777
778                                                                 // reset data
779                                                                 Set_Track();
780                                                                 Find_CurTrack();
781                                                                 ReadTrack( cdr.SetSectorPlay );
782
783                                                                 //CDR_play(cdr.SetSectorPlay);
784                                                         }
785                                                 }
786                                         }
787                                 }
788                         }
789
790
791                         // Vib Ribbon: gameplay checks flag
792                         cdr.StatP &= ~STATUS_SEEK;
793
794
795                         cdr.CmdProcess = 0;
796                         SetResultSize(1);
797                         cdr.StatP |= STATUS_ROTATING;
798                         cdr.Result[0] = cdr.StatP;
799                         cdr.Stat = Acknowledge;
800
801                         cdr.StatP |= STATUS_PLAY;
802
803                         
804                         // BIOS player - set flag again
805                         cdr.Play = TRUE;
806
807                         CDRPLAY_INT( cdReadTime );
808                         break;
809
810                 case CdlForward:
811                         cdr.CmdProcess = 0;
812                         SetResultSize(1);
813                         cdr.StatP |= STATUS_ROTATING;
814                         cdr.Result[0] = cdr.StatP;
815                         cdr.Stat = Complete;
816
817
818                         // GameShark CD Player: Calls 2x + Play 2x
819                         if( cdr.FastForward == 0 ) cdr.FastForward = 2;
820                         else cdr.FastForward++;
821
822                         cdr.FastBackward = 0;
823                         break;
824
825                 case CdlBackward:
826                         cdr.CmdProcess = 0;
827                         SetResultSize(1);
828                         cdr.StatP |= STATUS_ROTATING;
829                         cdr.Result[0] = cdr.StatP;
830                         cdr.Stat = Complete;
831
832
833                         // GameShark CD Player: Calls 2x + Play 2x
834                         if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
835                         else cdr.FastBackward++;
836
837                         cdr.FastForward = 0;
838                         break;
839
840                 case CdlStandby:
841                         cdr.CmdProcess = 0;
842                         SetResultSize(1);
843                         cdr.StatP |= STATUS_ROTATING;
844                         cdr.Result[0] = cdr.StatP;
845                         cdr.Stat = Complete;
846                         break;
847
848                 case CdlStop:
849                         cdr.CmdProcess = 0;
850                         SetResultSize(1);
851                         cdr.StatP &= ~STATUS_ROTATING;
852                         cdr.Result[0] = cdr.StatP;
853                         cdr.Stat = Complete;
854 //                      cdr.Stat = Acknowledge;
855
856                         if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
857                         break;
858
859                 case CdlPause:
860                         SetResultSize(1);
861                         cdr.Result[0] = cdr.StatP;
862                         cdr.Stat = Acknowledge;
863
864                         /*
865                         Gundam Battle Assault 2: much slower (*)
866                         - Fixes boot, gameplay
867
868                         Hokuto no Ken 2: slower
869                         - Fixes intro + subtitles
870
871                         InuYasha - Feudal Fairy Tale: slower
872                         - Fixes battles
873                         */
874                         AddIrqQueue(CdlPause + 0x20, cdReadTime * 3);
875                         cdr.Ctrl |= 0x80;
876                         break;
877
878                 case CdlPause + 0x20:
879                         SetResultSize(1);
880                         cdr.StatP &= ~STATUS_READ;
881                         cdr.StatP |= STATUS_ROTATING;
882                         cdr.Result[0] = cdr.StatP;
883                         cdr.Stat = Complete;
884                         break;
885
886                 case CdlInit:
887                         SetResultSize(1);
888                         cdr.StatP = STATUS_ROTATING;
889                         cdr.Result[0] = cdr.StatP;
890                         cdr.Stat = Acknowledge;
891 //                      if (!cdr.Init) {
892                                 AddIrqQueue(CdlInit + 0x20, 0x800);
893 //                      }
894                 break;
895
896                 case CdlInit + 0x20:
897                         SetResultSize(1);
898                         cdr.Result[0] = cdr.StatP;
899                         cdr.Stat = Complete;
900                         cdr.Init = 1;
901                         break;
902
903                 case CdlMute:
904                         SetResultSize(1);
905                         cdr.StatP |= STATUS_ROTATING;
906                         cdr.Result[0] = cdr.StatP;
907                         cdr.Stat = Acknowledge;
908                         break;
909
910                 case CdlDemute:
911                         SetResultSize(1);
912                         cdr.StatP |= STATUS_ROTATING;
913                         cdr.Result[0] = cdr.StatP;
914                         cdr.Stat = Acknowledge;
915                         break;
916
917                 case CdlSetfilter:
918                         SetResultSize(1);
919                         cdr.StatP |= STATUS_ROTATING;
920                         cdr.Result[0] = cdr.StatP;
921                         cdr.Stat = Acknowledge; 
922                         break;
923
924                 case CdlSetmode:
925                         SetResultSize(1);
926                         cdr.StatP |= STATUS_ROTATING;
927                         cdr.Result[0] = cdr.StatP;
928                         cdr.Stat = Acknowledge;
929                         break;
930
931                 case CdlGetmode:
932                         SetResultSize(6);
933                         cdr.StatP |= STATUS_ROTATING;
934                         cdr.Result[0] = cdr.StatP;
935                         cdr.Result[1] = cdr.Mode;
936                         cdr.Result[2] = cdr.File;
937                         cdr.Result[3] = cdr.Channel;
938                         cdr.Result[4] = 0;
939                         cdr.Result[5] = 0;
940                         cdr.Stat = Acknowledge;
941                         break;
942
943                 case CdlGetlocL:
944                         SetResultSize(8);
945                         for (i = 0; i < 8; i++)
946                                 cdr.Result[i] = cdr.Transfer[i];
947                         cdr.Stat = Acknowledge;
948                         break;
949
950                 case CdlGetlocP:
951                         // GameShark CDX CD Player: uses 17 bytes output (wraps around)
952                         SetResultSize(17);
953                         memset( cdr.Result, 0, 16 );
954
955                         subq = (struct SubQ *)CDR_getBufferSub();
956
957                         if (subq != NULL) {
958                                 cdr.Result[0] = subq->TrackNumber;
959                                 cdr.Result[1] = subq->IndexNumber;
960                                 memcpy(cdr.Result + 2, subq->TrackRelativeAddress, 3);
961                                 memcpy(cdr.Result + 5, subq->AbsoluteAddress, 3);
962
963
964                                 // subQ integrity check - data only (skip audio)
965                                 if( subq->TrackNumber == 1 && stat.Type == 0x01 ) {
966                                 if (calcCrc((u8 *)subq + 12, 10) != (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
967                                         memset(cdr.Result + 2, 0, 3 + 3); // CRC wrong, wipe out time data
968                                 }
969                                 }
970                         } else {
971                                 if( cdr.Play == FALSE || !(cdr.Mode & MODE_CDDA) || !(cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)) )
972                                         Create_Fake_Subq();
973
974
975                                 // track # / index #
976                                 cdr.Result[0] = itob(cdr.CurTrack);
977                                 cdr.Result[1] = itob(fake_subq_index);
978
979                                 // local
980                                 cdr.Result[2] = itob( fake_subq_local[0] );
981                                 cdr.Result[3] = itob( fake_subq_local[1] );
982                                 cdr.Result[4] = itob( fake_subq_local[2] );
983
984                                 // absolute
985                                 cdr.Result[5] = itob( fake_subq_real[0] );
986                                 cdr.Result[6] = itob( fake_subq_real[1] );
987                                 cdr.Result[7] = itob( fake_subq_real[2] );
988                         }
989
990                         // redump.org - wipe time
991                         if( !cdr.Play && CheckSBI(cdr.Result+5) ) {
992                                 memset( cdr.Result+2, 0, 6 );
993                         }
994
995                         cdr.Stat = Acknowledge;
996                         break;
997
998                 case CdlGetTN:
999                         // 5-Star Racing: don't stop CDDA
1000                         //
1001                         // Vib Ribbon: CD swap
1002                         StopReading();
1003
1004                         cdr.CmdProcess = 0;
1005                         SetResultSize(3);
1006                         cdr.StatP |= STATUS_ROTATING;
1007                         cdr.Result[0] = cdr.StatP;
1008                         if (CDR_getTN(cdr.ResultTN) == -1) {
1009                                 cdr.Stat = DiskError;
1010                                 cdr.Result[0] |= STATUS_ERROR;
1011                         } else {
1012                                 cdr.Stat = Acknowledge;
1013                                 cdr.Result[1] = itob(cdr.ResultTN[0]);
1014                                 cdr.Result[2] = itob(cdr.ResultTN[1]);
1015                         }
1016                         break;
1017
1018                 case CdlGetTD:
1019                         cdr.CmdProcess = 0;
1020                         cdr.Track = btoi(cdr.Param[0]);
1021                         SetResultSize(4);
1022                         cdr.StatP |= STATUS_ROTATING;
1023                         if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
1024                                 cdr.Stat = DiskError;
1025                                 cdr.Result[0] |= STATUS_ERROR;
1026                         } else {
1027                                 cdr.Stat = Acknowledge;
1028                                 cdr.Result[0] = cdr.StatP;
1029                                 cdr.Result[1] = itob(cdr.ResultTD[2]);
1030                                 cdr.Result[2] = itob(cdr.ResultTD[1]);
1031                                 cdr.Result[3] = itob(cdr.ResultTD[0]);
1032                         }
1033                         break;
1034
1035                 case CdlSeekL:
1036                         SetResultSize(1);
1037                         cdr.StatP |= STATUS_ROTATING;
1038                         cdr.Result[0] = cdr.StatP;
1039                         cdr.StatP |= STATUS_SEEK;
1040                         cdr.Stat = Acknowledge;
1041
1042                         /*
1043                         Crusaders of Might and Magic = 0.5x-4x
1044                         - fix cutscene speech start
1045
1046                         Eggs of Steel = 2x-?
1047                         - fix new game
1048
1049                         Medievil = ?-4x
1050                         - fix cutscene speech
1051
1052                         Rockman X5 = 0.5-4x
1053                         - fix capcom logo
1054                         */
1055                         AddIrqQueue(CdlSeekL + 0x20, cdReadTime * 4);
1056                         break;
1057
1058                 case CdlSeekL + 0x20:
1059                         SetResultSize(1);
1060                         cdr.StatP |= STATUS_ROTATING;
1061                         cdr.StatP &= ~STATUS_SEEK;
1062                         cdr.Result[0] = cdr.StatP;
1063                         cdr.Seeked = TRUE;
1064                         cdr.Stat = Complete;
1065
1066
1067                         // Mega Man Legends 2: must update read cursor for getlocp
1068                         ReadTrack( cdr.SetSector );
1069                         break;
1070
1071                 case CdlSeekP:
1072                         SetResultSize(1);
1073                         cdr.StatP |= STATUS_ROTATING;
1074                         cdr.Result[0] = cdr.StatP;
1075                         cdr.StatP |= STATUS_SEEK;
1076                         cdr.Stat = Acknowledge;
1077                         AddIrqQueue(CdlSeekP + 0x20, cdReadTime * 1);
1078                         break;
1079
1080                 case CdlSeekP + 0x20:
1081                         SetResultSize(1);
1082                         cdr.StatP |= STATUS_ROTATING;
1083                         cdr.StatP &= ~STATUS_SEEK;
1084                         cdr.Result[0] = cdr.StatP;
1085                         cdr.Stat = Complete;
1086                         cdr.Seeked = TRUE;
1087
1088                         // GameShark Music Player
1089                         memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
1090
1091                         // Tomb Raider 2: must update read cursor for getlocp
1092                         Find_CurTrack();
1093                         ReadTrack( cdr.SetSectorPlay );
1094                         break;
1095
1096                 case CdlTest:
1097                         cdr.Stat = Acknowledge;
1098                         switch (cdr.Param[0]) {
1099                                 case 0x20: // System Controller ROM Version
1100                                         SetResultSize(4);
1101                                         memcpy(cdr.Result, Test20, 4);
1102                                         break;
1103                                 case 0x22:
1104                                         SetResultSize(8);
1105                                         memcpy(cdr.Result, Test22, 4);
1106                                         break;
1107                                 case 0x23: case 0x24:
1108                                         SetResultSize(8);
1109                                         memcpy(cdr.Result, Test23, 4);
1110                                         break;
1111                         }
1112                         break;
1113
1114                 case CdlID:
1115                         SetResultSize(1);
1116                         cdr.StatP |= STATUS_ROTATING;
1117                         cdr.Result[0] = cdr.StatP;
1118                         cdr.Stat = Acknowledge;
1119                         AddIrqQueue(CdlID + 0x20, 0x800);
1120                         break;
1121
1122                 case CdlID + 0x20:
1123                         SetResultSize(8);
1124
1125                         if (CDR_getStatus(&stat) == -1) {
1126                                 cdr.Result[0] = 0x00; // 0x08 and cdr.Result[1]|0x10 : audio cd, enters cd player
1127                                 cdr.Result[1] = 0x80; // 0x80 leads to the menu in the bios, else loads CD
1128                         }
1129                         else {
1130                                 if (stat.Type == 2) {
1131                                         // Music CD
1132                                         cdr.Result[0] = 0x08;
1133                                         cdr.Result[1] = 0x10;
1134
1135                                         cdr.Result[1] |= 0x80;
1136                                 }
1137                                 else {
1138                                         // Data CD
1139                                         if (CdromId[0] == '\0') {
1140                                                 cdr.Result[0] = 0x00;
1141                                                 cdr.Result[1] = 0x80;
1142                                         }
1143                                         else {
1144                                                 cdr.Result[0] = 0x08;
1145                                                 cdr.Result[1] = 0x00;
1146                                         }
1147                                 }
1148                         }
1149
1150                         cdr.Result[2] = 0x00;
1151                         cdr.Result[3] = 0x00;
1152                         strncpy((char *)&cdr.Result[4], "PCSX", 4);
1153                         cdr.Stat = Complete;
1154                         break;
1155
1156                 case CdlReset:
1157                         SetResultSize(1);
1158                         cdr.StatP = STATUS_ROTATING;
1159                         cdr.Result[0] = cdr.StatP;
1160                         cdr.Stat = Acknowledge;
1161                         break;
1162
1163                 case CdlReadT:
1164                         SetResultSize(1);
1165                         cdr.StatP |= STATUS_ROTATING;
1166                         cdr.Result[0] = cdr.StatP;
1167                         cdr.Stat = Acknowledge;
1168                         AddIrqQueue(CdlReadT + 0x20, 0x800);
1169                         break;
1170
1171                 case CdlReadT + 0x20:
1172                         SetResultSize(1);
1173                         cdr.StatP |= STATUS_ROTATING;
1174                         cdr.Result[0] = cdr.StatP;
1175                         cdr.Stat = Complete;
1176                         break;
1177
1178                 case CdlReadToc:
1179                         SetResultSize(1);
1180                         cdr.StatP |= STATUS_ROTATING;
1181                         cdr.Result[0] = cdr.StatP;
1182                         cdr.Stat = Acknowledge;
1183                         AddIrqQueue(CdlReadToc + 0x20, 0x800);
1184                         break;
1185
1186                 case CdlReadToc + 0x20:
1187                         SetResultSize(1);
1188                         cdr.StatP |= STATUS_ROTATING;
1189                         cdr.Result[0] = cdr.StatP;
1190                         cdr.Stat = Complete;
1191                         break;
1192
1193                 case AUTOPAUSE:
1194                         cdr.OCUP = 0;
1195 /*                      SetResultSize(1);
1196                         StopCdda();
1197                         StopReading();
1198                         cdr.OCUP = 0;
1199                         cdr.StatP&=~0x20;
1200                         cdr.StatP|= 0x2;
1201                         cdr.Result[0] = cdr.StatP;
1202                         cdr.Stat = DataEnd;
1203 */                      AddIrqQueue(CdlPause, 0x800);
1204                         break;
1205
1206                 case READ_ACK:
1207                         if (!cdr.Reading) return;
1208
1209
1210                         // Fighting Force 2 - update subq time immediately
1211                         // - fixes new game
1212                         ReadTrack( cdr.SetSector );
1213
1214
1215                         // Crusaders of Might and Magic - update getlocl now
1216                         // - fixes cutscene speech
1217                         {
1218                                 u8 *buf = CDR_getBuffer();
1219                                 memcpy(cdr.Transfer, buf, 8);
1220                         }
1221                         
1222                         
1223                         /*
1224                         Duke Nukem: Land of the Babes - seek then delay read for one frame
1225                         - fixes cutscenes
1226                         */
1227
1228                         if (!cdr.Seeked) {
1229                                 cdr.Seeked = TRUE;
1230
1231                                 cdr.StatP |= STATUS_SEEK;
1232                                 cdr.StatP &= ~STATUS_READ;
1233
1234                                 // Crusaders of Might and Magic - use short time
1235                                 // - fix cutscene speech (startup)
1236
1237                                 // ??? - use more accurate seek time later
1238                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1239                         } else {
1240                                 cdr.StatP |= STATUS_READ;
1241                                 cdr.StatP &= ~STATUS_SEEK;
1242
1243                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1244                         }
1245
1246                         SetResultSize(1);
1247                         cdr.StatP |= STATUS_ROTATING;
1248                         cdr.Result[0] = cdr.StatP;
1249                         cdr.Stat = Acknowledge;
1250                         break;
1251
1252                 case 0xff:
1253                         return;
1254
1255                 default:
1256                         cdr.Stat = Complete;
1257                         break;
1258         }
1259
1260         Check_Shell( Irq );
1261
1262         if (cdr.Stat != NoIntr && cdr.Reg2 != 0x18) {
1263                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
1264         }
1265
1266 #ifdef CDR_LOG
1267         CDR_LOG("cdrInterrupt() Log: CDR Interrupt IRQ %x\n", Irq);
1268 #endif
1269 }
1270
1271 void cdrReadInterrupt() {
1272         u8 *buf;
1273
1274         if (!cdr.Reading)
1275                 return;
1276
1277         if (cdr.Irq || cdr.Stat) {
1278                 CDREAD_INT(0x100);
1279                 return;
1280         }
1281
1282 #ifdef CDR_LOG
1283         CDR_LOG("cdrReadInterrupt() Log: KEY END");
1284 #endif
1285
1286         cdr.OCUP = 1;
1287         SetResultSize(1);
1288         cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1289         cdr.StatP &= ~STATUS_SEEK;
1290         cdr.Result[0] = cdr.StatP;
1291
1292         ReadTrack( cdr.SetSector );
1293
1294         buf = CDR_getBuffer();
1295         if (buf == NULL)
1296                 cdr.RErr = -1;
1297
1298         if (cdr.RErr == -1) {
1299 #ifdef CDR_LOG
1300                 fprintf(emuLog, "cdrReadInterrupt() Log: err\n");
1301 #endif
1302                 memset(cdr.Transfer, 0, DATA_SIZE);
1303                 cdr.Stat = DiskError;
1304                 cdr.Result[0] |= STATUS_ERROR;
1305                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1306                 return;
1307         }
1308
1309         memcpy(cdr.Transfer, buf, DATA_SIZE);
1310         CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1311
1312
1313 #ifdef CDR_LOG
1314         fprintf(emuLog, "cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1315 #endif
1316
1317         if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1318                 // Firemen 2: Multi-XA files - briefings, cutscenes
1319                 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1320                         cdr.File = cdr.Transfer[4 + 0];
1321                         cdr.Channel = cdr.Transfer[4 + 1];
1322                 }
1323
1324                 if ((cdr.Transfer[4 + 2] & 0x4) &&
1325                          (cdr.Transfer[4 + 1] == cdr.Channel) &&
1326                         (cdr.Transfer[4 + 0] == cdr.File)) {
1327                         int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1328
1329                         if (!ret) {
1330                                 SPU_playADPCMchannel(&cdr.Xa);
1331                                 cdr.FirstSector = 0;
1332
1333 #if 0
1334                                 // Crash Team Racing: music, speech
1335                                 // - done using cdda decoded buffer (spu irq)
1336                                 // - don't do here
1337
1338                                 // signal ADPCM data ready
1339                                 psxHu32ref(0x1070) |= SWAP32((u32)0x200);
1340 #endif
1341                         }
1342                         else cdr.FirstSector = -1;
1343                 }
1344         }
1345
1346         cdr.SetSector[2]++;
1347         if (cdr.SetSector[2] == 75) {
1348                 cdr.SetSector[2] = 0;
1349                 cdr.SetSector[1]++;
1350                 if (cdr.SetSector[1] == 60) {
1351                         cdr.SetSector[1] = 0;
1352                         cdr.SetSector[0]++;
1353                 }
1354         }
1355
1356         cdr.Readed = 0;
1357
1358         // G-Police: Don't autopause ADPCM even if mode set (music)
1359         if ((cdr.Transfer[4 + 2] & 0x80) && (cdr.Mode & MODE_AUTOPAUSE) &&
1360                         (cdr.Transfer[4 + 2] & 0x4) != 0x4 ) { // EOF
1361 #ifdef CDR_LOG
1362                 CDR_LOG("cdrReadInterrupt() Log: Autopausing read\n");
1363 #endif
1364 //              AddIrqQueue(AUTOPAUSE, 0x2000);
1365                 AddIrqQueue(CdlPause, 0x2000);
1366         }
1367         else {
1368                 CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
1369         }
1370
1371         /*
1372         Croc 2: $40 - only FORM1 (*)
1373         Judge Dredd: $C8 - only FORM1 (*)
1374         Sim Theme Park - no adpcm at all (zero)
1375         */
1376
1377         if( (cdr.Mode & MODE_STRSND) == 0 || (cdr.Transfer[4+2] & 0x4) != 0x4 ) {
1378                 cdr.Stat = DataReady;
1379         } else {
1380                 // Breath of Fire 3 - fix inn sleeping
1381                 // Rockman X5 - no music restart problem
1382                 cdr.Stat = NoIntr;
1383         }
1384         psxHu32ref(0x1070) |= SWAP32((u32)0x4);
1385
1386         Check_Shell(0);
1387 }
1388
1389 /*
1390 cdrRead0:
1391         bit 0 - 0 REG1 command send / 1 REG1 data read
1392         bit 1 - 0 data transfer finish / 1 data transfer ready/in progress
1393         bit 2 - unknown
1394         bit 3 - unknown
1395         bit 4 - unknown
1396         bit 5 - 1 result ready
1397         bit 6 - 1 dma ready
1398         bit 7 - 1 command being processed
1399 */
1400
1401 unsigned char cdrRead0(void) {
1402         if (cdr.ResultReady)
1403                 cdr.Ctrl |= 0x20;
1404         else
1405                 cdr.Ctrl &= ~0x20;
1406
1407         if (cdr.OCUP)
1408                 cdr.Ctrl |= 0x40;
1409 //  else
1410 //              cdr.Ctrl &= ~0x40;
1411
1412         // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1413         cdr.Ctrl |= 0x18;
1414
1415 #ifdef CDR_LOG
1416         CDR_LOG("cdrRead0() Log: CD0 Read: %x\n", cdr.Ctrl);
1417 #endif
1418
1419         return psxHu8(0x1800) = cdr.Ctrl;
1420 }
1421
1422 /*
1423 cdrWrite0:
1424         0 - to send a command / 1 - to get the result
1425 */
1426
1427 void cdrWrite0(unsigned char rt) {
1428 #ifdef CDR_LOG
1429         CDR_LOG("cdrWrite0() Log: CD0 write: %x\n", rt);
1430 #endif
1431         cdr.Ctrl = rt | (cdr.Ctrl & ~0x3);
1432
1433         if (rt == 0) {
1434                 cdr.ParamP = 0;
1435                 cdr.ParamC = 0;
1436                 cdr.ResultReady = 0;
1437         }
1438 }
1439
1440 unsigned char cdrRead1(void) {
1441     if (cdr.ResultReady) { // && cdr.Ctrl & 0x1) {
1442                 // GameShark CDX CD Player: uses 17 bytes output (wraps around)
1443                 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1444                 cdr.ResultP++;
1445                 if (cdr.ResultP == cdr.ResultC)
1446                         cdr.ResultReady = 0;
1447         } else {
1448                 psxHu8(0x1801) = 0;
1449         }
1450 #ifdef CDR_LOG
1451         CDR_LOG("cdrRead1() Log: CD1 Read: %x\n", psxHu8(0x1801));
1452 #endif
1453         return psxHu8(0x1801);
1454 }
1455
1456 void cdrWrite1(unsigned char rt) {
1457         int i;
1458
1459 #ifdef CDR_LOG
1460         CDR_LOG("cdrWrite1() Log: CD1 write: %x (%s)\n", rt, CmdName[rt]);
1461 #endif
1462
1463
1464         // Tekken: CDXA fade-out
1465         if( (cdr.Ctrl & 3) == 3 ) {
1466                 //cdr.AttenuatorRight[0] = rt;
1467         }
1468
1469
1470 //      psxHu8(0x1801) = rt;
1471         cdr.Cmd = rt;
1472         cdr.OCUP = 0;
1473
1474 #ifdef CDRCMD_DEBUG
1475         SysPrintf("cdrWrite1() Log: CD1 write: %x (%s)", rt, CmdName[rt]);
1476         if (cdr.ParamC) {
1477                 SysPrintf(" Param[%d] = {", cdr.ParamC);
1478                 for (i = 0; i < cdr.ParamC; i++)
1479                         SysPrintf(" %x,", cdr.Param[i]);
1480                 SysPrintf("}\n");
1481         } else {
1482                 SysPrintf("\n");
1483         }
1484 #endif
1485
1486         if (cdr.Ctrl & 0x1) return;
1487
1488         switch (cdr.Cmd) {
1489         case CdlSync:
1490                 cdr.Ctrl |= 0x80;
1491                 cdr.Stat = NoIntr; 
1492                 AddIrqQueue(cdr.Cmd, 0x800);
1493                 break;
1494
1495         case CdlNop:
1496                 cdr.Ctrl |= 0x80;
1497                 cdr.Stat = NoIntr; 
1498
1499                 // Twisted Metal 3 - fix music
1500                 AddIrqQueue(cdr.Cmd, 0x800);
1501                 break;
1502
1503         case CdlSetloc:
1504                 StopReading();
1505                 cdr.Seeked = FALSE;
1506                 for (i = 0; i < 3; i++)
1507                         cdr.SetSector[i] = btoi(cdr.Param[i]);
1508                 cdr.SetSector[3] = 0;
1509
1510                 /*
1511                    if ((cdr.SetSector[0] | cdr.SetSector[1] | cdr.SetSector[2]) == 0) {
1512                  *(u32 *)cdr.SetSector = *(u32 *)cdr.SetSectorSeek;
1513                  }*/
1514
1515                 cdr.Ctrl |= 0x80;
1516                 cdr.Stat = NoIntr;
1517                 AddIrqQueue(cdr.Cmd, 0x800);
1518                 break;
1519
1520         case CdlPlay:
1521                 // Vib Ribbon: try same track again
1522                 StopCdda();
1523
1524                 if (!cdr.SetSector[0] & !cdr.SetSector[1] & !cdr.SetSector[2]) {
1525                         if (CDR_getTN(cdr.ResultTN) != -1) {
1526                                 if (cdr.CurTrack > cdr.ResultTN[1])
1527                                         cdr.CurTrack = cdr.ResultTN[1];
1528                                 if (CDR_getTD((unsigned char)(cdr.CurTrack), cdr.ResultTD) != -1) {
1529                                         int tmp = cdr.ResultTD[2];
1530                                         cdr.ResultTD[2] = cdr.ResultTD[0];
1531                                         cdr.ResultTD[0] = tmp;
1532                                         if (!Config.Cdda) CDR_play(cdr.ResultTD);
1533                                 }
1534                         }
1535                 } else if (!Config.Cdda) {
1536                         CDR_play(cdr.SetSector);
1537                 }
1538
1539                 // Vib Ribbon - decoded buffer IRQ for CDDA reading
1540                 // - fixes ribbon timing + music CD mode
1541                 //TODO?
1542                 //CDRDBUF_INT( PSXCLK / 44100 * 0x100 );
1543
1544
1545                 cdr.Play = TRUE;
1546
1547                 cdr.StatP |= STATUS_SEEK;
1548                 cdr.StatP &= ~STATUS_ROTATING;
1549
1550                 cdr.Ctrl |= 0x80;
1551                 cdr.Stat = NoIntr; 
1552                 AddIrqQueue(cdr.Cmd, 0x800);
1553                 break;
1554
1555         case CdlForward:
1556                 //if (cdr.CurTrack < 0xaa)
1557                 //      cdr.CurTrack++;
1558                 cdr.Ctrl |= 0x80;
1559                 cdr.Stat = NoIntr; 
1560                 AddIrqQueue(cdr.Cmd, 0x800);
1561                 break;
1562
1563         case CdlBackward:
1564                 //if (cdr.CurTrack > 1)
1565                 //cdr.CurTrack--;
1566                 cdr.Ctrl |= 0x80;
1567                 cdr.Stat = NoIntr; 
1568                 AddIrqQueue(cdr.Cmd, 0x800);
1569                 break;
1570
1571         case CdlReadN:
1572                 cdr.Irq = 0;
1573                 StopReading();
1574                 cdr.Ctrl|= 0x80;
1575                 cdr.Stat = NoIntr; 
1576                 StartReading(1, 0x800);
1577                 break;
1578
1579         case CdlStandby:
1580                 StopCdda();
1581                 StopReading();
1582                 cdr.Ctrl |= 0x80;
1583                 cdr.Stat = NoIntr;
1584                 AddIrqQueue(cdr.Cmd, 0x800);
1585                 break;
1586
1587         case CdlStop:
1588                 // GameShark CD Player: Reset CDDA to track start
1589                 if( cdr.Play && CDR_getStatus(&stat) != -1 ) {
1590                         cdr.SetSectorPlay[0] = stat.Time[0];
1591                         cdr.SetSectorPlay[1] = stat.Time[1];
1592                         cdr.SetSectorPlay[2] = stat.Time[2];
1593
1594                         Find_CurTrack();
1595
1596
1597                         // grab time for current track
1598                         CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
1599
1600                         cdr.SetSectorPlay[0] = cdr.ResultTD[2];
1601                         cdr.SetSectorPlay[1] = cdr.ResultTD[1];
1602                         cdr.SetSectorPlay[2] = cdr.ResultTD[0];
1603                 }
1604
1605                 StopCdda();
1606                 StopReading();
1607
1608                 cdr.Ctrl |= 0x80;
1609                 cdr.Stat = NoIntr;
1610                 AddIrqQueue(cdr.Cmd, 0x800);
1611                 break;
1612
1613         case CdlPause:
1614                 /*
1615                    GameShark CD Player: save time for resume
1616
1617                    Twisted Metal - World Tour: don't mix Setloc / CdlPlay cursors
1618                 */
1619
1620                 StopCdda();
1621                 StopReading();
1622                 cdr.Ctrl |= 0x80;
1623                 cdr.Stat = NoIntr;
1624
1625                 AddIrqQueue(cdr.Cmd, 0x800);
1626                 break;
1627
1628         case CdlReset:
1629         case CdlInit:
1630                 StopCdda();
1631                 StopReading();
1632                 cdr.Ctrl |= 0x80;
1633                 cdr.Stat = NoIntr; 
1634                 AddIrqQueue(cdr.Cmd, 0x800);
1635                 break;
1636
1637         case CdlMute:
1638                 cdr.Muted = TRUE;
1639                 cdr.Ctrl |= 0x80;
1640                 cdr.Stat = NoIntr; 
1641                 AddIrqQueue(cdr.Cmd, 0x800);
1642
1643                         // Duke Nukem - Time to Kill
1644                         // - do not directly set cd-xa volume
1645                         //SPU_writeRegister( H_CDLeft, 0x0000 );
1646                         //SPU_writeRegister( H_CDRight, 0x0000 );
1647                 break;
1648
1649         case CdlDemute:
1650                 cdr.Muted = FALSE;
1651                 cdr.Ctrl |= 0x80;
1652                 cdr.Stat = NoIntr; 
1653                 AddIrqQueue(cdr.Cmd, 0x800);
1654
1655                         // Duke Nukem - Time to Kill
1656                         // - do not directly set cd-xa volume
1657                         //SPU_writeRegister( H_CDLeft, 0x7f00 );
1658                         //SPU_writeRegister( H_CDRight, 0x7f00 );
1659                 break;
1660
1661         case CdlSetfilter:
1662                 cdr.File = cdr.Param[0];
1663                 cdr.Channel = cdr.Param[1];
1664                 cdr.Ctrl |= 0x80;
1665                 cdr.Stat = NoIntr; 
1666                 AddIrqQueue(cdr.Cmd, 0x800);
1667                 break;
1668
1669         case CdlSetmode:
1670 #ifdef CDR_LOG
1671                 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1672 #endif 
1673                 cdr.Mode = cdr.Param[0];
1674                 cdr.Ctrl |= 0x80;
1675                 cdr.Stat = NoIntr; 
1676                 AddIrqQueue(cdr.Cmd, 0x800);
1677
1678                 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1679                 // - fixes choppy movie sound
1680                 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1681                         StopCdda();
1682                 break;
1683
1684         case CdlGetmode:
1685                 cdr.Ctrl |= 0x80;
1686                 cdr.Stat = NoIntr; 
1687                 AddIrqQueue(cdr.Cmd, 0x800);
1688                 break;
1689
1690         case CdlGetlocL:
1691                 cdr.Ctrl |= 0x80;
1692                 cdr.Stat = NoIntr; 
1693
1694                 // Crusaders of Might and Magic - cutscene speech
1695                 AddIrqQueue(cdr.Cmd, 0x800);
1696                 break;
1697
1698         case CdlGetlocP:
1699                 cdr.Ctrl |= 0x80;
1700                 cdr.Stat = NoIntr; 
1701
1702                 // GameShark CDX / Lite Player: pretty narrow time window
1703                 // - doesn't always work due to time inprecision
1704                 //AddIrqQueue(cdr.Cmd, 0x28);
1705
1706                 // Tomb Raider 2 - cdda
1707                 //AddIrqQueue(cdr.Cmd, 0x40);
1708
1709                 // rearmed: the above works in pcsxr-svn, but breaks here
1710                 // (TOCA world touring cars), perhaps some other code is not merged yet
1711                 AddIrqQueue(cdr.Cmd, 0x1000);
1712                 break;
1713
1714         case CdlGetTN:
1715                 cdr.Ctrl |= 0x80;
1716                 cdr.Stat = NoIntr; 
1717                 //AddIrqQueue(cdr.Cmd, 0x800);
1718
1719                 // GameShark CDX CD Player: very long time
1720                 AddIrqQueue(cdr.Cmd, 0x100000);
1721                 break;
1722
1723         case CdlGetTD:
1724                 cdr.Ctrl |= 0x80;
1725                 cdr.Stat = NoIntr; 
1726                 AddIrqQueue(cdr.Cmd, 0x800);
1727                 break;
1728
1729         case CdlSeekL:
1730 //                      ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
1731                 cdr.Ctrl |= 0x80;
1732                 cdr.Stat = NoIntr; 
1733                 AddIrqQueue(cdr.Cmd, 0x800);
1734
1735                 StopCdda();
1736                 StopReading();
1737
1738                 break;
1739
1740         case CdlSeekP:
1741 //              ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
1742                 cdr.Ctrl |= 0x80;
1743                 cdr.Stat = NoIntr; 
1744
1745                 // Tomb Raider 2 - reset cdda
1746                 StopCdda();
1747                 StopReading();
1748
1749                 AddIrqQueue(cdr.Cmd, 0x800);
1750                 break;
1751
1752         // Destruction Derby: read TOC? GetTD after this
1753         case CdlReadT:
1754                 cdr.Ctrl |= 0x80;
1755                 cdr.Stat = NoIntr;
1756                 AddIrqQueue(cdr.Cmd, 0x800);
1757                 break;
1758
1759         case CdlTest:
1760                 cdr.Ctrl |= 0x80;
1761                 cdr.Stat = NoIntr; 
1762                 AddIrqQueue(cdr.Cmd, 0x800);
1763                 break;
1764
1765         case CdlID:
1766                 cdr.Ctrl |= 0x80;
1767                 cdr.Stat = NoIntr; 
1768                 AddIrqQueue(cdr.Cmd, 0x800);
1769                 break;
1770
1771         case CdlReadS:
1772                 cdr.Irq = 0;
1773                 StopReading();
1774                 cdr.Ctrl |= 0x80;
1775                 cdr.Stat = NoIntr; 
1776                 StartReading(2, 0x800);
1777                 break;
1778
1779         case CdlReadToc:
1780                 cdr.Ctrl |= 0x80;
1781                 cdr.Stat = NoIntr; 
1782                 AddIrqQueue(cdr.Cmd, 0x800);
1783                 break;
1784
1785         default:
1786 #ifdef CDR_LOG
1787                 CDR_LOG("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
1788 #endif
1789                 return;
1790         }
1791         if (cdr.Stat != NoIntr) {
1792                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
1793         }
1794 }
1795
1796 unsigned char cdrRead2(void) {
1797         unsigned char ret;
1798
1799         if (cdr.Readed == 0) {
1800                 ret = 0;
1801         } else {
1802                 ret = *cdr.pTransfer++;
1803         }
1804
1805 #ifdef CDR_LOG
1806         CDR_LOG("cdrRead2() Log: CD2 Read: %x\n", ret);
1807 #endif
1808         return ret;
1809 }
1810
1811 void cdrWrite2(unsigned char rt) {
1812 #ifdef CDR_LOG
1813         CDR_LOG("cdrWrite2() Log: CD2 write: %x\n", rt);
1814 #endif
1815
1816         // Tekken: CDXA fade-out
1817         if( (cdr.Ctrl & 3) == 2 ) {
1818                 //cdr.AttenuatorLeft[0] = rt;
1819         }
1820         else if( (cdr.Ctrl & 3) == 3 ) {
1821                 //cdr.AttenuatorRight[1] = rt;
1822         }
1823
1824
1825         if (cdr.Ctrl & 0x1) {
1826                 switch (rt) {
1827                         case 0x07:
1828                                 cdr.ParamP = 0;
1829                                 cdr.ParamC = 0;
1830                                 cdr.ResultReady = 1; //0;
1831                                 cdr.Ctrl &= ~3; //cdr.Ctrl = 0;
1832                                 break;
1833
1834                         default:
1835                                 cdr.Reg2 = rt;
1836                                 break;
1837                 }
1838         } else if (!(cdr.Ctrl & 0x1) && cdr.ParamP < 8) {
1839                 cdr.Param[cdr.ParamP++] = rt;
1840                 cdr.ParamC++;
1841         }
1842 }
1843
1844 unsigned char cdrRead3(void) {
1845         if (cdr.Stat) {
1846                 if (cdr.Ctrl & 0x1)
1847                         psxHu8(0x1803) = cdr.Stat | 0xE0;
1848                 else
1849                         psxHu8(0x1803) = 0xff;
1850         } else {
1851                 psxHu8(0x1803) = 0;
1852         }
1853 #ifdef CDR_LOG
1854         CDR_LOG("cdrRead3() Log: CD3 Read: %x\n", psxHu8(0x1803));
1855 #endif
1856         return psxHu8(0x1803);
1857 }
1858
1859 void cdrWrite3(unsigned char rt) {
1860 #ifdef CDR_LOG
1861         CDR_LOG("cdrWrite3() Log: CD3 write: %x\n", rt);
1862 #endif
1863 /*
1864         // Tekken: CDXA fade-out
1865         if( (cdr.Ctrl & 3) == 2 ) {
1866                 cdr.AttenuatorLeft[1] = rt;
1867         }
1868         else if( (cdr.Ctrl & 3) == 3 && rt == 0x20 ) {
1869 #ifdef CDR_LOG
1870                 CDR_LOG( "CD-XA Volume: %X %X | %X %X\n",
1871                         cdr.AttenuatorLeft[0], cdr.AttenuatorLeft[1],
1872                         cdr.AttenuatorRight[0], cdr.AttenuatorRight[1] );
1873 #endif
1874         }
1875 */
1876
1877         // GameShark CDX CD Player: Irq timing mania
1878         if( rt == 0 &&
1879                         cdr.Irq != 0 && cdr.Irq != 0xff &&
1880                         cdr.ResultReady == 0 ) {
1881
1882                 // GS CDX: ~0x28 cycle timing - way too precise
1883                 if( cdr.Irq == CdlGetlocP ) {
1884                         cdrInterrupt();
1885
1886                         psxRegs.interrupt &= ~(1 << PSXINT_CDR);
1887                 }
1888         }
1889
1890
1891         if (rt == 0x07 && cdr.Ctrl & 0x1) {
1892                 cdr.Stat = 0;
1893
1894                 if (cdr.Irq == 0xff) {
1895                         cdr.Irq = 0;
1896                         return;
1897                 }
1898
1899                 // XA streaming - incorrect timing because of this reschedule
1900                 // - Final Fantasy Tactics
1901                 // - various other games
1902
1903                 if (cdr.Irq) // rearmed guesswork hack
1904                 if (cdr.Reading && !cdr.ResultReady) {
1905                         CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
1906                 }
1907
1908                 return;
1909         }
1910
1911         if (rt == 0x80 && !(cdr.Ctrl & 0x1) && cdr.Readed == 0) {
1912                 cdr.Readed = 1;
1913                 cdr.pTransfer = cdr.Transfer;
1914
1915                 switch (cdr.Mode & 0x30) {
1916                         case MODE_SIZE_2328:
1917                         case 0x00:
1918                                 cdr.pTransfer += 12;
1919                                 break;
1920
1921                         case MODE_SIZE_2340:
1922                                 cdr.pTransfer += 0;
1923                                 break;
1924
1925                         default:
1926                                 break;
1927                 }
1928         }
1929 }
1930
1931 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1932         u32 cdsize;
1933         u8 *ptr;
1934
1935 #ifdef CDR_LOG
1936         CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1937 #endif
1938
1939         switch (chcr) {
1940                 case 0x11000000:
1941                 case 0x11400100:
1942                         if (cdr.Readed == 0) {
1943 #ifdef CDR_LOG
1944                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1945 #endif
1946                                 break;
1947                         }
1948
1949                         cdsize = (bcr & 0xffff) * 4;
1950
1951                         // Ape Escape: bcr = 0001 / 0000
1952                         // - fix boot
1953                         if( cdsize == 0 )
1954                         {
1955                                 switch (cdr.Mode & 0x30) {
1956                                         case 0x00: cdsize = 2048; break;
1957                                         case MODE_SIZE_2328: cdsize = 2328; break;
1958                                         case MODE_SIZE_2340: cdsize = 2340; break;
1959                                 }
1960                         }
1961
1962
1963                         ptr = (u8 *)PSXM(madr);
1964                         if (ptr == NULL) {
1965 #ifdef CPU_LOG
1966                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1967 #endif
1968                                 break;
1969                         }
1970
1971                         /*
1972                         GS CDX: Enhancement CD crash
1973                         - Setloc 0:0:0
1974                         - CdlPlay
1975                         - Spams DMA3 and gets buffer overrun
1976                         */
1977
1978                         if( (cdr.pTransfer-cdr.Transfer) + cdsize > 2352 )
1979                         {
1980                                 // avoid crash - probably should wrap here
1981                                 //memcpy(ptr, cdr.pTransfer, cdsize);
1982                         }
1983                         else
1984                         {
1985                                 memcpy(ptr, cdr.pTransfer, cdsize);
1986                         }
1987
1988                         psxCpu->Clear(madr, cdsize / 4);
1989                         cdr.pTransfer += cdsize;
1990
1991
1992                         // burst vs normal
1993                         if( chcr == 0x11400100 ) {
1994                                 CDRDMA_INT( (cdsize/4) / 4 );
1995                         }
1996                         else if( chcr == 0x11000000 ) {
1997                                 CDRDMA_INT( (cdsize/4) * 1 );
1998                         }
1999                         return;
2000
2001                 default:
2002 #ifdef CDR_LOG
2003                         CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
2004 #endif
2005                         break;
2006         }
2007
2008         HW_DMA3_CHCR &= SWAP32(~0x01000000);
2009         DMA_INTERRUPT(3);
2010 }
2011
2012 void cdrDmaInterrupt()
2013 {
2014         HW_DMA3_CHCR &= SWAP32(~0x01000000);
2015         DMA_INTERRUPT(3);
2016 }
2017
2018 void cdrReset() {
2019         memset(&cdr, 0, sizeof(cdr));
2020         cdr.CurTrack = 1;
2021         cdr.File = 1;
2022         cdr.Channel = 1;
2023 }
2024
2025 int cdrFreeze(gzFile f, int Mode) {
2026         uintptr_t tmp;
2027
2028
2029         if( Mode == 0 ) {
2030                 StopCdda();
2031         }
2032         
2033         gzfreeze(&cdr, sizeof(cdr));
2034         
2035         if (Mode == 1)
2036                 tmp = cdr.pTransfer - cdr.Transfer;
2037
2038         gzfreeze(&tmp, sizeof(tmp));
2039
2040         if (Mode == 0)
2041                 cdr.pTransfer = cdr.Transfer + tmp;
2042
2043         return 0;
2044 }
2045
2046 void LidInterrupt() {
2047         cdr.LidCheck = 0x20; // start checker
2048
2049         CDRLID_INT( cdReadTime * 3 );
2050         
2051         // generate interrupt if none active - open or close
2052         if (cdr.Irq == 0 || cdr.Irq == 0xff) {
2053                 cdr.Ctrl |= 0x80;
2054                 cdr.Stat = NoIntr;
2055                 AddIrqQueue(CdlNop, 0x800);
2056         }
2057 }