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