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