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 static u8 fake_subq_local[3], fake_subq_real[3], fake_subq_index, fake_subq_change;
 433 static void Create_Fake_Subq()
 434 {
 435         u8 temp_cur[3], temp_next[3], temp_start[3], pregap;
 436         int diff;
 437
 438         if (CDR_getTN(cdr.ResultTN) == -1) return;
 439         if( cdr.CurTrack+1 <= cdr.ResultTN[1] ) {
 440                 pregap = 150;
 441                 if( CDR_getTD(cdr.CurTrack+1, cdr.ResultTD) == -1 ) return;
 442         } else {
 443                 // last track - cd size
 444                 pregap = 0;
 445                 if( CDR_getTD(0, cdr.ResultTD) == -1 ) return;
 446         }
 447
 448         if( cdr.Play == TRUE ) {
 449                 temp_cur[0] = cdr.SetSectorPlay[0];
 450                 temp_cur[1] = cdr.SetSectorPlay[1];
 451                 temp_cur[2] = cdr.SetSectorPlay[2];
 452         } else {
 453                 temp_cur[0] = btoi( cdr.Prev[0] );
 454                 temp_cur[1] = btoi( cdr.Prev[1] );
 455                 temp_cur[2] = btoi( cdr.Prev[2] );
 456         }
 457
 458         fake_subq_real[0] = temp_cur[0];
 459         fake_subq_real[1] = temp_cur[1];
 460         fake_subq_real[2] = temp_cur[2];
 461
 462         temp_next[0] = cdr.ResultTD[2];
 463         temp_next[1] = cdr.ResultTD[1];
 464         temp_next[2] = cdr.ResultTD[0];
 465
 466
 467         // flag- next track
 468         if( msf2sec(temp_cur) >= msf2sec( temp_next )-pregap ) {
 469                 fake_subq_change = 1;
 470
 471                 cdr.CurTrack++;
 472
 473                 // end cd
 474                 if( pregap == 0 ) StopCdda();
 475         }
 476
 477         //////////////////////////////////////////////////
 478         //////////////////////////////////////////////////
 479
 480         // repair
 481         if( cdr.CurTrack <= cdr.ResultTN[1] ) {
 482                 if( CDR_getTD(cdr.CurTrack, cdr.ResultTD) == -1 ) return;
 483         } else {
 484                 // last track - cd size
 485                 if( CDR_getTD(0, cdr.ResultTD) == -1 ) return;
 486         }
 487
 488         temp_start[0] = cdr.ResultTD[2];
 489         temp_start[1] = cdr.ResultTD[1];
 490         temp_start[2] = cdr.ResultTD[0];
 491
 492
 493         CDR_LOG( "CDDA FAKE SUB - %d:%d:%d / %d:%d:%d / %d:%d:%d\n",
 494                 temp_cur[0], temp_cur[1], temp_cur[2],
 495                 temp_start[0], temp_start[1], temp_start[2],
 496                 temp_next[0], temp_next[1], temp_next[2]);
 497
 498
 499
 500         // local time - pregap / real
 501         diff = msf2sec(temp_cur) - msf2sec( temp_start );
 502         if( diff < 0 ) {
 503                 fake_subq_index = 0;
 504
 505                 sec2msf( -diff, fake_subq_local );
 506         } else {
 507                 fake_subq_index = 1;
 508
 509                 sec2msf( diff, fake_subq_local );
 510         }
 511 }
 512
 513
 514 static void cdrPlayInterrupt_Autopause()
 515 {
 516         struct SubQ *subq = (struct SubQ *)CDR_getBufferSub();
 517         int track_changed = 0;
 518         if (subq != NULL ) {
 519                 /*
 520                 CDDA Autopause
 521
 522                 Silhouette Mirage ($3)
 523                 Tomb Raider 1 ($7)
 524                 */
 525
 526                 // .. + 1 is probably wrong, but deals with corrupted subq + good checksum
 527                 // (how does real thing handle those?)
 528                 if( cdr.CurTrack + 1 == btoi( subq->TrackNumber ) )
 529                         track_changed = 1;
 530         } else {
 531                 track_changed = fake_subq_change;
 532                 fake_subq_change = 0;
 533         }
 534
 535         if ((cdr.Mode & MODE_AUTOPAUSE) && track_changed) {
 536                 CDR_LOG( "CDDA STOP\n" );
 537
 538                 // Magic the Gathering
 539                 // - looping territory cdda
 540
 541                 // ...?
 542                 //cdr.ResultReady = 1;
 543                 //cdr.Stat = DataReady;
 544                 cdr.Stat = DataEnd;
 545                 setIrq();
 546
 547                 StopCdda();
 548         }
 549         else if (cdr.Mode & MODE_REPORT) {
 550                 if (subq != NULL) {
 551                         CDR_LOG( "REPPLAY SUB - %X:%X:%X\n",
 552                                 subq->AbsoluteAddress[0], subq->AbsoluteAddress[1], subq->AbsoluteAddress[2] );
 553
 554                         // breaks when .sub doesn't have index 0 for some reason (bad rip?)
 555                         //cdr.CurTrack = btoi( subq->TrackNumber );
 556
 557                         if (subq->AbsoluteAddress[2] & 0xf)
 558                                 return;
 559
 560                         cdr.Result[0] = cdr.StatP;
 561                         // BIOS CD Player: data already BCD format
 562                         cdr.Result[1] = subq->TrackNumber;
 563                         cdr.Result[2] = subq->IndexNumber;
 564
 565                         cdr.Result[3] = subq->AbsoluteAddress[0];
 566                         cdr.Result[4] = subq->AbsoluteAddress[1];
 567                         cdr.Result[5] = subq->AbsoluteAddress[2];
 568                 } else {
 569                         CDR_LOG( "REPPLAY FAKE - %d:%d:%d\n",
 570                                 fake_subq_real[0], fake_subq_real[1], fake_subq_real[2] );
 571
 572                         if (fake_subq_real[2] & 0xf)
 573                                 return;
 574
 575                         cdr.Result[0] = cdr.StatP;
 576                         // track # / index #
 577                         cdr.Result[1] = itob(cdr.CurTrack);
 578                         cdr.Result[2] = itob(fake_subq_index);
 579                         // absolute
 580                         cdr.Result[3] = itob( fake_subq_real[0] );
 581                         cdr.Result[4] = itob( fake_subq_real[1] );
 582                         cdr.Result[5] = itob( fake_subq_real[2] );
 583                 }
 584
 585                 // Rayman: Logo freeze (resultready + dataready)
 586                 cdr.ResultReady = 1;
 587                 cdr.Stat = DataReady;
 588
 589                 SetResultSize(8);
 590                 setIrq();
 591         }
 592 }
 593
 594 // also handles seek
 595 void cdrPlayInterrupt()
 596 {
 597         if (cdr.Seeked == SEEK_PENDING) {
 598                 if (cdr.Stat) {
 599                         CDR_LOG_I("cdrom: seek stat hack\n");
 600                         CDRMISC_INT(0x1000);
 601                         return;
 602                 }
 603                 SetResultSize(1);
 604                 cdr.StatP |= STATUS_ROTATING;
 605                 cdr.StatP &= ~STATUS_SEEK;
 606                 cdr.Result[0] = cdr.StatP;
 607                 cdr.Seeked = SEEK_DONE;
 608                 if (cdr.Irq == 0) {
 609                         cdr.Stat = Complete;
 610                         setIrq();
 611                 }
 612
 613                 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
 614                 Find_CurTrack();
 615                 ReadTrack(cdr.SetSectorPlay);
 616         }
 617
 618         // update for CdlGetlocP/autopause
 619         struct SubQ *subq = (struct SubQ *)CDR_getBufferSub();
 620         if (subq != NULL)
 621                 // update subq
 622                 ReadTrack(cdr.SetSectorPlay);
 623         else
 624                 Create_Fake_Subq();
 625
 626         if (!cdr.Play) return;
 627
 628         CDR_LOG( "CDDA - %d:%d:%d\n",
 629                 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
 630
 631         CDRMISC_INT( cdReadTime );
 632
 633         if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
 634                 cdrPlayInterrupt_Autopause();
 635
 636         cdr.SetSectorPlay[2]++;
 637         if (cdr.SetSectorPlay[2] == 75) {
 638                 cdr.SetSectorPlay[2] = 0;
 639                 cdr.SetSectorPlay[1]++;
 640                 if (cdr.SetSectorPlay[1] == 60) {
 641                         cdr.SetSectorPlay[1] = 0;
 642                         cdr.SetSectorPlay[0]++;
 643                 }
 644         }
 645
 646         //Check_Shell(0);
 647 }
 648
 649 void cdrInterrupt() {
 650         int i;
 651         unsigned char Irq = cdr.Irq;
 652         struct SubQ *subq;
 653
 654         // Reschedule IRQ
 655         if (cdr.Stat) {
 656                 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
 657                 CDR_INT(0x1000);
 658                 return;
 659         }
 660
 661         cdr.Irq = 0;
 662         cdr.Ctrl &= ~0x80;
 663
 664         switch (Irq) {
 665                 case CdlSync:
 666                         SetResultSize(1);
 667                         cdr.StatP |= STATUS_ROTATING;
 668                         cdr.Result[0] = cdr.StatP;
 669                         cdr.Stat = Acknowledge;
 670                         break;
 671
 672                 case CdlNop:
 673                         SetResultSize(1);
 674                         cdr.Result[0] = cdr.StatP;
 675                         cdr.Stat = Acknowledge;
 676
 677                         if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
 678                         break;
 679
 680                 case CdlSetloc:
 681                         cdr.CmdProcess = 0;
 682                         SetResultSize(1);
 683                         cdr.StatP |= STATUS_ROTATING;
 684                         cdr.Result[0] = cdr.StatP;
 685                         cdr.Stat = Acknowledge;
 686                         break;
 687
 688                 case CdlPlay:
 689                         fake_subq_change = 0;
 690
 691                         if (cdr.Seeked == SEEK_PENDING) {
 692                                 // XXX: wrong, should seek instead..
 693                                 memcpy( cdr.SetSectorPlay, cdr.SetSector, 4 );
 694                                 cdr.Seeked = SEEK_DONE;
 695                         }
 696
 697                         // BIOS CD Player
 698                         // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
 699
 700                         if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
 701                                 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
 702                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
 703                         }
 704                         else
 705                         {
 706                                 int track = btoi( cdr.Param[0] );
 707
 708                                 if (track <= cdr.ResultTN[1])
 709                                         cdr.CurTrack = track;
 710
 711                                 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
 712
 713                                 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
 714                                         cdr.SetSectorPlay[0] = cdr.ResultTD[2];
 715                                         cdr.SetSectorPlay[1] = cdr.ResultTD[1];
 716                                         cdr.SetSectorPlay[2] = cdr.ResultTD[0];
 717                                 }
 718                         }
 719
 720                         /*
 721                         Rayman: detect track changes
 722                         - fixes logo freeze
 723
 724                         Twisted Metal 2: skip PREGAP + starting accurate SubQ
 725                         - plays tracks without retry play
 726
 727                         Wild 9: skip PREGAP + starting accurate SubQ
 728                         - plays tracks without retry play
 729                         */
 730                         Find_CurTrack();
 731                         ReadTrack(cdr.SetSectorPlay);
 732
 733                         if (!Config.Cdda)
 734                                 CDR_play(cdr.SetSectorPlay);
 735
 736                         // Vib Ribbon: gameplay checks flag
 737                         cdr.StatP &= ~STATUS_SEEK;
 738
 739                         cdr.CmdProcess = 0;
 740                         SetResultSize(1);
 741                         cdr.StatP |= STATUS_ROTATING;
 742                         cdr.Result[0] = cdr.StatP;
 743                         cdr.Stat = Acknowledge;
 744
 745                         cdr.StatP |= STATUS_PLAY;
 746
 747
 748                         // BIOS player - set flag again
 749                         cdr.Play = TRUE;
 750
 751                         CDRMISC_INT( cdReadTime );
 752                         break;
 753
 754                 case CdlForward:
 755                         cdr.CmdProcess = 0;
 756                         SetResultSize(1);
 757                         cdr.StatP |= STATUS_ROTATING;
 758                         cdr.Result[0] = cdr.StatP;
 759                         cdr.Stat = Complete;
 760
 761
 762                         // GameShark CD Player: Calls 2x + Play 2x
 763                         if( cdr.FastForward == 0 ) cdr.FastForward = 2;
 764                         else cdr.FastForward++;
 765
 766                         cdr.FastBackward = 0;
 767                         break;
 768
 769                 case CdlBackward:
 770                         cdr.CmdProcess = 0;
 771                         SetResultSize(1);
 772                         cdr.StatP |= STATUS_ROTATING;
 773                         cdr.Result[0] = cdr.StatP;
 774                         cdr.Stat = Complete;
 775
 776
 777                         // GameShark CD Player: Calls 2x + Play 2x
 778                         if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
 779                         else cdr.FastBackward++;
 780
 781                         cdr.FastForward = 0;
 782                         break;
 783
 784                 case CdlStandby:
 785                         cdr.CmdProcess = 0;
 786                         SetResultSize(1);
 787                         cdr.StatP |= STATUS_ROTATING;
 788                         cdr.Result[0] = cdr.StatP;
 789                         cdr.Stat = Complete;
 790                         break;
 791
 792                 case CdlStop:
 793                         cdr.CmdProcess = 0;
 794                         SetResultSize(1);
 795                         cdr.StatP &= ~STATUS_ROTATING;
 796                         cdr.Result[0] = cdr.StatP;
 797                         cdr.Stat = Complete;
 798 //                      cdr.Stat = Acknowledge;
 799
 800                         if (cdr.LidCheck == 0) cdr.LidCheck = 0x20;
 801                         break;
 802
 803                 case CdlPause:
 804                         SetResultSize(1);
 805                         cdr.Result[0] = cdr.StatP;
 806                         cdr.Stat = Acknowledge;
 807
 808                         /*
 809                         Gundam Battle Assault 2: much slower (*)
 810                         - Fixes boot, gameplay
 811
 812                         Hokuto no Ken 2: slower
 813                         - Fixes intro + subtitles
 814
 815                         InuYasha - Feudal Fairy Tale: slower
 816                         - Fixes battles
 817                         */
 818                         AddIrqQueue(CdlPause + 0x20, cdReadTime * 3);
 819                         cdr.Ctrl |= 0x80;
 820                         break;
 821
 822                 case CdlPause + 0x20:
 823                         SetResultSize(1);
 824                         cdr.StatP &= ~STATUS_READ;
 825                         cdr.StatP |= STATUS_ROTATING;
 826                         cdr.Result[0] = cdr.StatP;
 827                         cdr.Stat = Complete;
 828                         break;
 829
 830                 case CdlInit:
 831                         SetResultSize(1);
 832                         cdr.StatP = STATUS_ROTATING;
 833                         cdr.Result[0] = cdr.StatP;
 834                         cdr.Stat = Acknowledge;
 835 //                      if (!cdr.Init) {
 836                                 AddIrqQueue(CdlInit + 0x20, 0x800);
 837 //                      }
 838                 break;
 839
 840                 case CdlInit + 0x20:
 841                         SetResultSize(1);
 842                         cdr.Result[0] = cdr.StatP;
 843                         cdr.Stat = Complete;
 844                         cdr.Init = 1;
 845                         break;
 846
 847                 case CdlMute:
 848                         SetResultSize(1);
 849                         cdr.StatP |= STATUS_ROTATING;
 850                         cdr.Result[0] = cdr.StatP;
 851                         cdr.Stat = Acknowledge;
 852                         break;
 853
 854                 case CdlDemute:
 855                         SetResultSize(1);
 856                         cdr.StatP |= STATUS_ROTATING;
 857                         cdr.Result[0] = cdr.StatP;
 858                         cdr.Stat = Acknowledge;
 859                         break;
 860
 861                 case CdlSetfilter:
 862                         SetResultSize(1);
 863                         cdr.StatP |= STATUS_ROTATING;
 864                         cdr.Result[0] = cdr.StatP;
 865                         cdr.Stat = Acknowledge;
 866                         break;
 867
 868                 case CdlSetmode:
 869                         SetResultSize(1);
 870                         cdr.StatP |= STATUS_ROTATING;
 871                         cdr.Result[0] = cdr.StatP;
 872                         cdr.Stat = Acknowledge;
 873                         break;
 874
 875                 case CdlGetmode:
 876                         SetResultSize(6);
 877                         cdr.StatP |= STATUS_ROTATING;
 878                         cdr.Result[0] = cdr.StatP;
 879                         cdr.Result[1] = cdr.Mode;
 880                         cdr.Result[2] = cdr.File;
 881                         cdr.Result[3] = cdr.Channel;
 882                         cdr.Result[4] = 0;
 883                         cdr.Result[5] = 0;
 884                         cdr.Stat = Acknowledge;
 885                         break;
 886
 887                 case CdlGetlocL:
 888                         SetResultSize(8);
 889                         for (i = 0; i < 8; i++)
 890                                 cdr.Result[i] = cdr.Transfer[i];
 891                         cdr.Stat = Acknowledge;
 892                         break;
 893
 894                 case CdlGetlocP:
 895                         // GameShark CDX CD Player: uses 17 bytes output (wraps around)
 896                         SetResultSize(17);
 897                         memset( cdr.Result, 0, 16 );
 898
 899                         subq = (struct SubQ *)CDR_getBufferSub();
 900
 901                         if (subq != NULL) {
 902                                 // update subq
 903                                 ReadTrack( cdr.SetSector );
 904
 905                                 cdr.Result[0] = subq->TrackNumber;
 906                                 cdr.Result[1] = subq->IndexNumber;
 907                                 memcpy(cdr.Result + 2, subq->TrackRelativeAddress, 3);
 908                                 memcpy(cdr.Result + 5, subq->AbsoluteAddress, 3);
 909
 910
 911                                 // subQ integrity check - data only (skip audio)
 912                                 if( subq->TrackNumber == 1 && stat.Type == 0x01 ) {
 913                                 if (calcCrc((u8 *)subq + 12, 10) != (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
 914                                         memset(cdr.Result + 2, 0, 3 + 3); // CRC wrong, wipe out time data
 915                                 }
 916                                 }
 917                         } else {
 918                                 if (cdr.Play == FALSE)
 919                                         Create_Fake_Subq();
 920
 921                                 // track # / index #
 922                                 cdr.Result[0] = itob(cdr.CurTrack);
 923                                 cdr.Result[1] = itob(fake_subq_index);
 924
 925                                 // local
 926                                 cdr.Result[2] = itob( fake_subq_local[0] );
 927                                 cdr.Result[3] = itob( fake_subq_local[1] );
 928                                 cdr.Result[4] = itob( fake_subq_local[2] );
 929
 930                                 // absolute
 931                                 cdr.Result[5] = itob( fake_subq_real[0] );
 932                                 cdr.Result[6] = itob( fake_subq_real[1] );
 933                                 cdr.Result[7] = itob( fake_subq_real[2] );
 934                         }
 935
 936                         if (!cdr.Play && !cdr.Reading)
 937                                 cdr.Result[1] = 0; // HACK?
 938
 939                         // redump.org - wipe time
 940                         if( !cdr.Play && CheckSBI(cdr.Result+5) ) {
 941                                 memset( cdr.Result+2, 0, 6 );
 942                         }
 943
 944                         cdr.Stat = Acknowledge;
 945                         break;
 946
 947                 case CdlGetTN:
 948                         // 5-Star Racing: don't stop CDDA
 949                         //
 950                         // Vib Ribbon: CD swap
 951                         StopReading();
 952
 953                         cdr.CmdProcess = 0;
 954                         SetResultSize(3);
 955                         cdr.StatP |= STATUS_ROTATING;
 956                         cdr.Result[0] = cdr.StatP;
 957                         if (CDR_getTN(cdr.ResultTN) == -1) {
 958                                 cdr.Stat = DiskError;
 959                                 cdr.Result[0] |= STATUS_ERROR;
 960                         } else {
 961                                 cdr.Stat = Acknowledge;
 962                                 cdr.Result[1] = itob(cdr.ResultTN[0]);
 963                                 cdr.Result[2] = itob(cdr.ResultTN[1]);
 964                         }
 965                         break;
 966
 967                 case CdlGetTD:
 968                         cdr.CmdProcess = 0;
 969                         cdr.Track = btoi(cdr.Param[0]);
 970                         SetResultSize(4);
 971                         cdr.StatP |= STATUS_ROTATING;
 972                         if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
 973                                 cdr.Stat = DiskError;
 974                                 cdr.Result[0] |= STATUS_ERROR;
 975                         } else {
 976                                 cdr.Stat = Acknowledge;
 977                                 cdr.Result[0] = cdr.StatP;
 978                                 cdr.Result[1] = itob(cdr.ResultTD[2]);
 979                                 cdr.Result[2] = itob(cdr.ResultTD[1]);
 980                                 cdr.Result[3] = itob(cdr.ResultTD[0]);
 981                         }
 982                         break;
 983
 984                 case CdlSeekL:
 985                 case CdlSeekP:
 986                         SetResultSize(1);
 987                         cdr.StatP |= STATUS_ROTATING;
 988                         cdr.Result[0] = cdr.StatP;
 989                         cdr.StatP |= STATUS_SEEK;
 990                         cdr.Stat = Acknowledge;
 991
 992                         /*
 993                         Crusaders of Might and Magic = 0.5x-4x
 994                         - fix cutscene speech start
 995
 996                         Eggs of Steel = 2x-?
 997                         - fix new game
 998
 999                         Medievil = ?-4x
1000                         - fix cutscene speech
1001
1002                         Rockman X5 = 0.5-4x
1003                         - fix capcom logo
1004                         */
1005                         CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
1006                         cdr.Seeked = SEEK_PENDING;
1007                         break;
1008
1009                 case CdlTest:
1010                         cdr.Stat = Acknowledge;
1011                         switch (cdr.Param[0]) {
1012                                 case 0x20: // System Controller ROM Version
1013                                         SetResultSize(4);
1014                                         memcpy(cdr.Result, Test20, 4);
1015                                         break;
1016                                 case 0x22:
1017                                         SetResultSize(8);
1018                                         memcpy(cdr.Result, Test22, 4);
1019                                         break;
1020                                 case 0x23: case 0x24:
1021                                         SetResultSize(8);
1022                                         memcpy(cdr.Result, Test23, 4);
1023                                         break;
1024                         }
1025                         break;
1026
1027                 case CdlID:
1028                         SetResultSize(1);
1029                         cdr.StatP |= STATUS_ROTATING;
1030                         cdr.Result[0] = cdr.StatP;
1031                         cdr.Stat = Acknowledge;
1032                         AddIrqQueue(CdlID + 0x20, 0x800);
1033                         break;
1034
1035                 case CdlID + 0x20:
1036                         SetResultSize(8);
1037
1038                         if (CDR_getStatus(&stat) == -1) {
1039                                 cdr.Result[0] = 0x00; // 0x08 and cdr.Result[1]|0x10 : audio cd, enters cd player
1040                                 cdr.Result[1] = 0x80; // 0x80 leads to the menu in the bios, else loads CD
1041                         }
1042                         else {
1043                                 if (stat.Type == 2) {
1044                                         // Music CD
1045                                         cdr.Result[0] = 0x08;
1046                                         cdr.Result[1] = 0x10;
1047
1048                                         cdr.Result[1] |= 0x80;
1049                                 }
1050                                 else {
1051                                         // Data CD
1052                                         if (CdromId[0] == '\0') {
1053                                                 cdr.Result[0] = 0x00;
1054                                                 cdr.Result[1] = 0x80;
1055                                         }
1056                                         else {
1057                                                 cdr.Result[0] = 0x08;
1058                                                 cdr.Result[1] = 0x00;
1059                                         }
1060                                 }
1061                         }
1062
1063                         cdr.Result[2] = 0x00;
1064                         cdr.Result[3] = 0x00;
1065                         strncpy((char *)&cdr.Result[4], "PCSX", 4);
1066                         cdr.Stat = Complete;
1067                         break;
1068
1069                 case CdlReset:
1070                         SetResultSize(1);
1071                         cdr.StatP = STATUS_ROTATING;
1072                         cdr.Result[0] = cdr.StatP;
1073                         cdr.Stat = Acknowledge;
1074                         break;
1075
1076                 case CdlReadT:
1077                         SetResultSize(1);
1078                         cdr.StatP |= STATUS_ROTATING;
1079                         cdr.Result[0] = cdr.StatP;
1080                         cdr.Stat = Acknowledge;
1081                         AddIrqQueue(CdlReadT + 0x20, 0x800);
1082                         break;
1083
1084                 case CdlReadT + 0x20:
1085                         SetResultSize(1);
1086                         cdr.StatP |= STATUS_ROTATING;
1087                         cdr.Result[0] = cdr.StatP;
1088                         cdr.Stat = Complete;
1089                         break;
1090
1091                 case CdlReadToc:
1092                         SetResultSize(1);
1093                         cdr.StatP |= STATUS_ROTATING;
1094                         cdr.Result[0] = cdr.StatP;
1095                         cdr.Stat = Acknowledge;
1096                         AddIrqQueue(CdlReadToc + 0x20, 0x800);
1097                         break;
1098
1099                 case CdlReadToc + 0x20:
1100                         SetResultSize(1);
1101                         cdr.StatP |= STATUS_ROTATING;
1102                         cdr.Result[0] = cdr.StatP;
1103                         cdr.Stat = Complete;
1104                         break;
1105
1106                 case CdlReadN:
1107                 case CdlReadS:
1108                         if (!cdr.Reading) return;
1109
1110
1111                         // Fighting Force 2 - update subq time immediately
1112                         // - fixes new game
1113                         ReadTrack( cdr.SetSector );
1114
1115
1116                         // Crusaders of Might and Magic - update getlocl now
1117                         // - fixes cutscene speech
1118                         {
1119                                 u8 *buf = CDR_getBuffer();
1120                                 if (buf != NULL)
1121                                         memcpy(cdr.Transfer, buf, 8);
1122                         }
1123
1124                         /*
1125                         Duke Nukem: Land of the Babes - seek then delay read for one frame
1126                         - fixes cutscenes
1127                         C-12 - Final Resistance - doesn't like seek
1128                         */
1129
1130                         if (cdr.Seeked != SEEK_DONE) {
1131                                 cdr.StatP |= STATUS_SEEK;
1132                                 cdr.StatP &= ~STATUS_READ;
1133
1134                                 // Crusaders of Might and Magic - use short time
1135                                 // - fix cutscene speech (startup)
1136
1137                                 // ??? - use more accurate seek time later
1138                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1139                         } else {
1140                                 cdr.StatP |= STATUS_READ;
1141                                 cdr.StatP &= ~STATUS_SEEK;
1142
1143                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1144                         }
1145
1146                         SetResultSize(1);
1147                         cdr.StatP |= STATUS_ROTATING;
1148                         cdr.Result[0] = cdr.StatP;
1149                         cdr.Stat = Acknowledge;
1150                         break;
1151
1152                 case 0xff:
1153                         return;
1154
1155                 default:
1156                         cdr.Stat = Complete;
1157                         break;
1158         }
1159
1160         Check_Shell( Irq );
1161
1162         cdr.ParamC = 0;
1163
1164         setIrq();
1165
1166 #ifdef CDR_LOG_CMD_IRQ
1167         SysPrintf("cdrInterrupt() Log: CDR Interrupt IRQ %d %02x: ",
1168                 cdr.Stat != NoIntr && cdr.Reg2 != 0x18, Irq);
1169         for (i = 0; i < cdr.ResultC; i++)
1170                 SysPrintf("%02x ", cdr.Result[i]);
1171         SysPrintf("\n");
1172 #endif
1173 }
1174
1175 void cdrReadInterrupt() {
1176         u8 *buf;
1177
1178         if (!cdr.Reading)
1179                 return;
1180
1181         if (cdr.Irq || cdr.Stat) {
1182                 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1183                 CDREAD_INT(0x1000);
1184                 return;
1185         }
1186
1187         cdr.OCUP = 1;
1188         SetResultSize(1);
1189         cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1190         cdr.StatP &= ~STATUS_SEEK;
1191         cdr.Result[0] = cdr.StatP;
1192         cdr.Seeked = SEEK_DONE;
1193
1194         ReadTrack( cdr.SetSector );
1195
1196         buf = CDR_getBuffer();
1197         if (buf == NULL)
1198                 cdr.RErr = -1;
1199
1200         if (cdr.RErr == -1) {
1201                 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1202                 memset(cdr.Transfer, 0, DATA_SIZE);
1203                 cdr.Stat = DiskError;
1204                 cdr.Result[0] |= STATUS_ERROR;
1205                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1206                 return;
1207         }
1208
1209         memcpy(cdr.Transfer, buf, DATA_SIZE);
1210         CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1211
1212
1213         CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1214
1215         if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1216                 // Firemen 2: Multi-XA files - briefings, cutscenes
1217                 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1218                         cdr.File = cdr.Transfer[4 + 0];
1219                         cdr.Channel = cdr.Transfer[4 + 1];
1220                 }
1221
1222                 if ((cdr.Transfer[4 + 2] & 0x4) &&
1223                          (cdr.Transfer[4 + 1] == cdr.Channel) &&
1224                         (cdr.Transfer[4 + 0] == cdr.File)) {
1225                         int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1226
1227                         if (!ret) {
1228                                 // only handle attenuator basic channel switch for now
1229                                 if (cdr.Xa.stereo) {
1230                                         int i;
1231                                         if ((cdr.AttenuatorLeft[0] | cdr.AttenuatorLeft[1])
1232                                             && !(cdr.AttenuatorRight[0] | cdr.AttenuatorRight[1]))
1233                                         {
1234                                                 for (i = 0; i < cdr.Xa.nsamples; i++)
1235                                                         cdr.Xa.pcm[i*2 + 1] = cdr.Xa.pcm[i*2];
1236                                         }
1237                                         else if (!(cdr.AttenuatorLeft[0] | cdr.AttenuatorLeft[1])
1238                                             && (cdr.AttenuatorRight[0] | cdr.AttenuatorRight[1]))
1239                                         {
1240                                                 for (i = 0; i < cdr.Xa.nsamples; i++)
1241                                                         cdr.Xa.pcm[i*2] = cdr.Xa.pcm[i*2 + 1];
1242                                         }
1243                                 }
1244
1245                                 SPU_playADPCMchannel(&cdr.Xa);
1246                                 cdr.FirstSector = 0;
1247
1248 #if 0
1249                                 // Crash Team Racing: music, speech
1250                                 // - done using cdda decoded buffer (spu irq)
1251                                 // - don't do here
1252
1253                                 // signal ADPCM data ready
1254                                 setIrq();
1255 #endif
1256                         }
1257                         else cdr.FirstSector = -1;
1258                 }
1259         }
1260
1261         cdr.SetSector[2]++;
1262         if (cdr.SetSector[2] == 75) {
1263                 cdr.SetSector[2] = 0;
1264                 cdr.SetSector[1]++;
1265                 if (cdr.SetSector[1] == 60) {
1266                         cdr.SetSector[1] = 0;
1267                         cdr.SetSector[0]++;
1268                 }
1269         }
1270
1271         cdr.Readed = 0;
1272
1273         CDREAD_INT((cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime);
1274
1275         /*
1276         Croc 2: $40 - only FORM1 (*)
1277         Judge Dredd: $C8 - only FORM1 (*)
1278         Sim Theme Park - no adpcm at all (zero)
1279         */
1280
1281         if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
1282                 cdr.Stat = DataReady;
1283                 setIrq();
1284         }
1285
1286         Check_Shell(0);
1287 }
1288
1289 /*
1290 cdrRead0:
1291         bit 0,1 - mode
1292         bit 2 - unknown
1293         bit 3 - unknown
1294         bit 4 - unknown
1295         bit 5 - 1 result ready
1296         bit 6 - 1 dma ready
1297         bit 7 - 1 command being processed
1298 */
1299
1300 unsigned char cdrRead0(void) {
1301         if (cdr.ResultReady)
1302                 cdr.Ctrl |= 0x20;
1303         else
1304                 cdr.Ctrl &= ~0x20;
1305
1306         if (cdr.OCUP)
1307                 cdr.Ctrl |= 0x40;
1308 //  else
1309 //              cdr.Ctrl &= ~0x40;
1310
1311         // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1312         cdr.Ctrl |= 0x18;
1313
1314         CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1315
1316         return psxHu8(0x1800) = cdr.Ctrl;
1317 }
1318
1319 void cdrWrite0(unsigned char rt) {
1320         CDR_LOG_IO("cdr w0: %02x\n", rt);
1321
1322         cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1323 }
1324
1325 unsigned char cdrRead1(void) {
1326         if ((cdr.ResultP & 0xf) < cdr.ResultC)
1327                 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1328         else
1329                 psxHu8(0x1801) = 0;
1330         cdr.ResultP++;
1331         if (cdr.ResultP == cdr.ResultC)
1332                 cdr.ResultReady = 0;
1333
1334         CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1335
1336         return psxHu8(0x1801);
1337 }
1338
1339 void cdrWrite1(unsigned char rt) {
1340         u8 set_loc[3];
1341         int i;
1342
1343         CDR_LOG_IO("cdr w1: %02x\n", rt);
1344
1345         switch (cdr.Ctrl & 3) {
1346         case 0:
1347                 break;
1348         case 3:
1349                 cdr.AttenuatorRight[1] = rt;
1350                 return;
1351         default:
1352                 return;
1353         }
1354
1355         cdr.Cmd = rt;
1356         cdr.OCUP = 0;
1357
1358 #ifdef CDR_LOG_CMD_IRQ
1359         SysPrintf("cdrWrite1() Log: CD1 write: %x (%s)", rt, CmdName[rt]);
1360         if (cdr.ParamC) {
1361                 SysPrintf(" Param[%d] = {", cdr.ParamC);
1362                 for (i = 0; i < cdr.ParamC; i++)
1363                         SysPrintf(" %x,", cdr.Param[i]);
1364                 SysPrintf("}\n");
1365         } else {
1366                 SysPrintf("\n");
1367         }
1368 #endif
1369
1370         cdr.ResultReady = 0;
1371         cdr.Ctrl |= 0x80;
1372         // cdr.Stat = NoIntr;
1373         AddIrqQueue(cdr.Cmd, 0x800);
1374
1375         switch (cdr.Cmd) {
1376         case CdlSync:
1377         case CdlNop:
1378         case CdlForward:
1379         case CdlBackward:
1380         case CdlReadT:
1381         case CdlTest:
1382         case CdlID:
1383         case CdlReadToc:
1384         case CdlGetmode:
1385         case CdlGetlocL:
1386         case CdlGetlocP:
1387         case CdlGetTD:
1388                 break;
1389
1390         case CdlSetloc:
1391                 StopReading();
1392                 for (i = 0; i < 3; i++)
1393                         set_loc[i] = btoi(cdr.Param[i]);
1394
1395                 // FIXME: clean up this SetSector/SetSectorPlay mess,
1396                 // there should be single var tracking current sector pos
1397                 if (cdr.Play)
1398                         i = msf2sec(cdr.SetSectorPlay);
1399                 else
1400                         i = msf2sec(cdr.SetSector);
1401                 i = abs(i - msf2sec(set_loc));
1402                 if (i > 16)
1403                         cdr.Seeked = SEEK_PENDING;
1404
1405                 memcpy(cdr.SetSector, set_loc, 3);
1406                 cdr.SetSector[3] = 0;
1407                 break;
1408
1409         case CdlPlay:
1410                 // Vib Ribbon: try same track again
1411                 StopCdda();
1412
1413 #if 0
1414                 if (!cdr.SetSector[0] & !cdr.SetSector[1] & !cdr.SetSector[2]) {
1415                         if (CDR_getTN(cdr.ResultTN) != -1) {
1416                                 if (cdr.CurTrack > cdr.ResultTN[1])
1417                                         cdr.CurTrack = cdr.ResultTN[1];
1418                                 if (CDR_getTD((unsigned char)(cdr.CurTrack), cdr.ResultTD) != -1) {
1419                                         int tmp = cdr.ResultTD[2];
1420                                         cdr.ResultTD[2] = cdr.ResultTD[0];
1421                                         cdr.ResultTD[0] = tmp;
1422                                         if (!Config.Cdda) CDR_play(cdr.ResultTD);
1423                                 }
1424                         }
1425                 }
1426 #endif
1427                 // Vib Ribbon - decoded buffer IRQ for CDDA reading
1428                 // - fixes ribbon timing + music CD mode
1429                 //TODO?
1430                 //CDRDBUF_INT( PSXCLK / 44100 * 0x100 );
1431
1432                 cdr.Play = TRUE;
1433
1434                 cdr.StatP |= STATUS_SEEK;
1435                 cdr.StatP &= ~STATUS_ROTATING;
1436                 break;
1437
1438         case CdlReadN:
1439                 StopReading();
1440                 cdr.Reading = 1;
1441                 cdr.FirstSector = 1;
1442                 cdr.Readed = 0xff;
1443                 break;
1444
1445         case CdlStandby:
1446                 StopCdda();
1447                 StopReading();
1448                 break;
1449
1450         case CdlStop:
1451                 // GameShark CD Player: Reset CDDA to track start
1452                 if (cdr.Play) {
1453                         Find_CurTrack();
1454
1455                         // grab time for current track
1456                         CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
1457
1458                         cdr.SetSectorPlay[0] = cdr.ResultTD[2];
1459                         cdr.SetSectorPlay[1] = cdr.ResultTD[1];
1460                         cdr.SetSectorPlay[2] = cdr.ResultTD[0];
1461                 }
1462
1463                 StopCdda();
1464                 StopReading();
1465                 break;
1466
1467         case CdlPause:
1468                 /*
1469                    GameShark CD Player: save time for resume
1470
1471                    Twisted Metal - World Tour: don't mix Setloc / CdlPlay cursors
1472                 */
1473
1474                 StopCdda();
1475                 StopReading();
1476                 break;
1477
1478         case CdlReset:
1479         case CdlInit:
1480                 cdr.Seeked = SEEK_DONE;
1481                 StopCdda();
1482                 StopReading();
1483                 break;
1484
1485         case CdlMute:
1486                 cdr.Muted = TRUE;
1487                         // Duke Nukem - Time to Kill
1488                         // - do not directly set cd-xa volume
1489                         //SPU_writeRegister( H_CDLeft, 0x0000 );
1490                         //SPU_writeRegister( H_CDRight, 0x0000 );
1491                 break;
1492
1493         case CdlDemute:
1494                 cdr.Muted = FALSE;
1495
1496                         // Duke Nukem - Time to Kill
1497                         // - do not directly set cd-xa volume
1498                         //SPU_writeRegister( H_CDLeft, 0x7f00 );
1499                         //SPU_writeRegister( H_CDRight, 0x7f00 );
1500                 break;
1501
1502         case CdlSetfilter:
1503                 cdr.File = cdr.Param[0];
1504                 cdr.Channel = cdr.Param[1];
1505                 break;
1506
1507         case CdlSetmode:
1508                 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1509
1510                 cdr.Mode = cdr.Param[0];
1511
1512                 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1513                 // - fixes choppy movie sound
1514                 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1515                         StopCdda();
1516                 break;
1517
1518         case CdlGetTN:
1519                 //AddIrqQueue(cdr.Cmd, 0x800);
1520
1521                 // GameShark CDX CD Player: very long time
1522                 AddIrqQueue(cdr.Cmd, 0x100000);
1523                 break;
1524
1525         case CdlSeekL:
1526         case CdlSeekP:
1527                 // Tomb Raider 2 - reset cdda
1528                 StopCdda();
1529                 StopReading();
1530                 break;
1531
1532         case CdlReadS:
1533                 StopReading();
1534                 cdr.Reading = 2;
1535                 cdr.FirstSector = 1;
1536                 cdr.Readed = 0xff;
1537                 break;
1538
1539         default:
1540                 cdr.ParamC = 0;
1541                 CDR_LOG_I("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
1542                 return;
1543         }
1544 }
1545
1546 unsigned char cdrRead2(void) {
1547         unsigned char ret;
1548
1549         if (cdr.Readed == 0) {
1550                 ret = 0;
1551         } else {
1552                 ret = *pTransfer++;
1553         }
1554
1555         CDR_LOG_IO("cdr r2: %02x\n", ret);
1556         return ret;
1557 }
1558
1559 void cdrWrite2(unsigned char rt) {
1560         CDR_LOG_IO("cdr w2: %02x\n", rt);
1561
1562         switch (cdr.Ctrl & 3) {
1563         case 0:
1564                 if (cdr.ParamC < 8) // FIXME: size and wrapping
1565                         cdr.Param[cdr.ParamC++] = rt;
1566                 return;
1567         case 1:
1568                 cdr.Reg2 = rt;
1569                 setIrq();
1570                 return;
1571         case 2:
1572                 cdr.AttenuatorLeft[0] = rt;
1573                 return;
1574         case 3:
1575                 cdr.AttenuatorRight[0] = rt;
1576                 return;
1577         }
1578 }
1579
1580 unsigned char cdrRead3(void) {
1581         if (cdr.Ctrl & 0x1)
1582                 psxHu8(0x1803) = cdr.Stat | 0xE0;
1583         else
1584                 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1585
1586         CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1587         return psxHu8(0x1803);
1588 }
1589
1590 void cdrWrite3(unsigned char rt) {
1591         CDR_LOG_IO("cdr w3: %02x\n", rt);
1592
1593         switch (cdr.Ctrl & 3) {
1594         case 0:
1595                 break; // transfer
1596         case 1:
1597                 cdr.Stat &= ~rt;
1598
1599                 if (rt & 0x40)
1600                         cdr.ParamC = 0;
1601                 return;
1602         case 2:
1603                 cdr.AttenuatorLeft[1] = rt;
1604                 return;
1605         case 3:
1606                 if (rt == 0x20)
1607                 CDR_LOG( "CD-XA Volume: %X %X | %X %X\n",
1608                         cdr.AttenuatorLeft[0], cdr.AttenuatorLeft[1],
1609                         cdr.AttenuatorRight[0], cdr.AttenuatorRight[1] );
1610                 return;
1611         }
1612
1613         if ((rt & 0x80) && cdr.Readed == 0) {
1614                 cdr.Readed = 1;
1615                 pTransfer = cdr.Transfer;
1616
1617                 switch (cdr.Mode & 0x30) {
1618                         case MODE_SIZE_2328:
1619                         case 0x00:
1620                                 pTransfer += 12;
1621                                 break;
1622
1623                         case MODE_SIZE_2340:
1624                                 pTransfer += 0;
1625                                 break;
1626
1627                         default:
1628                                 break;
1629                 }
1630         }
1631 }
1632
1633 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1634         u32 cdsize;
1635         int size;
1636         u8 *ptr;
1637
1638         CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1639
1640         switch (chcr) {
1641                 case 0x11000000:
1642                 case 0x11400100:
1643                         if (cdr.Readed == 0) {
1644                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1645                                 break;
1646                         }
1647
1648                         cdsize = (bcr & 0xffff) * 4;
1649
1650                         // Ape Escape: bcr = 0001 / 0000
1651                         // - fix boot
1652                         if( cdsize == 0 )
1653                         {
1654                                 switch (cdr.Mode & 0x30) {
1655                                         case 0x00: cdsize = 2048; break;
1656                                         case MODE_SIZE_2328: cdsize = 2328; break;
1657                                         case MODE_SIZE_2340: cdsize = 2340; break;
1658                                 }
1659                         }
1660
1661
1662                         ptr = (u8 *)PSXM(madr);
1663                         if (ptr == NULL) {
1664                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1665                                 break;
1666                         }
1667
1668                         /*
1669                         GS CDX: Enhancement CD crash
1670                         - Setloc 0:0:0
1671                         - CdlPlay
1672                         - Spams DMA3 and gets buffer overrun
1673                         */
1674                         size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1675                         if (size > cdsize)
1676                                 size = cdsize;
1677                         if (size > 0)
1678                         {
1679                                 memcpy(ptr, pTransfer, size);
1680                         }
1681
1682                         psxCpu->Clear(madr, cdsize / 4);
1683                         pTransfer += cdsize;
1684
1685
1686                         // burst vs normal
1687                         if( chcr == 0x11400100 ) {
1688                                 CDRDMA_INT( (cdsize/4) / 4 );
1689                         }
1690                         else if( chcr == 0x11000000 ) {
1691                                 CDRDMA_INT( (cdsize/4) * 1 );
1692                         }
1693                         return;
1694
1695                 default:
1696                         CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1697                         break;
1698         }
1699
1700         HW_DMA3_CHCR &= SWAP32(~0x01000000);
1701         DMA_INTERRUPT(3);
1702 }
1703
1704 void cdrDmaInterrupt()
1705 {
1706         if (HW_DMA3_CHCR & SWAP32(0x01000000))
1707         {
1708                 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1709                 DMA_INTERRUPT(3);
1710         }
1711 }
1712
1713 void cdrReset() {
1714         memset(&cdr, 0, sizeof(cdr));
1715         cdr.CurTrack = 1;
1716         cdr.File = 1;
1717         cdr.Channel = 1;
1718         pTransfer = cdr.Transfer;
1719
1720         // BIOS player - default values
1721         cdr.AttenuatorLeft[0] = 0x80;
1722         cdr.AttenuatorLeft[1] = 0x00;
1723         cdr.AttenuatorRight[0] = 0x00;
1724         cdr.AttenuatorRight[1] = 0x80;
1725 }
1726
1727 int cdrFreeze(void *f, int Mode) {
1728         u32 tmp;
1729
1730         if( Mode == 0 ) {
1731                 StopCdda();
1732         }
1733
1734         gzfreeze(&cdr, sizeof(cdr));
1735
1736         if (Mode == 1) {
1737                 cdr.ParamP = cdr.ParamC;
1738                 tmp = pTransfer - cdr.Transfer;
1739         }
1740
1741         gzfreeze(&tmp, sizeof(tmp));
1742
1743         if (Mode == 0) {
1744                 pTransfer = cdr.Transfer + tmp;
1745
1746                 if (cdr.Play && !Config.Cdda)
1747                         CDR_play(cdr.SetSectorPlay);
1748         }
1749
1750         return 0;
1751 }
1752
1753 void LidInterrupt() {
1754         cdr.LidCheck = 0x20; // start checker
1755
1756         CDRLID_INT( cdReadTime * 3 );
1757
1758         // generate interrupt if none active - open or close
1759         if (cdr.Irq == 0 || cdr.Irq == 0xff) {
1760                 cdr.Ctrl |= 0x80;
1761                 cdr.Stat = NoIntr;
1762                 AddIrqQueue(CdlNop, 0x800);
1763         }
1764 }