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 02110-1301 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 #include "arm_features.h"
  28
  29 /* logging */
  30 #if 0
  31 #define CDR_LOG SysPrintf
  32 #else
  33 #define CDR_LOG(...)
  34 #endif
  35 #if 0
  36 #define CDR_LOG_I SysPrintf
  37 #else
  38 #define CDR_LOG_I(...)
  39 #endif
  40 #if 0
  41 #define CDR_LOG_IO SysPrintf
  42 #else
  43 #define CDR_LOG_IO(...)
  44 #endif
  45 //#define CDR_LOG_CMD_IRQ
  46
  47 cdrStruct cdr;
  48 static unsigned char *pTransfer;
  49
  50 /* CD-ROM magic numbers */
  51 #define CdlSync        0  /* nocash documentation : "Uh, actually, returns error code 40h = Invalid Command...?" */
  52 #define CdlNop         1
  53 #define CdlSetloc      2
  54 #define CdlPlay        3
  55 #define CdlForward     4
  56 #define CdlBackward    5
  57 #define CdlReadN       6
  58 #define CdlStandby     7
  59 #define CdlStop        8
  60 #define CdlPause       9
  61 #define CdlReset       10
  62 #define CdlMute        11
  63 #define CdlDemute      12
  64 #define CdlSetfilter   13
  65 #define CdlSetmode     14
  66 #define CdlGetparam    15
  67 #define CdlGetlocL     16
  68 #define CdlGetlocP     17
  69 #define CdlReadT       18
  70 #define CdlGetTN       19
  71 #define CdlGetTD       20
  72 #define CdlSeekL       21
  73 #define CdlSeekP       22
  74 #define CdlSetclock    23
  75 #define CdlGetclock    24
  76 #define CdlTest        25
  77 #define CdlID          26
  78 #define CdlReadS       27
  79 #define CdlInit        28
  80 #define CdlGetQ        29
  81 #define CdlReadToc     30
  82
  83 char *CmdName[0x100]= {
  84     "CdlSync",     "CdlNop",       "CdlSetloc",  "CdlPlay",
  85     "CdlForward",  "CdlBackward",  "CdlReadN",   "CdlStandby",
  86     "CdlStop",     "CdlPause",     "CdlReset",    "CdlMute",
  87     "CdlDemute",   "CdlSetfilter", "CdlSetmode", "CdlGetparam",
  88     "CdlGetlocL",  "CdlGetlocP",   "CdlReadT",   "CdlGetTN",
  89     "CdlGetTD",    "CdlSeekL",     "CdlSeekP",   "CdlSetclock",
  90     "CdlGetclock", "CdlTest",      "CdlID",      "CdlReadS",
  91     "CdlInit",     NULL,           "CDlReadToc", NULL
  92 };
  93
  94 unsigned char Test04[] = { 0 };
  95 unsigned char Test05[] = { 0 };
  96 unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
  97 unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
  98 unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
  99
 100 // cdr.Stat:
 101 #define NoIntr          0
 102 #define DataReady       1
 103 #define Complete        2
 104 #define Acknowledge     3
 105 #define DataEnd         4
 106 #define DiskError       5
 107
 108 /* Modes flags */
 109 #define MODE_SPEED       (1<<7) // 0x80
 110 #define MODE_STRSND      (1<<6) // 0x40 ADPCM on/off
 111 #define MODE_SIZE_2340   (1<<5) // 0x20
 112 #define MODE_SIZE_2328   (1<<4) // 0x10
 113 #define MODE_SIZE_2048   (0<<4) // 0x00
 114 #define MODE_SF          (1<<3) // 0x08 channel on/off
 115 #define MODE_REPORT      (1<<2) // 0x04
 116 #define MODE_AUTOPAUSE   (1<<1) // 0x02
 117 #define MODE_CDDA        (1<<0) // 0x01
 118
 119 /* Status flags */
 120 #define STATUS_PLAY      (1<<7) // 0x80
 121 #define STATUS_SEEK      (1<<6) // 0x40
 122 #define STATUS_READ      (1<<5) // 0x20
 123 #define STATUS_SHELLOPEN (1<<4) // 0x10
 124 #define STATUS_UNKNOWN3  (1<<3) // 0x08
 125 #define STATUS_UNKNOWN2  (1<<2) // 0x04
 126 #define STATUS_ROTATING  (1<<1) // 0x02
 127 #define STATUS_ERROR     (1<<0) // 0x01
 128
 129 /* Errors */
 130 #define ERROR_NOTREADY   (1<<7) // 0x80
 131 #define ERROR_INVALIDCMD (1<<6) // 0x40
 132 #define ERROR_INVALIDARG (1<<5) // 0x20
 133
 134 // 1x = 75 sectors per second
 135 // PSXCLK = 1 sec in the ps
 136 // so (PSXCLK / 75) = cdr read time (linuzappz)
 137 #define cdReadTime (PSXCLK / 75)
 138
 139 enum drive_state {
 140         DRIVESTATE_STANDBY = 0,
 141         DRIVESTATE_LID_OPEN,
 142         DRIVESTATE_RESCAN_CD,
 143         DRIVESTATE_PREPARE_CD,
 144         DRIVESTATE_STOPPED,
 145 };
 146
 147 // for cdr.Seeked
 148 enum seeked_state {
 149         SEEK_PENDING = 0,
 150         SEEK_DONE = 1,
 151 };
 152
 153 static struct CdrStat stat;
 154
 155 static unsigned int msf2sec(const u8 *msf) {
 156         return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
 157 }
 158
 159 // for that weird psemu API..
 160 static unsigned int fsm2sec(const u8 *msf) {
 161         return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
 162 }
 163
 164 static void sec2msf(unsigned int s, u8 *msf) {
 165         msf[0] = s / 75 / 60;
 166         s = s - msf[0] * 75 * 60;
 167         msf[1] = s / 75;
 168         s = s - msf[1] * 75;
 169         msf[2] = s;
 170 }
 171
 172 // cdrInterrupt
 173 #define CDR_INT(eCycle) { \
 174         psxRegs.interrupt |= (1 << PSXINT_CDR); \
 175         psxRegs.intCycle[PSXINT_CDR].cycle = eCycle; \
 176         psxRegs.intCycle[PSXINT_CDR].sCycle = psxRegs.cycle; \
 177         new_dyna_set_event(PSXINT_CDR, eCycle); \
 178 }
 179
 180 // cdrReadInterrupt
 181 #define CDREAD_INT(eCycle) { \
 182         psxRegs.interrupt |= (1 << PSXINT_CDREAD); \
 183         psxRegs.intCycle[PSXINT_CDREAD].cycle = eCycle; \
 184         psxRegs.intCycle[PSXINT_CDREAD].sCycle = psxRegs.cycle; \
 185         new_dyna_set_event(PSXINT_CDREAD, eCycle); \
 186 }
 187
 188 // cdrLidSeekInterrupt
 189 #define CDRLID_INT(eCycle) { \
 190         psxRegs.interrupt |= (1 << PSXINT_CDRLID); \
 191         psxRegs.intCycle[PSXINT_CDRLID].cycle = eCycle; \
 192         psxRegs.intCycle[PSXINT_CDRLID].sCycle = psxRegs.cycle; \
 193         new_dyna_set_event(PSXINT_CDRLID, eCycle); \
 194 }
 195
 196 // cdrPlayInterrupt
 197 #define CDRMISC_INT(eCycle) { \
 198         psxRegs.interrupt |= (1 << PSXINT_CDRPLAY); \
 199         psxRegs.intCycle[PSXINT_CDRPLAY].cycle = eCycle; \
 200         psxRegs.intCycle[PSXINT_CDRPLAY].sCycle = psxRegs.cycle; \
 201         new_dyna_set_event(PSXINT_CDRPLAY, eCycle); \
 202 }
 203
 204 #define StopReading() { \
 205         if (cdr.Reading) { \
 206                 cdr.Reading = 0; \
 207                 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
 208         } \
 209         cdr.StatP &= ~(STATUS_READ|STATUS_SEEK);\
 210 }
 211
 212 #define StopCdda() { \
 213         if (cdr.Play) { \
 214                 if (!Config.Cdda) CDR_stop(); \
 215                 cdr.StatP &= ~STATUS_PLAY; \
 216                 cdr.Play = FALSE; \
 217                 cdr.FastForward = 0; \
 218                 cdr.FastBackward = 0; \
 219                 /*SPU_registerCallback( SPUirq );*/ \
 220         } \
 221 }
 222
 223 #define SetResultSize(size) { \
 224         cdr.ResultP = 0; \
 225         cdr.ResultC = size; \
 226         cdr.ResultReady = 1; \
 227 }
 228
 229 static void setIrq(void)
 230 {
 231         if (cdr.Stat & cdr.Reg2)
 232                 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
 233 }
 234
 235 // timing used in this function was taken from tests on real hardware
 236 // (yes it's slow, but you probably don't want to modify it)
 237 void cdrLidSeekInterrupt()
 238 {
 239         switch (cdr.DriveState) {
 240         default:
 241         case DRIVESTATE_STANDBY:
 242                 cdr.StatP &= ~STATUS_SEEK;
 243
 244                 if (CDR_getStatus(&stat) == -1)
 245                         return;
 246
 247                 if (stat.Status & STATUS_SHELLOPEN)
 248                 {
 249                         StopCdda();
 250                         cdr.DriveState = DRIVESTATE_LID_OPEN;
 251                         CDRLID_INT(0x800);
 252                 }
 253                 break;
 254
 255         case DRIVESTATE_LID_OPEN:
 256                 if (CDR_getStatus(&stat) == -1)
 257                         stat.Status &= ~STATUS_SHELLOPEN;
 258
 259                 // 02, 12, 10
 260                 if (!(cdr.StatP & STATUS_SHELLOPEN)) {
 261                         StopReading();
 262                         cdr.StatP |= STATUS_SHELLOPEN;
 263
 264                         // could generate error irq here, but real hardware
 265                         // only sometimes does that
 266                         // (not done when lots of commands are sent?)
 267
 268                         CDRLID_INT(cdReadTime * 30);
 269                         break;
 270                 }
 271                 else if (cdr.StatP & STATUS_ROTATING) {
 272                         cdr.StatP &= ~STATUS_ROTATING;
 273                 }
 274                 else if (!(stat.Status & STATUS_SHELLOPEN)) {
 275                         // closed now
 276                         CheckCdrom();
 277
 278                         // cdr.StatP STATUS_SHELLOPEN is "sticky"
 279                         // and is only cleared by CdlNop
 280
 281                         cdr.DriveState = DRIVESTATE_RESCAN_CD;
 282                         CDRLID_INT(cdReadTime * 105);
 283                         break;
 284                 }
 285
 286                 // recheck for close
 287                 CDRLID_INT(cdReadTime * 3);
 288                 break;
 289
 290         case DRIVESTATE_RESCAN_CD:
 291                 cdr.StatP |= STATUS_ROTATING;
 292                 cdr.DriveState = DRIVESTATE_PREPARE_CD;
 293
 294                 // this is very long on real hardware, over 6 seconds
 295                 // make it a bit faster here...
 296                 CDRLID_INT(cdReadTime * 150);
 297                 break;
 298
 299         case DRIVESTATE_PREPARE_CD:
 300                 cdr.StatP |= STATUS_SEEK;
 301
 302                 cdr.DriveState = DRIVESTATE_STANDBY;
 303                 CDRLID_INT(cdReadTime * 26);
 304                 break;
 305         }
 306 }
 307
 308 static void Find_CurTrack(const u8 *time)
 309 {
 310         int current, sect;
 311
 312         current = msf2sec(time);
 313
 314         for (cdr.CurTrack = 1; cdr.CurTrack < cdr.ResultTN[1]; cdr.CurTrack++) {
 315                 CDR_getTD(cdr.CurTrack + 1, cdr.ResultTD);
 316                 sect = fsm2sec(cdr.ResultTD);
 317                 if (sect - current >= 150)
 318                         break;
 319         }
 320 }
 321
 322 static void generate_subq(const u8 *time)
 323 {
 324         unsigned char start[3], next[3];
 325         unsigned int this_s, start_s, next_s, pregap;
 326         int relative_s;
 327
 328         CDR_getTD(cdr.CurTrack, start);
 329         if (cdr.CurTrack + 1 <= cdr.ResultTN[1]) {
 330                 pregap = 150;
 331                 CDR_getTD(cdr.CurTrack + 1, next);
 332         }
 333         else {
 334                 // last track - cd size
 335                 pregap = 0;
 336                 next[0] = cdr.SetSectorEnd[2];
 337                 next[1] = cdr.SetSectorEnd[1];
 338                 next[2] = cdr.SetSectorEnd[0];
 339         }
 340
 341         this_s = msf2sec(time);
 342         start_s = fsm2sec(start);
 343         next_s = fsm2sec(next);
 344
 345         cdr.TrackChanged = FALSE;
 346
 347         if (next_s - this_s < pregap) {
 348                 cdr.TrackChanged = TRUE;
 349                 cdr.CurTrack++;
 350                 start_s = next_s;
 351         }
 352
 353         cdr.subq.Index = 1;
 354
 355         relative_s = this_s - start_s;
 356         if (relative_s < 0) {
 357                 cdr.subq.Index = 0;
 358                 relative_s = -relative_s;
 359         }
 360         sec2msf(relative_s, cdr.subq.Relative);
 361
 362         cdr.subq.Track = itob(cdr.CurTrack);
 363         cdr.subq.Relative[0] = itob(cdr.subq.Relative[0]);
 364         cdr.subq.Relative[1] = itob(cdr.subq.Relative[1]);
 365         cdr.subq.Relative[2] = itob(cdr.subq.Relative[2]);
 366         cdr.subq.Absolute[0] = itob(time[0]);
 367         cdr.subq.Absolute[1] = itob(time[1]);
 368         cdr.subq.Absolute[2] = itob(time[2]);
 369 }
 370
 371 static void ReadTrack(const u8 *time) {
 372         unsigned char tmp[3];
 373         struct SubQ *subq;
 374         u16 crc;
 375
 376         tmp[0] = itob(time[0]);
 377         tmp[1] = itob(time[1]);
 378         tmp[2] = itob(time[2]);
 379
 380         if (memcmp(cdr.Prev, tmp, 3) == 0)
 381                 return;
 382
 383         CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
 384
 385         cdr.RErr = CDR_readTrack(tmp);
 386         memcpy(cdr.Prev, tmp, 3);
 387
 388         if (CheckSBI(time))
 389                 return;
 390
 391         subq = (struct SubQ *)CDR_getBufferSub();
 392         if (subq != NULL && cdr.CurTrack == 1) {
 393                 crc = calcCrc((u8 *)subq + 12, 10);
 394                 if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
 395                         cdr.subq.Track = subq->TrackNumber;
 396                         cdr.subq.Index = subq->IndexNumber;
 397                         memcpy(cdr.subq.Relative, subq->TrackRelativeAddress, 3);
 398                         memcpy(cdr.subq.Absolute, subq->AbsoluteAddress, 3);
 399                 }
 400                 else {
 401                         CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
 402                                 tmp[0], tmp[1], tmp[2]);
 403                 }
 404         }
 405         else {
 406                 generate_subq(time);
 407         }
 408
 409         CDR_LOG(" -> %02x,%02x %02x:%02x:%02x %02x:%02x:%02x\n",
 410                 cdr.subq.Track, cdr.subq.Index,
 411                 cdr.subq.Relative[0], cdr.subq.Relative[1], cdr.subq.Relative[2],
 412                 cdr.subq.Absolute[0], cdr.subq.Absolute[1], cdr.subq.Absolute[2]);
 413 }
 414
 415 static void AddIrqQueue(unsigned short irq, unsigned long ecycle) {
 416         if (cdr.Irq != 0) {
 417                 if (irq == cdr.Irq || irq + 0x100 == cdr.Irq) {
 418                         cdr.IrqRepeated = 1;
 419                         CDR_INT(ecycle);
 420                         return;
 421                 }
 422
 423                 CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
 424         }
 425
 426         cdr.Irq = irq;
 427         cdr.eCycle = ecycle;
 428
 429         CDR_INT(ecycle);
 430 }
 431
 432 static void cdrPlayInterrupt_Autopause()
 433 {
 434         u32 abs_lev_max = 0;
 435         boolean abs_lev_chselect;
 436         u32 i;
 437         s16 read_buf[CD_FRAMESIZE_RAW/2];
 438
 439         if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
 440                 CDR_LOG( "CDDA STOP\n" );
 441
 442                 // Magic the Gathering
 443                 // - looping territory cdda
 444
 445                 // ...?
 446                 //cdr.ResultReady = 1;
 447                 //cdr.Stat = DataReady;
 448                 cdr.Stat = DataEnd;
 449                 setIrq();
 450
 451                 StopCdda();
 452         }
 453         else if (cdr.Mode & MODE_REPORT) {
 454                 CDR_readCDDA(cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2], (u8 *)read_buf);
 455
 456                 cdr.Result[0] = cdr.StatP;
 457                 cdr.Result[1] = cdr.subq.Track;
 458                 cdr.Result[2] = cdr.subq.Index;
 459
 460                 abs_lev_chselect = cdr.subq.Absolute[1] & 0x01;
 461
 462                 /* 8 is a hack. For accuracy, it should be 588. */
 463                 for (i = 0; i < 8; i++)
 464                 {
 465                         abs_lev_max = MAX_VALUE(abs_lev_max, abs(read_buf[i * 2 + abs_lev_chselect]));
 466                 }
 467                 abs_lev_max = MIN_VALUE(abs_lev_max, 32767);
 468                 abs_lev_max |= abs_lev_chselect << 15;
 469
 470                 if (cdr.subq.Absolute[2] & 0x10) {
 471                         cdr.Result[3] = cdr.subq.Relative[0];
 472                         cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
 473                         cdr.Result[5] = cdr.subq.Relative[2];
 474                 }
 475                 else {
 476                         cdr.Result[3] = cdr.subq.Absolute[0];
 477                         cdr.Result[4] = cdr.subq.Absolute[1];
 478                         cdr.Result[5] = cdr.subq.Absolute[2];
 479                 }
 480
 481                 cdr.Result[6] = abs_lev_max >> 0;
 482                 cdr.Result[7] = abs_lev_max >> 8;
 483
 484                 // Rayman: Logo freeze (resultready + dataready)
 485                 cdr.ResultReady = 1;
 486                 cdr.Stat = DataReady;
 487
 488                 SetResultSize(8);
 489                 setIrq();
 490         }
 491 }
 492
 493 // also handles seek
 494 void cdrPlayInterrupt()
 495 {
 496         if (cdr.Seeked == SEEK_PENDING) {
 497                 if (cdr.Stat) {
 498                         CDR_LOG_I("cdrom: seek stat hack\n");
 499                         CDRMISC_INT(0x1000);
 500                         return;
 501                 }
 502                 SetResultSize(1);
 503                 cdr.StatP |= STATUS_ROTATING;
 504                 cdr.StatP &= ~STATUS_SEEK;
 505                 cdr.Result[0] = cdr.StatP;
 506                 cdr.Seeked = SEEK_DONE;
 507                 if (cdr.Irq == 0) {
 508                         cdr.Stat = Complete;
 509                         setIrq();
 510                 }
 511
 512                 if (cdr.SetlocPending) {
 513                         memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
 514                         cdr.SetlocPending = 0;
 515                         cdr.m_locationChanged = TRUE;
 516                 }
 517                 Find_CurTrack(cdr.SetSectorPlay);
 518                 ReadTrack(cdr.SetSectorPlay);
 519                 cdr.TrackChanged = FALSE;
 520         }
 521
 522         if (!cdr.Play) return;
 523
 524         CDR_LOG( "CDDA - %d:%d:%d\n",
 525                 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
 526
 527         if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
 528                 StopCdda();
 529                 cdr.TrackChanged = TRUE;
 530         }
 531
 532         if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
 533                 cdrPlayInterrupt_Autopause();
 534
 535         if (!cdr.Play) return;
 536
 537         cdr.SetSectorPlay[2]++;
 538         if (cdr.SetSectorPlay[2] == 75) {
 539                 cdr.SetSectorPlay[2] = 0;
 540                 cdr.SetSectorPlay[1]++;
 541                 if (cdr.SetSectorPlay[1] == 60) {
 542                         cdr.SetSectorPlay[1] = 0;
 543                         cdr.SetSectorPlay[0]++;
 544                 }
 545         }
 546
 547         if (cdr.m_locationChanged)
 548         {
 549                 CDRMISC_INT(cdReadTime * 30);
 550                 cdr.m_locationChanged = FALSE;
 551         }
 552         else
 553         {
 554                 CDRMISC_INT(cdReadTime);
 555         }
 556
 557         // update for CdlGetlocP/autopause
 558         generate_subq(cdr.SetSectorPlay);
 559 }
 560
 561 void cdrInterrupt() {
 562         u16 Irq = cdr.Irq;
 563         int no_busy_error = 0;
 564         int start_rotating = 0;
 565         int error = 0;
 566         int delay;
 567         unsigned int seekTime = 0;
 568
 569         // Reschedule IRQ
 570         if (cdr.Stat) {
 571                 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
 572                 CDR_INT(0x1000);
 573                 return;
 574         }
 575
 576         cdr.Ctrl &= ~0x80;
 577
 578         // default response
 579         SetResultSize(1);
 580         cdr.Result[0] = cdr.StatP;
 581         cdr.Stat = Acknowledge;
 582
 583         if (cdr.IrqRepeated) {
 584                 cdr.IrqRepeated = 0;
 585                 if (cdr.eCycle > psxRegs.cycle) {
 586                         CDR_INT(cdr.eCycle);
 587                         goto finish;
 588                 }
 589         }
 590
 591         cdr.Irq = 0;
 592
 593         switch (Irq) {
 594                 case CdlNop:
 595                         if (cdr.DriveState != DRIVESTATE_LID_OPEN)
 596                                 cdr.StatP &= ~STATUS_SHELLOPEN;
 597                         no_busy_error = 1;
 598                         break;
 599
 600                 case CdlSetloc:
 601                         break;
 602
 603                 do_CdlPlay:
 604                 case CdlPlay:
 605                         StopCdda();
 606                         if (cdr.Seeked == SEEK_PENDING) {
 607                                 // XXX: wrong, should seek instead..
 608                                 cdr.Seeked = SEEK_DONE;
 609                         }
 610                         if (cdr.SetlocPending) {
 611                                 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
 612                                 cdr.SetlocPending = 0;
 613                                 cdr.m_locationChanged = TRUE;
 614                         }
 615
 616                         // BIOS CD Player
 617                         // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
 618
 619                         if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
 620                                 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
 621                                         cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
 622                         }
 623                         else
 624                         {
 625                                 int track = btoi( cdr.Param[0] );
 626
 627                                 if (track <= cdr.ResultTN[1])
 628                                         cdr.CurTrack = track;
 629
 630                                 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
 631
 632                                 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
 633                                         cdr.SetSectorPlay[0] = cdr.ResultTD[2];
 634                                         cdr.SetSectorPlay[1] = cdr.ResultTD[1];
 635                                         cdr.SetSectorPlay[2] = cdr.ResultTD[0];
 636                                 }
 637                         }
 638
 639                         /*
 640                         Rayman: detect track changes
 641                         - fixes logo freeze
 642
 643                         Twisted Metal 2: skip PREGAP + starting accurate SubQ
 644                         - plays tracks without retry play
 645
 646                         Wild 9: skip PREGAP + starting accurate SubQ
 647                         - plays tracks without retry play
 648                         */
 649                         Find_CurTrack(cdr.SetSectorPlay);
 650                         ReadTrack(cdr.SetSectorPlay);
 651                         cdr.TrackChanged = FALSE;
 652
 653                         if (!Config.Cdda)
 654                                 CDR_play(cdr.SetSectorPlay);
 655
 656                         // Vib Ribbon: gameplay checks flag
 657                         cdr.StatP &= ~STATUS_SEEK;
 658                         cdr.Result[0] = cdr.StatP;
 659
 660                         cdr.StatP |= STATUS_PLAY;
 661
 662                         // BIOS player - set flag again
 663                         cdr.Play = TRUE;
 664
 665                         CDRMISC_INT( cdReadTime );
 666                         start_rotating = 1;
 667                         break;
 668
 669                 case CdlForward:
 670                         // TODO: error 80 if stopped
 671                         cdr.Stat = Complete;
 672
 673                         // GameShark CD Player: Calls 2x + Play 2x
 674                         if( cdr.FastForward == 0 ) cdr.FastForward = 2;
 675                         else cdr.FastForward++;
 676
 677                         cdr.FastBackward = 0;
 678                         break;
 679
 680                 case CdlBackward:
 681                         cdr.Stat = Complete;
 682
 683                         // GameShark CD Player: Calls 2x + Play 2x
 684                         if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
 685                         else cdr.FastBackward++;
 686
 687                         cdr.FastForward = 0;
 688                         break;
 689
 690                 case CdlStandby:
 691                         if (cdr.DriveState != DRIVESTATE_STOPPED) {
 692                                 error = ERROR_INVALIDARG;
 693                                 goto set_error;
 694                         }
 695                         AddIrqQueue(CdlStandby + 0x100, cdReadTime * 125 / 2);
 696                         start_rotating = 1;
 697                         break;
 698
 699                 case CdlStandby + 0x100:
 700                         cdr.Stat = Complete;
 701                         break;
 702
 703                 case CdlStop:
 704                         if (cdr.Play) {
 705                                 // grab time for current track
 706                                 CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
 707
 708                                 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
 709                                 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
 710                                 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
 711                         }
 712
 713                         StopCdda();
 714                         StopReading();
 715
 716                         delay = 0x800;
 717                         if (cdr.DriveState == DRIVESTATE_STANDBY)
 718                                 delay = cdReadTime * 30 / 2;
 719
 720                         cdr.DriveState = DRIVESTATE_STOPPED;
 721                         AddIrqQueue(CdlStop + 0x100, delay);
 722                         break;
 723
 724                 case CdlStop + 0x100:
 725                         cdr.StatP &= ~STATUS_ROTATING;
 726                         cdr.Result[0] = cdr.StatP;
 727                         cdr.Stat = Complete;
 728                         break;
 729
 730                 case CdlPause:
 731                         /*
 732                         Gundam Battle Assault 2: much slower (*)
 733                         - Fixes boot, gameplay
 734
 735                         Hokuto no Ken 2: slower
 736                         - Fixes intro + subtitles
 737
 738                         InuYasha - Feudal Fairy Tale: slower
 739                         - Fixes battles
 740                         */
 741                         /* Gameblabla - Tightening the timings (as taken from Duckstation).
 742                          * The timings from Duckstation are based upon hardware tests.
 743                          * Mednafen's timing don't work for Gundam Battle Assault 2 in PAL/50hz mode,
 744                          * seems to be timing sensitive as it can depend on the CPU's clock speed.
 745                          * */
 746                         if (cdr.DriveState != DRIVESTATE_STANDBY)
 747                         {
 748                                 delay = 7000;
 749                         }
 750                         else
 751                         {
 752                                 delay = (((cdr.Mode & MODE_SPEED) ? 2 : 1) * (1000000));
 753                                 CDRMISC_INT((cdr.Mode & MODE_SPEED) ? cdReadTime / 2 : cdReadTime);
 754                         }
 755                         AddIrqQueue(CdlPause + 0x100, delay);
 756                         cdr.Ctrl |= 0x80;
 757                         break;
 758
 759                 case CdlPause + 0x100:
 760                         cdr.StatP &= ~STATUS_READ;
 761                         cdr.Result[0] = cdr.StatP;
 762                         cdr.Stat = Complete;
 763                         break;
 764
 765                 case CdlReset:
 766                         cdr.Muted = FALSE;
 767                         cdr.Mode = 0x20; /* This fixes This is Football 2, Pooh's Party lockups */
 768                         AddIrqQueue(CdlReset + 0x100, 4100000);
 769                         no_busy_error = 1;
 770                         start_rotating = 1;
 771                         break;
 772
 773                 case CdlReset + 0x100:
 774                         cdr.Stat = Complete;
 775                         break;
 776
 777                 case CdlMute:
 778                         cdr.Muted = TRUE;
 779                         break;
 780
 781                 case CdlDemute:
 782                         cdr.Muted = FALSE;
 783                         break;
 784
 785                 case CdlSetfilter:
 786                         cdr.File = cdr.Param[0];
 787                         cdr.Channel = cdr.Param[1];
 788                         break;
 789
 790                 case CdlSetmode:
 791                         no_busy_error = 1;
 792                         break;
 793
 794                 case CdlGetparam:
 795                         /* Gameblabla : According to mednafen, Result size should be 5 and done this way. */
 796                         SetResultSize(5);
 797                         cdr.Result[1] = cdr.Mode;
 798                         cdr.Result[2] = 0;
 799                         cdr.Result[3] = cdr.File;
 800                         cdr.Result[4] = cdr.Channel;
 801                         no_busy_error = 1;
 802                         break;
 803
 804                 case CdlGetlocL:
 805                         SetResultSize(8);
 806                         memcpy(cdr.Result, cdr.Transfer, 8);
 807                         break;
 808
 809                 case CdlGetlocP:
 810                         SetResultSize(8);
 811                         memcpy(&cdr.Result, &cdr.subq, 8);
 812
 813                         if (!cdr.Play && !cdr.Reading)
 814                                 cdr.Result[1] = 0; // HACK?
 815                         break;
 816
 817                 case CdlReadT: // SetSession?
 818                         // really long
 819                         AddIrqQueue(CdlReadT + 0x100, cdReadTime * 290 / 4);
 820                         start_rotating = 1;
 821                         break;
 822
 823                 case CdlReadT + 0x100:
 824                         cdr.Stat = Complete;
 825                         break;
 826
 827                 case CdlGetTN:
 828                         SetResultSize(3);
 829                         if (CDR_getTN(cdr.ResultTN) == -1) {
 830                                 cdr.Stat = DiskError;
 831                                 cdr.Result[0] |= STATUS_ERROR;
 832                         } else {
 833                                 cdr.Stat = Acknowledge;
 834                                 cdr.Result[1] = itob(cdr.ResultTN[0]);
 835                                 cdr.Result[2] = itob(cdr.ResultTN[1]);
 836                         }
 837                         break;
 838
 839                 case CdlGetTD:
 840                         cdr.Track = btoi(cdr.Param[0]);
 841                         SetResultSize(4);
 842                         if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
 843                                 cdr.Stat = DiskError;
 844                                 cdr.Result[0] |= STATUS_ERROR;
 845                         } else {
 846                                 cdr.Stat = Acknowledge;
 847                                 cdr.Result[0] = cdr.StatP;
 848                                 cdr.Result[1] = itob(cdr.ResultTD[2]);
 849                                 cdr.Result[2] = itob(cdr.ResultTD[1]);
 850                                 /* According to Nocash's documentation, the function doesn't care about ff.
 851                                  * This can be seen also in Mednafen's implementation. */
 852                                 //cdr.Result[3] = itob(cdr.ResultTD[0]);
 853                         }
 854                         break;
 855
 856                 case CdlSeekL:
 857                 case CdlSeekP:
 858                         StopCdda();
 859                         StopReading();
 860                         cdr.StatP |= STATUS_SEEK;
 861
 862                         /*
 863                         Crusaders of Might and Magic = 0.5x-4x
 864                         - fix cutscene speech start
 865
 866                         Eggs of Steel = 2x-?
 867                         - fix new game
 868
 869                         Medievil = ?-4x
 870                         - fix cutscene speech
 871
 872                         Rockman X5 = 0.5-4x
 873                         - fix capcom logo
 874                         */
 875                         CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
 876                         cdr.Seeked = SEEK_PENDING;
 877                         start_rotating = 1;
 878                         break;
 879
 880                 case CdlTest:
 881                         switch (cdr.Param[0]) {
 882                                 case 0x20: // System Controller ROM Version
 883                                         SetResultSize(4);
 884                                         memcpy(cdr.Result, Test20, 4);
 885                                         break;
 886                                 case 0x22:
 887                                         SetResultSize(8);
 888                                         memcpy(cdr.Result, Test22, 4);
 889                                         break;
 890                                 case 0x23: case 0x24:
 891                                         SetResultSize(8);
 892                                         memcpy(cdr.Result, Test23, 4);
 893                                         break;
 894                         }
 895                         no_busy_error = 1;
 896                         break;
 897
 898                 case CdlID:
 899                         AddIrqQueue(CdlID + 0x100, 20480);
 900                         break;
 901
 902                 case CdlID + 0x100:
 903                         SetResultSize(8);
 904                         cdr.Result[0] = cdr.StatP;
 905                         cdr.Result[1] = 0;
 906                         cdr.Result[2] = 0;
 907                         cdr.Result[3] = 0;
 908
 909                         // 0x10 - audio | 0x40 - disk missing | 0x80 - unlicensed
 910                         if (CDR_getStatus(&stat) == -1 || stat.Type == 0 || stat.Type == 0xff) {
 911                                 cdr.Result[1] = 0xc0;
 912                         }
 913                         else {
 914                                 if (stat.Type == 2)
 915                                         cdr.Result[1] |= 0x10;
 916                                 if (CdromId[0] == '\0')
 917                                         cdr.Result[1] |= 0x80;
 918                         }
 919                         cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
 920
 921                         strncpy((char *)&cdr.Result[4], "PCSX", 4);
 922                         cdr.Stat = Complete;
 923                         break;
 924
 925                 case CdlInit:
 926                         // yes, it really sets STATUS_SHELLOPEN
 927                         cdr.StatP |= STATUS_SHELLOPEN;
 928                         cdr.DriveState = DRIVESTATE_RESCAN_CD;
 929                         CDRLID_INT(20480);
 930                         no_busy_error = 1;
 931                         start_rotating = 1;
 932                         break;
 933
 934                 case CdlGetQ:
 935                         no_busy_error = 1;
 936                         break;
 937
 938                 case CdlReadToc:
 939                         AddIrqQueue(CdlReadToc + 0x100, cdReadTime * 180 / 4);
 940                         no_busy_error = 1;
 941                         start_rotating = 1;
 942                         break;
 943
 944                 case CdlReadToc + 0x100:
 945                         cdr.Stat = Complete;
 946                         no_busy_error = 1;
 947                         break;
 948
 949                 case CdlReadN:
 950                 case CdlReadS:
 951                         if (cdr.SetlocPending) {
 952                                 seekTime = abs(msf2sec(cdr.SetSectorPlay) - msf2sec(cdr.SetSector)) * (cdReadTime / 200);
 953                                 if(seekTime > 1000000) seekTime = 1000000;
 954                                 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
 955                                 cdr.SetlocPending = 0;
 956                                 cdr.m_locationChanged = TRUE;
 957                         }
 958                         Find_CurTrack(cdr.SetSectorPlay);
 959
 960                         if ((cdr.Mode & MODE_CDDA) && cdr.CurTrack > 1)
 961                                 // Read* acts as play for cdda tracks in cdda mode
 962                                 goto do_CdlPlay;
 963
 964                         cdr.Reading = 1;
 965                         cdr.FirstSector = 1;
 966
 967                         // Fighting Force 2 - update subq time immediately
 968                         // - fixes new game
 969                         ReadTrack(cdr.SetSectorPlay);
 970
 971
 972                         // Crusaders of Might and Magic - update getlocl now
 973                         // - fixes cutscene speech
 974                         {
 975                                 u8 *buf = CDR_getBuffer();
 976                                 if (buf != NULL)
 977                                         memcpy(cdr.Transfer, buf, 8);
 978                         }
 979
 980                         /*
 981                         Duke Nukem: Land of the Babes - seek then delay read for one frame
 982                         - fixes cutscenes
 983                         C-12 - Final Resistance - doesn't like seek
 984                         */
 985
 986                         if (cdr.Seeked != SEEK_DONE) {
 987                                 cdr.StatP |= STATUS_SEEK;
 988                                 cdr.StatP &= ~STATUS_READ;
 989
 990                                 // Crusaders of Might and Magic - use short time
 991                                 // - fix cutscene speech (startup)
 992
 993                                 // ??? - use more accurate seek time later
 994                                 CDREAD_INT(((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1) + seekTime);
 995                         } else {
 996                                 cdr.StatP |= STATUS_READ;
 997                                 cdr.StatP &= ~STATUS_SEEK;
 998
 999                                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1000                         }
1001
1002                         cdr.Result[0] = cdr.StatP;
1003                         start_rotating = 1;
1004                         break;
1005                 case CdlSync:
1006                 default:
1007                         CDR_LOG_I("Invalid command: %02x\n", Irq);
1008                         error = ERROR_INVALIDCMD;
1009                         // FALLTHROUGH
1010
1011                 set_error:
1012                         SetResultSize(2);
1013                         cdr.Result[0] = cdr.StatP | STATUS_ERROR;
1014                         cdr.Result[1] = error;
1015                         cdr.Stat = DiskError;
1016                         break;
1017         }
1018
1019         if (cdr.DriveState == DRIVESTATE_STOPPED && start_rotating) {
1020                 cdr.DriveState = DRIVESTATE_STANDBY;
1021                 cdr.StatP |= STATUS_ROTATING;
1022         }
1023
1024         if (!no_busy_error) {
1025                 switch (cdr.DriveState) {
1026                 case DRIVESTATE_LID_OPEN:
1027                 case DRIVESTATE_RESCAN_CD:
1028                 case DRIVESTATE_PREPARE_CD:
1029                         SetResultSize(2);
1030                         cdr.Result[0] = cdr.StatP | STATUS_ERROR;
1031                         cdr.Result[1] = ERROR_NOTREADY;
1032                         cdr.Stat = DiskError;
1033                         break;
1034                 }
1035         }
1036
1037 finish:
1038         setIrq();
1039         cdr.ParamC = 0;
1040
1041 #ifdef CDR_LOG_CMD_IRQ
1042         {
1043                 int i;
1044                 SysPrintf("CDR IRQ %d cmd %02x stat %02x: ",
1045                         !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
1046                 for (i = 0; i < cdr.ResultC; i++)
1047                         SysPrintf("%02x ", cdr.Result[i]);
1048                 SysPrintf("\n");
1049         }
1050 #endif
1051 }
1052
1053 #ifdef HAVE_ARMV7
1054  #define ssat32_to_16(v) \
1055   asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
1056 #else
1057  #define ssat32_to_16(v) do { \
1058   if (v < -32768) v = -32768; \
1059   else if (v > 32767) v = 32767; \
1060  } while (0)
1061 #endif
1062
1063 void cdrAttenuate(s16 *buf, int samples, int stereo)
1064 {
1065         int i, l, r;
1066         int ll = cdr.AttenuatorLeftToLeft;
1067         int lr = cdr.AttenuatorLeftToRight;
1068         int rl = cdr.AttenuatorRightToLeft;
1069         int rr = cdr.AttenuatorRightToRight;
1070
1071         if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
1072                 return;
1073
1074         if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
1075                 return;
1076
1077         if (stereo) {
1078                 for (i = 0; i < samples; i++) {
1079                         l = buf[i * 2];
1080                         r = buf[i * 2 + 1];
1081                         l = (l * ll + r * rl) >> 7;
1082                         r = (r * rr + l * lr) >> 7;
1083                         ssat32_to_16(l);
1084                         ssat32_to_16(r);
1085                         buf[i * 2] = l;
1086                         buf[i * 2 + 1] = r;
1087                 }
1088         }
1089         else {
1090                 for (i = 0; i < samples; i++) {
1091                         l = buf[i];
1092                         l = l * (ll + rl) >> 7;
1093                         //r = r * (rr + lr) >> 7;
1094                         ssat32_to_16(l);
1095                         //ssat32_to_16(r);
1096                         buf[i] = l;
1097                 }
1098         }
1099 }
1100
1101 void cdrReadInterrupt() {
1102         u8 *buf;
1103
1104         if (!cdr.Reading)
1105                 return;
1106
1107         if (cdr.Irq || cdr.Stat) {
1108                 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1109                 CDREAD_INT(0x1000);
1110                 return;
1111         }
1112
1113         cdr.OCUP = 1;
1114         SetResultSize(1);
1115         cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1116         cdr.StatP &= ~STATUS_SEEK;
1117         cdr.Result[0] = cdr.StatP;
1118         cdr.Seeked = SEEK_DONE;
1119
1120         ReadTrack(cdr.SetSectorPlay);
1121
1122         buf = CDR_getBuffer();
1123         if (buf == NULL)
1124                 cdr.RErr = -1;
1125
1126         if (cdr.RErr == -1) {
1127                 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1128                 memset(cdr.Transfer, 0, DATA_SIZE);
1129                 cdr.Stat = DiskError;
1130                 cdr.Result[0] |= STATUS_ERROR;
1131                 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1132                 return;
1133         }
1134
1135         memcpy(cdr.Transfer, buf, DATA_SIZE);
1136         CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1137
1138
1139         CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1140
1141         if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1142                 // Firemen 2: Multi-XA files - briefings, cutscenes
1143                 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1144                         cdr.File = cdr.Transfer[4 + 0];
1145                         cdr.Channel = cdr.Transfer[4 + 1];
1146                 }
1147
1148                 /* Gameblabla
1149                  * Skips playing on channel 255.
1150                  * Fixes missing audio in Blue's Clues : Blue's Big Musical. (Should also fix Taxi 2)
1151                  * TODO : Check if this is the proper behaviour.
1152                  * */
1153                 if((cdr.Transfer[4 + 2] & 0x4) &&
1154                          (cdr.Transfer[4 + 1] == cdr.Channel) &&
1155                          (cdr.Transfer[4 + 0] == cdr.File) && cdr.Channel != 255) {
1156                         int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1157                         if (!ret) {
1158                                 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
1159                                 SPU_playADPCMchannel(&cdr.Xa);
1160                                 cdr.FirstSector = 0;
1161                         }
1162                         else cdr.FirstSector = -1;
1163                 }
1164         }
1165
1166         cdr.SetSectorPlay[2]++;
1167         if (cdr.SetSectorPlay[2] == 75) {
1168                 cdr.SetSectorPlay[2] = 0;
1169                 cdr.SetSectorPlay[1]++;
1170                 if (cdr.SetSectorPlay[1] == 60) {
1171                         cdr.SetSectorPlay[1] = 0;
1172                         cdr.SetSectorPlay[0]++;
1173                 }
1174         }
1175
1176         cdr.Readed = 0;
1177
1178         uint32_t delay = (cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime;
1179         if (cdr.m_locationChanged) {
1180                 CDREAD_INT(delay * 30);
1181                 cdr.m_locationChanged = FALSE;
1182         } else {
1183                 CDREAD_INT(delay);
1184         }
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.SetSectorPlay);
1199 }
1200
1201 /*
1202 cdrRead0:
1203         bit 0,1 - mode
1204         bit 2 - unknown
1205         bit 3 - unknown
1206         bit 4 - unknown
1207         bit 5 - 1 result ready
1208         bit 6 - 1 dma ready
1209         bit 7 - 1 command being processed
1210 */
1211
1212 unsigned char cdrRead0(void) {
1213         if (cdr.ResultReady)
1214                 cdr.Ctrl |= 0x20;
1215         else
1216                 cdr.Ctrl &= ~0x20;
1217
1218         if (cdr.OCUP)
1219                 cdr.Ctrl |= 0x40;
1220 //  else
1221 //              cdr.Ctrl &= ~0x40;
1222
1223         // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1224         cdr.Ctrl |= 0x18;
1225
1226         CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1227
1228         return psxHu8(0x1800) = cdr.Ctrl;
1229 }
1230
1231 void cdrWrite0(unsigned char rt) {
1232         CDR_LOG_IO("cdr w0: %02x\n", rt);
1233
1234         cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1235 }
1236
1237 unsigned char cdrRead1(void) {
1238         if ((cdr.ResultP & 0xf) < cdr.ResultC)
1239                 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1240         else
1241                 psxHu8(0x1801) = 0;
1242         cdr.ResultP++;
1243         if (cdr.ResultP == cdr.ResultC)
1244                 cdr.ResultReady = 0;
1245
1246         CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1247
1248         return psxHu8(0x1801);
1249 }
1250
1251 void cdrWrite1(unsigned char rt) {
1252         u8 set_loc[3];
1253         int i;
1254
1255         CDR_LOG_IO("cdr w1: %02x\n", rt);
1256
1257         switch (cdr.Ctrl & 3) {
1258         case 0:
1259                 break;
1260         case 3:
1261                 cdr.AttenuatorRightToRightT = rt;
1262                 return;
1263         default:
1264                 return;
1265         }
1266
1267         cdr.Cmd = rt;
1268         cdr.OCUP = 0;
1269
1270 #ifdef CDR_LOG_CMD_IRQ
1271         SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
1272         if (cdr.ParamC) {
1273                 SysPrintf(" Param[%d] = {", cdr.ParamC);
1274                 for (i = 0; i < cdr.ParamC; i++)
1275                         SysPrintf(" %x,", cdr.Param[i]);
1276                 SysPrintf("}\n");
1277         } else {
1278                 SysPrintf("\n");
1279         }
1280 #endif
1281
1282         cdr.ResultReady = 0;
1283         cdr.Ctrl |= 0x80;
1284         // cdr.Stat = NoIntr;
1285         AddIrqQueue(cdr.Cmd, 0x800);
1286
1287         switch (cdr.Cmd) {
1288         case CdlSetloc:
1289                 CDR_LOG("CDROM setloc command (%02X, %02X, %02X)\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1290
1291                 // MM must be BCD, SS must be BCD and <0x60, FF must be BCD and <0x75
1292                 if (((cdr.Param[0] & 0x0F) > 0x09) || (cdr.Param[0] > 0x99) || ((cdr.Param[1] & 0x0F) > 0x09) || (cdr.Param[1] >= 0x60) || ((cdr.Param[2] & 0x0F) > 0x09) || (cdr.Param[2] >= 0x75))
1293                 {
1294                         CDR_LOG("Invalid/out of range seek to %02X:%02X:%02X\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1295                 }
1296                 else
1297                 {
1298                         for (i = 0; i < 3; i++)
1299                         {
1300                                 set_loc[i] = btoi(cdr.Param[i]);
1301                         }
1302
1303                         i = msf2sec(cdr.SetSectorPlay);
1304                         i = abs(i - msf2sec(set_loc));
1305                         if (i > 16)
1306                                 cdr.Seeked = SEEK_PENDING;
1307
1308                         memcpy(cdr.SetSector, set_loc, 3);
1309                         cdr.SetSector[3] = 0;
1310                         cdr.SetlocPending = 1;
1311                 }
1312                 break;
1313
1314         case CdlReadN:
1315         case CdlReadS:
1316         case CdlPause:
1317                 StopCdda();
1318                 StopReading();
1319                 break;
1320
1321         case CdlInit:
1322         case CdlReset:
1323                 cdr.Seeked = SEEK_DONE;
1324                 StopCdda();
1325                 StopReading();
1326                 break;
1327
1328         case CdlSetmode:
1329                 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1330
1331                 cdr.Mode = cdr.Param[0];
1332
1333                 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1334                 // - fixes choppy movie sound
1335                 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1336                         StopCdda();
1337                 break;
1338         }
1339 }
1340
1341 unsigned char cdrRead2(void) {
1342         unsigned char ret;
1343
1344         if (cdr.Readed == 0) {
1345                 ret = 0;
1346         } else {
1347                 ret = *pTransfer++;
1348         }
1349
1350         CDR_LOG_IO("cdr r2: %02x\n", ret);
1351         return ret;
1352 }
1353
1354 void cdrWrite2(unsigned char rt) {
1355         CDR_LOG_IO("cdr w2: %02x\n", rt);
1356
1357         switch (cdr.Ctrl & 3) {
1358         case 0:
1359                 if (cdr.ParamC < 8) // FIXME: size and wrapping
1360                         cdr.Param[cdr.ParamC++] = rt;
1361                 return;
1362         case 1:
1363                 cdr.Reg2 = rt;
1364                 setIrq();
1365                 return;
1366         case 2:
1367                 cdr.AttenuatorLeftToLeftT = rt;
1368                 return;
1369         case 3:
1370                 cdr.AttenuatorRightToLeftT = rt;
1371                 return;
1372         }
1373 }
1374
1375 unsigned char cdrRead3(void) {
1376         if (cdr.Ctrl & 0x1)
1377                 psxHu8(0x1803) = cdr.Stat | 0xE0;
1378         else
1379                 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1380
1381         CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1382         return psxHu8(0x1803);
1383 }
1384
1385 void cdrWrite3(unsigned char rt) {
1386         CDR_LOG_IO("cdr w3: %02x\n", rt);
1387
1388         switch (cdr.Ctrl & 3) {
1389         case 0:
1390                 break; // transfer
1391         case 1:
1392                 cdr.Stat &= ~rt;
1393
1394                 if (rt & 0x40)
1395                         cdr.ParamC = 0;
1396                 return;
1397         case 2:
1398                 cdr.AttenuatorLeftToRightT = rt;
1399                 return;
1400         case 3:
1401                 if (rt & 0x20) {
1402                         memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
1403                         CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
1404                                 cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
1405                                 cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
1406                 }
1407                 return;
1408         }
1409
1410         if ((rt & 0x80) && cdr.Readed == 0) {
1411                 cdr.Readed = 1;
1412                 pTransfer = cdr.Transfer;
1413
1414                 switch (cdr.Mode & 0x30) {
1415                         case MODE_SIZE_2328:
1416                         case 0x00:
1417                                 pTransfer += 12;
1418                                 break;
1419
1420                         case MODE_SIZE_2340:
1421                                 pTransfer += 0;
1422                                 break;
1423
1424                         default:
1425                                 break;
1426                 }
1427         }
1428 }
1429
1430 void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1431         u32 cdsize;
1432         int size;
1433         u8 *ptr;
1434
1435         CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1436
1437         switch (chcr) {
1438                 case 0x11000000:
1439                 case 0x11400100:
1440                         if (cdr.Readed == 0) {
1441                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1442                                 break;
1443                         }
1444
1445                         cdsize = (bcr & 0xffff) * 4;
1446
1447                         // Ape Escape: bcr = 0001 / 0000
1448                         // - fix boot
1449                         if( cdsize == 0 )
1450                         {
1451                                 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
1452                                         case MODE_SIZE_2340: cdsize = 2340; break;
1453                                         case MODE_SIZE_2328: cdsize = 2328; break;
1454                                         default:
1455                                         case MODE_SIZE_2048: cdsize = 2048; break;
1456                                 }
1457                         }
1458
1459
1460                         ptr = (u8 *)PSXM(madr);
1461                         if (ptr == NULL) {
1462                                 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1463                                 break;
1464                         }
1465
1466                         /*
1467                         GS CDX: Enhancement CD crash
1468                         - Setloc 0:0:0
1469                         - CdlPlay
1470                         - Spams DMA3 and gets buffer overrun
1471                         */
1472                         size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1473                         if (size > cdsize)
1474                                 size = cdsize;
1475                         if (size > 0)
1476                         {
1477                                 memcpy(ptr, pTransfer, size);
1478                         }
1479
1480                         psxCpu->Clear(madr, cdsize / 4);
1481                         pTransfer += cdsize;
1482
1483                         if( chcr == 0x11400100 ) {
1484                                 HW_DMA3_MADR = SWAPu32(madr + cdsize);
1485                                 CDRDMA_INT( (cdsize/4) / 4 );
1486                         }
1487                         else if( chcr == 0x11000000 ) {
1488                                 // CDRDMA_INT( (cdsize/4) * 1 );
1489                                 // halted
1490                                 psxRegs.cycle += (cdsize/4) * 24/2;
1491                                 CDRDMA_INT(16);
1492                         }
1493                         return;
1494
1495                 default:
1496                         CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1497                         break;
1498         }
1499
1500         HW_DMA3_CHCR &= SWAP32(~0x01000000);
1501         DMA_INTERRUPT(3);
1502 }
1503
1504 void cdrDmaInterrupt()
1505 {
1506         if (HW_DMA3_CHCR & SWAP32(0x01000000))
1507         {
1508                 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1509                 DMA_INTERRUPT(3);
1510         }
1511 }
1512
1513 static void getCdInfo(void)
1514 {
1515         u8 tmp;
1516
1517         CDR_getTN(cdr.ResultTN);
1518         CDR_getTD(0, cdr.SetSectorEnd);
1519         tmp = cdr.SetSectorEnd[0];
1520         cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
1521         cdr.SetSectorEnd[2] = tmp;
1522 }
1523
1524 void cdrReset() {
1525         memset(&cdr, 0, sizeof(cdr));
1526         cdr.CurTrack = 1;
1527         cdr.File = 1;
1528         cdr.Channel = 1;
1529         cdr.Reg2 = 0x1f;
1530         cdr.Stat = NoIntr;
1531         cdr.DriveState = DRIVESTATE_STANDBY;
1532         cdr.StatP = STATUS_ROTATING;
1533         pTransfer = cdr.Transfer;
1534         cdr.SetlocPending = 0;
1535         cdr.m_locationChanged = FALSE;
1536
1537         // BIOS player - default values
1538         cdr.AttenuatorLeftToLeft = 0x80;
1539         cdr.AttenuatorLeftToRight = 0x00;
1540         cdr.AttenuatorRightToLeft = 0x00;
1541         cdr.AttenuatorRightToRight = 0x80;
1542
1543         getCdInfo();
1544 }
1545
1546 int cdrFreeze(void *f, int Mode) {
1547         u32 tmp;
1548         u8 tmpp[3];
1549
1550         if (Mode == 0 && !Config.Cdda)
1551                 CDR_stop();
1552
1553         cdr.freeze_ver = 0x63647202;
1554         gzfreeze(&cdr, sizeof(cdr));
1555
1556         if (Mode == 1) {
1557                 cdr.ParamP = cdr.ParamC;
1558                 tmp = pTransfer - cdr.Transfer;
1559         }
1560
1561         gzfreeze(&tmp, sizeof(tmp));
1562
1563         if (Mode == 0) {
1564                 getCdInfo();
1565
1566                 pTransfer = cdr.Transfer + tmp;
1567
1568                 // read right sub data
1569                 tmpp[0] = btoi(cdr.Prev[0]);
1570                 tmpp[1] = btoi(cdr.Prev[1]);
1571                 tmpp[2] = btoi(cdr.Prev[2]);
1572                 cdr.Prev[0]++;
1573                 ReadTrack(tmpp);
1574
1575                 if (cdr.Play) {
1576                         if (cdr.freeze_ver < 0x63647202)
1577                                 memcpy(cdr.SetSectorPlay, cdr.SetSector, 3);
1578
1579                         Find_CurTrack(cdr.SetSectorPlay);
1580                         if (!Config.Cdda)
1581                                 CDR_play(cdr.SetSectorPlay);
1582                 }
1583
1584                 if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
1585                         // old versions did not latch Reg2, have to fixup..
1586                         if (cdr.Reg2 == 0) {
1587                                 SysPrintf("cdrom: fixing up old savestate\n");
1588                                 cdr.Reg2 = 7;
1589                         }
1590                         // also did not save Attenuator..
1591                         if ((cdr.AttenuatorLeftToLeft | cdr.AttenuatorLeftToRight
1592                              | cdr.AttenuatorRightToLeft | cdr.AttenuatorRightToRight) == 0)
1593                         {
1594                                 cdr.AttenuatorLeftToLeft = cdr.AttenuatorRightToRight = 0x80;
1595                         }
1596                 }
1597         }
1598
1599         return 0;
1600 }
1601
1602 void LidInterrupt() {
1603         getCdInfo();
1604         StopCdda();
1605         cdrLidSeekInterrupt();
1606 }