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