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