notaz.gp2x.de / pcsx_rearmed.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
One more on odd lines for PAL HSYNC (#224)
[pcsx_rearmed.git] / libpcsxcore / cdrom.c
CommitLineData
ef79bbde
P		 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., *
22bbabf6 17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
ef79bbde
P		 18 ***************************************************************************/
19
22bbabf6 20/*
ef79bbde
P		 21* Handles all CD-ROM registers and functions.
22*/
23
24#include "cdrom.h"
25#include "ppf.h"
9f8b032d 26#include "psxdma.h"
8f2bb0cb 27#include "arm_features.h"
ef79bbde 28
8b380e97 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
ef79bbde 47cdrStruct cdr;
8e1040b6 48static unsigned char *pTransfer;
ef79bbde
P		 49
50/* CD-ROM magic numbers */
1f035e27 51#define CdlSync 0 /* nocash documentation : "Uh, actually, returns error code 40h = Invalid Command...?" */
ef79bbde
P		 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
b0bd140d 61#define CdlReset 10
ef79bbde
P		 62#define CdlMute 11
63#define CdlDemute 12
64#define CdlSetfilter 13
65#define CdlSetmode 14
dcd72441 66#define CdlGetparam 15
ef79bbde
P		 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
b0bd140d 79#define CdlInit 28
e4268a49 80#define CdlGetQ 29
ef79bbde
P		 81#define CdlReadToc 30
82
ef79bbde
P		 83char *CmdName[0x100]= {
84 "CdlSync", "CdlNop", "CdlSetloc", "CdlPlay",
85 "CdlForward", "CdlBackward", "CdlReadN", "CdlStandby",
b0bd140d 86 "CdlStop", "CdlPause", "CdlReset", "CdlMute",
dcd72441 87 "CdlDemute", "CdlSetfilter", "CdlSetmode", "CdlGetparam",
ef79bbde
P		 88 "CdlGetlocL", "CdlGetlocP", "CdlReadT", "CdlGetTN",
89 "CdlGetTD", "CdlSeekL", "CdlSeekP", "CdlSetclock",
90 "CdlGetclock", "CdlTest", "CdlID", "CdlReadS",
b0bd140d 91 "CdlInit", NULL, "CDlReadToc", NULL
ef79bbde
P		 92};
93
94unsigned char Test04[] = { 0 };
95unsigned char Test05[] = { 0 };
96unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
97unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
98unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
99
9f8b032d 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
cd0c9f5b 113#define MODE_SIZE_2048 (0<<4) // 0x00
9f8b032d 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
e4268a49 129/* Errors */
003cfc63 130#define ERROR_NOTREADY (1<<7) // 0x80
e4268a49 131#define ERROR_INVALIDCMD (1<<6) // 0x40
132#define ERROR_INVALIDARG (1<<5) // 0x20
9f8b032d 133
ef79bbde
P		 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
80f91a20 139enum drive_state {
140 DRIVESTATE_STANDBY = 0,
141 DRIVESTATE_LID_OPEN,
142 DRIVESTATE_RESCAN_CD,
143 DRIVESTATE_PREPARE_CD,
e4268a49 144 DRIVESTATE_STOPPED,
80f91a20 145};
146
39df67df 147// for cdr.Seeked
148enum seeked_state {
149 SEEK_PENDING = 0,
150 SEEK_DONE = 1,
39df67df 151};
152
ef79bbde 153static struct CdrStat stat;
ef79bbde 154
fffad32e 155static unsigned int msf2sec(const u8 *msf) {
9f8b032d 156 return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
157}
158
fffad32e 159// for that weird psemu API..
160static unsigned int fsm2sec(const u8 *msf) {
161 return ((msf[2] * 60 + msf[1]) * 75) + msf[0];
162}
163
305c8c93 164static void sec2msf(unsigned int s, u8 *msf) {
9f8b032d 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
39df67df 172// cdrInterrupt
ef79bbde 173#define CDR_INT(eCycle) { \
d28b54b1 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); \
ae602c19 178}
ef79bbde 179
39df67df 180// cdrReadInterrupt
ef79bbde 181#define CDREAD_INT(eCycle) { \
d28b54b1 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); \
ae602c19 186}
ef79bbde 187
39df67df 188// cdrLidSeekInterrupt
9f8b032d 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
39df67df 196// cdrPlayInterrupt
197#define CDRMISC_INT(eCycle) { \
7f457614 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
ef79bbde
P		 204#define StopReading() { \
205 if (cdr.Reading) { \
206 cdr.Reading = 0; \
d28b54b1 207 psxRegs.interrupt &= ~(1 << PSXINT_CDREAD); \
ef79bbde 208 } \
9ffe8d5c 209 cdr.StatP &= ~(STATUS_READ|STATUS_SEEK);\
ef79bbde
P		 210}
211
212#define StopCdda() { \
213 if (cdr.Play) { \
214 if (!Config.Cdda) CDR_stop(); \
9f8b032d 215 cdr.StatP &= ~STATUS_PLAY; \
ef79bbde 216 cdr.Play = FALSE; \
9f8b032d 217 cdr.FastForward = 0; \
218 cdr.FastBackward = 0; \
219 /*SPU_registerCallback( SPUirq );*/ \
ef79bbde
P		 220 } \
221}
222
223#define SetResultSize(size) { \
94c118c3 224 cdr.ResultP = 0; \
ef79bbde
P		 225 cdr.ResultC = size; \
226 cdr.ResultReady = 1; \
227}
228
94c118c3 229static void setIrq(void)
230{
231 if (cdr.Stat & cdr.Reg2)
232 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
233}
9f8b032d 234
80f91a20 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)
9f8b032d 237void cdrLidSeekInterrupt()
238{
80f91a20 239 switch (cdr.DriveState) {
240 default:
241 case DRIVESTATE_STANDBY:
9f8b032d 242 cdr.StatP &= ~STATUS_SEEK;
243
80f91a20 244 if (CDR_getStatus(&stat) == -1)
245 return;
9f8b032d 246
80f91a20 247 if (stat.Status & STATUS_SHELLOPEN)
9f8b032d 248 {
80f91a20 249 StopCdda();
250 cdr.DriveState = DRIVESTATE_LID_OPEN;
251 CDRLID_INT(0x800);
252 }
253 break;
9f8b032d 254
80f91a20 255 case DRIVESTATE_LID_OPEN:
256 if (CDR_getStatus(&stat) == -1)
257 stat.Status &= ~STATUS_SHELLOPEN;
9f8b032d 258
80f91a20 259 // 02, 12, 10
260 if (!(cdr.StatP & STATUS_SHELLOPEN)) {
261 StopReading();
262 cdr.StatP |= STATUS_SHELLOPEN;
9f8b032d 263
80f91a20 264 // could generate error irq here, but real hardware
265 // only sometimes does that
266 // (not done when lots of commands are sent?)
9f8b032d 267
80f91a20 268 CDRLID_INT(cdReadTime * 30);
269 break;
9f8b032d 270 }
80f91a20 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();
9f8b032d 277
80f91a20 278 // cdr.StatP STATUS_SHELLOPEN is "sticky"
279 // and is only cleared by CdlNop
9f8b032d 280
80f91a20 281 cdr.DriveState = DRIVESTATE_RESCAN_CD;
282 CDRLID_INT(cdReadTime * 105);
283 break;
284 }
9f8b032d 285
80f91a20 286 // recheck for close
287 CDRLID_INT(cdReadTime * 3);
288 break;
9f8b032d 289
80f91a20 290 case DRIVESTATE_RESCAN_CD:
291 cdr.StatP |= STATUS_ROTATING;
292 cdr.DriveState = DRIVESTATE_PREPARE_CD;
9f8b032d 293
80f91a20 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;
9f8b032d 298
80f91a20 299 case DRIVESTATE_PREPARE_CD:
300 cdr.StatP |= STATUS_SEEK;
9f8b032d 301
80f91a20 302 cdr.DriveState = DRIVESTATE_STANDBY;
303 CDRLID_INT(cdReadTime * 26);
304 break;
9f8b032d 305 }
306}
307
fffad32e 308static void Find_CurTrack(const u8 *time)
309{
310 int current, sect;
9f8b032d 311
fffad32e 312 current = msf2sec(time);
9f8b032d 313
fffad32e 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)
9f8b032d 318 break;
9f8b032d 319 }
320}
321
73b29eeb 322static 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
371static void ReadTrack(const u8 *time) {
fffad32e 372 unsigned char tmp[3];
373 struct SubQ *subq;
374 u16 crc;
ef79bbde 375
fffad32e 376 tmp[0] = itob(time[0]);
377 tmp[1] = itob(time[1]);
378 tmp[2] = itob(time[2]);
ef79bbde 379
fffad32e 380 if (memcmp(cdr.Prev, tmp, 3) == 0)
381 return;
39df67df 382
fffad32e 383 CDR_LOG("ReadTrack *** %02x:%02x:%02x\n", tmp[0], tmp[1], tmp[2]);
9f8b032d 384
fffad32e 385 cdr.RErr = CDR_readTrack(tmp);
386 memcpy(cdr.Prev, tmp, 3);
9f8b032d 387
fffad32e 388 if (CheckSBI(time))
389 return;
9f8b032d 390
fffad32e 391 subq = (struct SubQ *)CDR_getBufferSub();
73b29eeb 392 if (subq != NULL && cdr.CurTrack == 1) {
fffad32e 393 crc = calcCrc((u8 *)subq + 12, 10);
73b29eeb 394 if (crc == (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
fffad32e 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);
fffad32e 399 }
92ca1ba6 400 else {
73b29eeb 401 CDR_LOG_I("subq bad crc @%02x:%02x:%02x\n",
92ca1ba6 402 tmp[0], tmp[1], tmp[2]);
403 }
9f8b032d 404 }
fffad32e 405 else {
73b29eeb 406 generate_subq(time);
9f8b032d 407 }
9f8b032d 408
fffad32e 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}
9f8b032d 414
e4268a49 415static 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
fffad32e 423 CDR_LOG_I("cdr: override cmd %02x -> %02x\n", cdr.Irq, irq);
e4268a49 424 }
9f8b032d 425
fffad32e 426 cdr.Irq = irq;
427 cdr.eCycle = ecycle;
9f8b032d 428
fffad32e 429 CDR_INT(ecycle);
ef79bbde
P		 430}
431
7f457614 432static void cdrPlayInterrupt_Autopause()
433{
bf4df3ba 434 u32 abs_lev_max = 0;
435 boolean abs_lev_chselect;
436 u32 i;
437 s16 read_buf[CD_FRAMESIZE_RAW/2];
438
fffad32e 439 if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
7f457614 440 CDR_LOG( "CDDA STOP\n" );
7f457614 441
442 // Magic the Gathering
443 // - looping territory cdda
444
445 // ...?
446 //cdr.ResultReady = 1;
447 //cdr.Stat = DataReady;
448 cdr.Stat = DataEnd;
94c118c3 449 setIrq();
7f457614 450
451 StopCdda();
452 }
a02ee86f 453 else if (cdr.Mode & MODE_REPORT) {
bf4df3ba 454 CDR_readCDDA(cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2], (u8 *)read_buf);
7f457614 455
fffad32e 456 cdr.Result[0] = cdr.StatP;
457 cdr.Result[1] = cdr.subq.Track;
458 cdr.Result[2] = cdr.subq.Index;
bf4df3ba 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;
9b470ab7 469
fffad32e 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];
7f457614 474 }
fffad32e 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
bf4df3ba 481 cdr.Result[6] = abs_lev_max >> 0;
482 cdr.Result[7] = abs_lev_max >> 8;
7f457614 483
484 // Rayman: Logo freeze (resultready + dataready)
485 cdr.ResultReady = 1;
486 cdr.Stat = DataReady;
487
488 SetResultSize(8);
94c118c3 489 setIrq();
7f457614 490 }
491}
492
39df67df 493// also handles seek
7f457614 494void cdrPlayInterrupt()
495{
892bd7d4 496 if (cdr.Seeked == SEEK_PENDING) {
e7e33ef2 497 if (cdr.Stat) {
8b380e97 498 CDR_LOG_I("cdrom: seek stat hack\n");
e7e33ef2 499 CDRMISC_INT(0x1000);
500 return;
501 }
39df67df 502 SetResultSize(1);
503 cdr.StatP |= STATUS_ROTATING;
504 cdr.StatP &= ~STATUS_SEEK;
505 cdr.Result[0] = cdr.StatP;
892bd7d4 506 cdr.Seeked = SEEK_DONE;
a34a2445 507 if (cdr.Irq == 0) {
39df67df 508 cdr.Stat = Complete;
94c118c3 509 setIrq();
39df67df 510 }
511
55b8460a 512 if (cdr.SetlocPending) {
513 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
514 cdr.SetlocPending = 0;
dc0ee8d4 515 cdr.m_locationChanged = TRUE;
55b8460a 516 }
fffad32e 517 Find_CurTrack(cdr.SetSectorPlay);
73b29eeb 518 ReadTrack(cdr.SetSectorPlay);
fffad32e 519 cdr.TrackChanged = FALSE;
39df67df 520 }
521
522 if (!cdr.Play) return;
7f457614 523
7f457614 524 CDR_LOG( "CDDA - %d:%d:%d\n",
525 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
8b380e97 526
fffad32e 527 if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
528 StopCdda();
529 cdr.TrackChanged = TRUE;
530 }
7f457614 531
892bd7d4 532 if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
7f457614 533 cdrPlayInterrupt_Autopause();
534
fffad32e 535 if (!cdr.Play) return;
536
7f457614 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
dc0ee8d4 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 }
fffad32e 556
557 // update for CdlGetlocP/autopause
73b29eeb 558 generate_subq(cdr.SetSectorPlay);
7f457614 559}
560
ef79bbde 561void cdrInterrupt() {
e4268a49 562 u16 Irq = cdr.Irq;
563 int no_busy_error = 0;
564 int start_rotating = 0;
565 int error = 0;
566 int delay;
fbf19ce6 567 unsigned int seekTime = 0;
ef79bbde 568
9f8b032d 569 // Reschedule IRQ
ef79bbde 570 if (cdr.Stat) {
8b380e97 571 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
e7e33ef2 572 CDR_INT(0x1000);
ef79bbde
P		 573 return;
574 }
575
ef79bbde
P		 576 cdr.Ctrl &= ~0x80;
577
e4268a49 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
ef79bbde 593 switch (Irq) {
ef79bbde 594 case CdlNop:
80f91a20 595 if (cdr.DriveState != DRIVESTATE_LID_OPEN)
596 cdr.StatP &= ~STATUS_SHELLOPEN;
e4268a49 597 no_busy_error = 1;
ef79bbde
P		 598 break;
599
600 case CdlSetloc:
ef79bbde
P		 601 break;
602
55b8460a 603 do_CdlPlay:
ef79bbde 604 case CdlPlay:
030bd76a 605 StopCdda();
39df67df 606 if (cdr.Seeked == SEEK_PENDING) {
607 // XXX: wrong, should seek instead..
39df67df 608 cdr.Seeked = SEEK_DONE;
9f8b032d 609 }
55b8460a 610 if (cdr.SetlocPending) {
611 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
612 cdr.SetlocPending = 0;
dc0ee8d4 613 cdr.m_locationChanged = TRUE;
55b8460a 614 }
9f8b032d 615
2d5ca6c0 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
9f8b032d 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 */
fffad32e 649 Find_CurTrack(cdr.SetSectorPlay);
73b29eeb 650 ReadTrack(cdr.SetSectorPlay);
fffad32e 651 cdr.TrackChanged = FALSE;
9f8b032d 652
2d5ca6c0 653 if (!Config.Cdda)
654 CDR_play(cdr.SetSectorPlay);
9f8b032d 655
656 // Vib Ribbon: gameplay checks flag
657 cdr.StatP &= ~STATUS_SEEK;
ef79bbde 658 cdr.Result[0] = cdr.StatP;
9f8b032d 659
660 cdr.StatP |= STATUS_PLAY;
9f8b032d 661
662 // BIOS player - set flag again
663 cdr.Play = TRUE;
664
39df67df 665 CDRMISC_INT( cdReadTime );
e4268a49 666 start_rotating = 1;
ef79bbde
P		 667 break;
668
9f8b032d 669 case CdlForward:
e4268a49 670 // TODO: error 80 if stopped
9f8b032d 671 cdr.Stat = Complete;
672
9f8b032d 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;
ef79bbde
P		 678 break;
679
9f8b032d 680 case CdlBackward:
9f8b032d 681 cdr.Stat = Complete;
682
9f8b032d 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;
ef79bbde
P		 688 break;
689
9f8b032d 690 case CdlStandby:
e4268a49 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:
ef79bbde
P		 700 cdr.Stat = Complete;
701 break;
702
703 case CdlStop:
030bd76a 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
e4268a49 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:
9f8b032d 725 cdr.StatP &= ~STATUS_ROTATING;
ef79bbde
P		 726 cdr.Result[0] = cdr.StatP;
727 cdr.Stat = Complete;
ef79bbde
P		 728 break;
729
730 case CdlPause:
12228917 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 */
4e70ea5a 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 * */
e3d555e0 746 if (cdr.DriveState != DRIVESTATE_STANDBY)
747 {
4e70ea5a 748 delay = 7000;
e3d555e0 749 }
750 else
751 {
4e70ea5a 752 delay = (((cdr.Mode & MODE_SPEED) ? 2 : 1) * (1000000));
e3d555e0 753 CDRMISC_INT((cdr.Mode & MODE_SPEED) ? cdReadTime / 2 : cdReadTime);
754 }
755 AddIrqQueue(CdlPause + 0x100, delay);
ef79bbde
P		 756 cdr.Ctrl |= 0x80;
757 break;
758
e4268a49 759 case CdlPause + 0x100:
9f8b032d 760 cdr.StatP &= ~STATUS_READ;
ef79bbde 761 cdr.Result[0] = cdr.StatP;
9f8b032d 762 cdr.Stat = Complete;
ef79bbde
P		 763 break;
764
b0bd140d 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);
e4268a49 769 no_busy_error = 1;
770 start_rotating = 1;
771 break;
772
b0bd140d 773 case CdlReset + 0x100:
9f8b032d 774 cdr.Stat = Complete;
ef79bbde
P		 775 break;
776
9f8b032d 777 case CdlMute:
030bd76a 778 cdr.Muted = TRUE;
ef79bbde
P		 779 break;
780
9f8b032d 781 case CdlDemute:
030bd76a 782 cdr.Muted = FALSE;
ef79bbde
P		 783 break;
784
9f8b032d 785 case CdlSetfilter:
030bd76a 786 cdr.File = cdr.Param[0];
787 cdr.Channel = cdr.Param[1];
9f8b032d 788 break;
ef79bbde
P		 789
790 case CdlSetmode:
e4268a49 791 no_busy_error = 1;
9f8b032d 792 break;
ef79bbde 793
dcd72441 794 case CdlGetparam:
795 /* Gameblabla : According to mednafen, Result size should be 5 and done this way. */
796 SetResultSize(5);
9f8b032d 797 cdr.Result[1] = cdr.Mode;
dcd72441 798 cdr.Result[2] = 0;
799 cdr.Result[3] = cdr.File;
800 cdr.Result[4] = cdr.Channel;
e4268a49 801 no_busy_error = 1;
9f8b032d 802 break;
ef79bbde 803
9f8b032d 804 case CdlGetlocL:
ef79bbde 805 SetResultSize(8);
e4268a49 806 memcpy(cdr.Result, cdr.Transfer, 8);
9f8b032d 807 break;
ef79bbde
P		 808
809 case CdlGetlocP:
fffad32e 810 SetResultSize(8);
811 memcpy(&cdr.Result, &cdr.subq, 8);
ef79bbde 812
892bd7d4 813 if (!cdr.Play && !cdr.Reading)
814 cdr.Result[1] = 0; // HACK?
e4268a49 815 break;
892bd7d4 816
e4268a49 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;
ef79bbde
P		 825 break;
826
9f8b032d 827 case CdlGetTN:
ef79bbde 828 SetResultSize(3);
9f8b032d 829 if (CDR_getTN(cdr.ResultTN) == -1) {
ef79bbde 830 cdr.Stat = DiskError;
9f8b032d 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;
ef79bbde 838
9f8b032d 839 case CdlGetTD:
ef79bbde
P		 840 cdr.Track = btoi(cdr.Param[0]);
841 SetResultSize(4);
ef79bbde
P		 842 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
843 cdr.Stat = DiskError;
9f8b032d 844 cdr.Result[0] |= STATUS_ERROR;
ef79bbde
P		 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]);
cfeb7cab 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]);
ef79bbde
P		 853 }
854 break;
855
9f8b032d 856 case CdlSeekL:
39df67df 857 case CdlSeekP:
030bd76a 858 StopCdda();
859 StopReading();
9f8b032d 860 cdr.StatP |= STATUS_SEEK;
9f8b032d 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 */
39df67df 875 CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
892bd7d4 876 cdr.Seeked = SEEK_PENDING;
e4268a49 877 start_rotating = 1;
ef79bbde
P		 878 break;
879
880 case CdlTest:
9f8b032d 881 switch (cdr.Param[0]) {
882 case 0x20: // System Controller ROM Version
ef79bbde
P		 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;
9f8b032d 894 }
e4268a49 895 no_busy_error = 1;
ef79bbde
P		 896 break;
897
9f8b032d 898 case CdlID:
e4268a49 899 AddIrqQueue(CdlID + 0x100, 20480);
ef79bbde
P		 900 break;
901
e4268a49 902 case CdlID + 0x100:
ef79bbde 903 SetResultSize(8);
89ec56af 904 cdr.Result[0] = cdr.StatP;
905 cdr.Result[1] = 0;
906 cdr.Result[2] = 0;
907 cdr.Result[3] = 0;
9f8b032d 908
d8432250 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;
9f8b032d 912 }
913 else {
89ec56af 914 if (stat.Type == 2)
915 cdr.Result[1] |= 0x10;
916 if (CdromId[0] == '\0')
9f8b032d 917 cdr.Result[1] |= 0x80;
9f8b032d 918 }
89ec56af 919 cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
9f8b032d 920
ef79bbde
P		 921 strncpy((char *)&cdr.Result[4], "PCSX", 4);
922 cdr.Stat = Complete;
923 break;
924
b0bd140d 925 case CdlInit:
e4268a49 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;
9f8b032d 932 break;
933
e4268a49 934 case CdlGetQ:
6360a61b 935 no_busy_error = 1;
9f8b032d 936 break;
937
938 case CdlReadToc:
e4268a49 939 AddIrqQueue(CdlReadToc + 0x100, cdReadTime * 180 / 4);
940 no_busy_error = 1;
941 start_rotating = 1;
ef79bbde
P		 942 break;
943
e4268a49 944 case CdlReadToc + 0x100:
9f8b032d 945 cdr.Stat = Complete;
e4268a49 946 no_busy_error = 1;
ef79bbde
P		 947 break;
948
94c118c3 949 case CdlReadN:
950 case CdlReadS:
55b8460a 951 if (cdr.SetlocPending) {
fbf19ce6 952 seekTime = abs(msf2sec(cdr.SetSectorPlay) - msf2sec(cdr.SetSector)) * (cdReadTime / 200);
953 if(seekTime > 1000000) seekTime = 1000000;
55b8460a 954 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
955 cdr.SetlocPending = 0;
dc0ee8d4 956 cdr.m_locationChanged = TRUE;
55b8460a 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
030bd76a 964 cdr.Reading = 1;
965 cdr.FirstSector = 1;
ef79bbde 966
9f8b032d 967 // Fighting Force 2 - update subq time immediately
968 // - fixes new game
55b8460a 969 ReadTrack(cdr.SetSectorPlay);
9f8b032d 970
971
972 // Crusaders of Might and Magic - update getlocl now
973 // - fixes cutscene speech
974 {
975 u8 *buf = CDR_getBuffer();
a48ae3a7 976 if (buf != NULL)
977 memcpy(cdr.Transfer, buf, 8);
9f8b032d 978 }
39df67df 979
9f8b032d 980 /*
981 Duke Nukem: Land of the Babes - seek then delay read for one frame
982 - fixes cutscenes
914722b2 983 C-12 - Final Resistance - doesn't like seek
9f8b032d 984 */
985
39df67df 986 if (cdr.Seeked != SEEK_DONE) {
9f8b032d 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
fbf19ce6 994 CDREAD_INT(((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1) + seekTime);
9f8b032d 995 } else {
996 cdr.StatP |= STATUS_READ;
997 cdr.StatP &= ~STATUS_SEEK;
998
999 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
1000 }
ef79bbde 1001
9f8b032d 1002 cdr.Result[0] = cdr.StatP;
e4268a49 1003 start_rotating = 1;
ef79bbde 1004 break;
1f035e27 1005 case CdlSync:
ef79bbde 1006 default:
e4268a49 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;
ef79bbde
P		 1016 break;
1017 }
1018
e4268a49 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) {
80f91a20 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;
003cfc63 1031 cdr.Result[1] = ERROR_NOTREADY;
80f91a20 1032 cdr.Stat = DiskError;
1033 break;
1034 }
1035 }
9f8b032d 1036
e4268a49 1037finish:
94c118c3 1038 setIrq();
e4268a49 1039 cdr.ParamC = 0;
ef79bbde 1040
8b380e97 1041#ifdef CDR_LOG_CMD_IRQ
e4268a49 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 }
ef79bbde
P		 1050#endif
1051}
1052
8f2bb0cb 1053#ifdef HAVE_ARMV7
53598a71 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
1063void 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
ef79bbde
P		 1101void cdrReadInterrupt() {
1102 u8 *buf;
1103
1104 if (!cdr.Reading)
1105 return;
1106
9f8b032d 1107 if (cdr.Irq || cdr.Stat) {
8b380e97 1108 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
e7e33ef2 1109 CDREAD_INT(0x1000);
ef79bbde
P		 1110 return;
1111 }
1112
9f8b032d 1113 cdr.OCUP = 1;
ef79bbde 1114 SetResultSize(1);
9f8b032d 1115 cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1116 cdr.StatP &= ~STATUS_SEEK;
1117 cdr.Result[0] = cdr.StatP;
39df67df 1118 cdr.Seeked = SEEK_DONE;
ef79bbde 1119
55b8460a 1120 ReadTrack(cdr.SetSectorPlay);
ef79bbde
P		 1121
1122 buf = CDR_getBuffer();
1123 if (buf == NULL)
1124 cdr.RErr = -1;
1125
1126 if (cdr.RErr == -1) {
8b380e97 1127 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
ef79bbde
P		 1128 memset(cdr.Transfer, 0, DATA_SIZE);
1129 cdr.Stat = DiskError;
9f8b032d 1130 cdr.Result[0] |= STATUS_ERROR;
ef79bbde
P		 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
ef79bbde 1138
8b380e97 1139 CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
ef79bbde 1140
9f8b032d 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
e73e384c 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 * */
cd0c9f5b 1153 if((cdr.Transfer[4 + 2] & 0x4) &&
9f8b032d 1154 (cdr.Transfer[4 + 1] == cdr.Channel) &&
e73e384c 1155 (cdr.Transfer[4 + 0] == cdr.File) && cdr.Channel != 255) {
ef79bbde 1156 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
ef79bbde 1157 if (!ret) {
53598a71 1158 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
ef79bbde
P		 1159 SPU_playADPCMchannel(&cdr.Xa);
1160 cdr.FirstSector = 0;
1161 }
1162 else cdr.FirstSector = -1;
1163 }
1164 }
1165
55b8460a 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]++;
9f8b032d 1173 }
1174 }
1175
1176 cdr.Readed = 0;
1177
dc0ee8d4 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 }
9f8b032d 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
a34a2445 1192 if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
9f8b032d 1193 cdr.Stat = DataReady;
a34a2445 1194 setIrq();
ef79bbde 1195 }
9f8b032d 1196
fffad32e 1197 // update for CdlGetlocP
55b8460a 1198 ReadTrack(cdr.SetSectorPlay);
ef79bbde
P		 1199}
1200
1201/*
1202cdrRead0:
94c118c3 1203 bit 0,1 - mode
ef79bbde
P		 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
1212unsigned 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
8b380e97 1226 CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
ef79bbde
P		 1227
1228 return psxHu8(0x1800) = cdr.Ctrl;
1229}
1230
ef79bbde 1231void cdrWrite0(unsigned char rt) {
8b380e97 1232 CDR_LOG_IO("cdr w0: %02x\n", rt);
1233
50b13be9 1234 cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
ef79bbde
P		 1235}
1236
1237unsigned char cdrRead1(void) {
94c118c3 1238 if ((cdr.ResultP & 0xf) < cdr.ResultC)
9f8b032d 1239 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
94c118c3 1240 else
ef79bbde 1241 psxHu8(0x1801) = 0;
94c118c3 1242 cdr.ResultP++;
1243 if (cdr.ResultP == cdr.ResultC)
1244 cdr.ResultReady = 0;
1245
8b380e97 1246 CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1247
ef79bbde
P		 1248 return psxHu8(0x1801);
1249}
1250
1251void cdrWrite1(unsigned char rt) {
305c8c93 1252 u8 set_loc[3];
ef79bbde
P		 1253 int i;
1254
8b380e97 1255 CDR_LOG_IO("cdr w1: %02x\n", rt);
9f8b032d 1256
94c118c3 1257 switch (cdr.Ctrl & 3) {
1258 case 0:
1259 break;
1260 case 3:
53598a71 1261 cdr.AttenuatorRightToRightT = rt;
94c118c3 1262 return;
1263 default:
1264 return;
9f8b032d 1265 }
1266
9f8b032d 1267 cdr.Cmd = rt;
ef79bbde
P		 1268 cdr.OCUP = 0;
1269
8b380e97 1270#ifdef CDR_LOG_CMD_IRQ
89ec56af 1271 SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
ef79bbde
P		 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
2daaaae3 1282 cdr.ResultReady = 0;
94c118c3 1283 cdr.Ctrl |= 0x80;
1284 // cdr.Stat = NoIntr;
1285 AddIrqQueue(cdr.Cmd, 0x800);
2daaaae3 1286
9f8b032d 1287 switch (cdr.Cmd) {
94c118c3 1288 case CdlSetloc:
449968ef 1289 CDR_LOG("CDROM setloc command (%02X, %02X, %02X)\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
39df67df 1290
449968ef 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 }
39df67df 1302
449968ef 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 }
94c118c3 1312 break;
ef79bbde 1313
94c118c3 1314 case CdlReadN:
030bd76a 1315 case CdlReadS:
94c118c3 1316 case CdlPause:
9f8b032d 1317 StopCdda();
1318 StopReading();
9f8b032d 1319 break;
1320
94c118c3 1321 case CdlInit:
b0bd140d 1322 case CdlReset:
39df67df 1323 cdr.Seeked = SEEK_DONE;
9f8b032d 1324 StopCdda();
1325 StopReading();
94c118c3 1326 break;
9f8b032d 1327
ef79bbde 1328 case CdlSetmode:
9f8b032d 1329 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
8b380e97 1330
ef79bbde 1331 cdr.Mode = cdr.Param[0];
9f8b032d 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();
ef79bbde 1337 break;
9f8b032d 1338 }
ef79bbde
P		 1339}
1340
1341unsigned char cdrRead2(void) {
1342 unsigned char ret;
1343
1344 if (cdr.Readed == 0) {
1345 ret = 0;
1346 } else {
8e1040b6 1347 ret = *pTransfer++;
ef79bbde
P		 1348 }
1349
8b380e97 1350 CDR_LOG_IO("cdr r2: %02x\n", ret);
ef79bbde
P		 1351 return ret;
1352}
1353
1354void cdrWrite2(unsigned char rt) {
8b380e97 1355 CDR_LOG_IO("cdr w2: %02x\n", rt);
9f8b032d 1356
94c118c3 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:
53598a71 1367 cdr.AttenuatorLeftToLeftT = rt;
94c118c3 1368 return;
1369 case 3:
53598a71 1370 cdr.AttenuatorRightToLeftT = rt;
94c118c3 1371 return;
ef79bbde
P		 1372 }
1373}
1374
1375unsigned char cdrRead3(void) {
94c118c3 1376 if (cdr.Ctrl & 0x1)
1377 psxHu8(0x1803) = cdr.Stat | 0xE0;
1378 else
1379 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
8b380e97 1380
1381 CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
ef79bbde
P		 1382 return psxHu8(0x1803);
1383}
1384
1385void cdrWrite3(unsigned char rt) {
8b380e97 1386 CDR_LOG_IO("cdr w3: %02x\n", rt);
056d6759 1387
94c118c3 1388 switch (cdr.Ctrl & 3) {
1389 case 0:
a34a2445 1390 break; // transfer
94c118c3 1391 case 1:
a34a2445 1392 cdr.Stat &= ~rt;
1393
1394 if (rt & 0x40)
1395 cdr.ParamC = 0;
1396 return;
94c118c3 1397 case 2:
53598a71 1398 cdr.AttenuatorLeftToRightT = rt;
94c118c3 1399 return;
1400 case 3:
53598a71 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 }
94c118c3 1407 return;
9f8b032d 1408 }
056d6759 1409
94c118c3 1410 if ((rt & 0x80) && cdr.Readed == 0) {
ef79bbde 1411 cdr.Readed = 1;
8e1040b6 1412 pTransfer = cdr.Transfer;
ef79bbde
P		 1413
1414 switch (cdr.Mode & 0x30) {
9f8b032d 1415 case MODE_SIZE_2328:
ef79bbde 1416 case 0x00:
8e1040b6 1417 pTransfer += 12;
ef79bbde 1418 break;
9f8b032d 1419
1420 case MODE_SIZE_2340:
8e1040b6 1421 pTransfer += 0;
9f8b032d 1422 break;
1423
ef79bbde
P		 1424 default:
1425 break;
1426 }
1427 }
1428}
1429
1430void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1431 u32 cdsize;
c7071c43 1432 int size;
ef79bbde
P		 1433 u8 *ptr;
1434
ef79bbde 1435 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
ef79bbde
P		 1436
1437 switch (chcr) {
1438 case 0x11000000:
1439 case 0x11400100:
1440 if (cdr.Readed == 0) {
ef79bbde 1441 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
ef79bbde
P		 1442 break;
1443 }
1444
1445 cdsize = (bcr & 0xffff) * 4;
1446
9f8b032d 1447 // Ape Escape: bcr = 0001 / 0000
1448 // - fix boot
1449 if( cdsize == 0 )
1450 {
cd0c9f5b 1451 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
9f8b032d 1452 case MODE_SIZE_2340: cdsize = 2340; break;
cd0c9f5b 1453 case MODE_SIZE_2328: cdsize = 2328; break;
1454 default:
1455 case MODE_SIZE_2048: cdsize = 2048; break;
9f8b032d 1456 }
1457 }
1458
1459
ef79bbde
P		 1460 ptr = (u8 *)PSXM(madr);
1461 if (ptr == NULL) {
ef79bbde 1462 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
ef79bbde
P		 1463 break;
1464 }
9f8b032d 1465
1466 /*
1467 GS CDX: Enhancement CD crash
1468 - Setloc 0:0:0
1469 - CdlPlay
1470 - Spams DMA3 and gets buffer overrun
1471 */
8e1040b6 1472 size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
c7071c43 1473 if (size > cdsize)
1474 size = cdsize;
1475 if (size > 0)
9f8b032d 1476 {
8e1040b6 1477 memcpy(ptr, pTransfer, size);
9f8b032d 1478 }
1479
ef79bbde 1480 psxCpu->Clear(madr, cdsize / 4);
8e1040b6 1481 pTransfer += cdsize;
9f8b032d 1482
9f8b032d 1483 if( chcr == 0x11400100 ) {
58ebb94c 1484 HW_DMA3_MADR = SWAPu32(madr + cdsize);
9f8b032d 1485 CDRDMA_INT( (cdsize/4) / 4 );
1486 }
1487 else if( chcr == 0x11000000 ) {
fc4803bd 1488 // CDRDMA_INT( (cdsize/4) * 1 );
1489 // halted
1490 psxRegs.cycle += (cdsize/4) * 24/2;
1491 CDRDMA_INT(16);
9f8b032d 1492 }
1493 return;
1494
ef79bbde 1495 default:
ef79bbde 1496 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
ef79bbde
P		 1497 break;
1498 }
1499
1500 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1501 DMA_INTERRUPT(3);
1502}
1503
9f8b032d 1504void cdrDmaInterrupt()
1505{
ad418c19 1506 if (HW_DMA3_CHCR & SWAP32(0x01000000))
1507 {
1508 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1509 DMA_INTERRUPT(3);
1510 }
9f8b032d 1511}
1512
fffad32e 1513static 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
ef79bbde
P		 1524void cdrReset() {
1525 memset(&cdr, 0, sizeof(cdr));
1526 cdr.CurTrack = 1;
1527 cdr.File = 1;
1528 cdr.Channel = 1;
a2d3ccb8 1529 cdr.Reg2 = 0x1f;
1530 cdr.Stat = NoIntr;
80f91a20 1531 cdr.DriveState = DRIVESTATE_STANDBY;
22bbabf6 1532 cdr.StatP = STATUS_ROTATING;
8e1040b6 1533 pTransfer = cdr.Transfer;
dc0ee8d4 1534 cdr.SetlocPending = 0;
1535 cdr.m_locationChanged = FALSE;
056d6759 1536
1537 // BIOS player - default values
53598a71 1538 cdr.AttenuatorLeftToLeft = 0x80;
1539 cdr.AttenuatorLeftToRight = 0x00;
1540 cdr.AttenuatorRightToLeft = 0x00;
1541 cdr.AttenuatorRightToRight = 0x80;
fffad32e 1542
1543 getCdInfo();
ef79bbde
P		 1544}
1545
496d88d4 1546int cdrFreeze(void *f, int Mode) {
8e1040b6 1547 u32 tmp;
fffad32e 1548 u8 tmpp[3];
ef79bbde 1549
fffad32e 1550 if (Mode == 0 && !Config.Cdda)
1551 CDR_stop();
9f8b032d 1552
55b8460a 1553 cdr.freeze_ver = 0x63647202;
9f8b032d 1554 gzfreeze(&cdr, sizeof(cdr));
1555
94c118c3 1556 if (Mode == 1) {
1557 cdr.ParamP = cdr.ParamC;
8e1040b6 1558 tmp = pTransfer - cdr.Transfer;
94c118c3 1559 }
ef79bbde
P		 1560
1561 gzfreeze(&tmp, sizeof(tmp));
1562
42f3c512 1563 if (Mode == 0) {
fffad32e 1564 getCdInfo();
1565
8e1040b6 1566 pTransfer = cdr.Transfer + tmp;
ef79bbde 1567
fffad32e 1568 // read right sub data
f84d4864
DS		 1569 tmpp[0] = btoi(cdr.Prev[0]);
1570 tmpp[1] = btoi(cdr.Prev[1]);
1571 tmpp[2] = btoi(cdr.Prev[2]);
fffad32e 1572 cdr.Prev[0]++;
73b29eeb 1573 ReadTrack(tmpp);
fffad32e 1574
1575 if (cdr.Play) {
55b8460a 1576 if (cdr.freeze_ver < 0x63647202)
1577 memcpy(cdr.SetSectorPlay, cdr.SetSector, 3);
1578
fffad32e 1579 Find_CurTrack(cdr.SetSectorPlay);
1580 if (!Config.Cdda)
1581 CDR_play(cdr.SetSectorPlay);
1582 }
c69642c8 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 }
0f2dee0f 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 }
c69642c8 1596 }
42f3c512 1597 }
1598
ef79bbde
P		 1599 return 0;
1600}
9f8b032d 1601
1602void LidInterrupt() {
fffad32e 1603 getCdInfo();
fffad32e 1604 StopCdda();
80f91a20 1605 cdrLidSeekInterrupt();
9f8b032d 1606}
ARM optimized PCSX fork