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