notaz.gp2x.de / pcsx_rearmed.git / blame_incremental
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (non-incremental) | history | HEAD
Improve CdlPause command based on Mednafen's implementation (#207)
[pcsx_rearmed.git] / libpcsxcore / cdrom.c
... / ...
CommitLineData
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
47cdrStruct cdr;
48static 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
83char *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
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
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
139enum 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
148enum seeked_state {
149 SEEK_PENDING = 0,
150 SEEK_DONE = 1,
151};
152
153static struct CdrStat stat;
154
155static unsigned int msf2sec(const u8 *msf) {
156 return ((msf[0] * 60 + msf[1]) * 75) + msf[2];
157}
158
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
164static 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
229static 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)
237void 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
308static 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
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) {
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
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
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
432static void cdrPlayInterrupt_Autopause()
433{
434 if ((cdr.Mode & MODE_AUTOPAUSE) && cdr.TrackChanged) {
435 CDR_LOG( "CDDA STOP\n" );
436
437 // Magic the Gathering
438 // - looping territory cdda
439
440 // ...?
441 //cdr.ResultReady = 1;
442 //cdr.Stat = DataReady;
443 cdr.Stat = DataEnd;
444 setIrq();
445
446 StopCdda();
447 }
448 else if (cdr.Mode & MODE_REPORT) {
449
450 cdr.Result[0] = cdr.StatP;
451 cdr.Result[1] = cdr.subq.Track;
452 cdr.Result[2] = cdr.subq.Index;
453
454 if (cdr.subq.Absolute[2] & 0x10) {
455 cdr.Result[3] = cdr.subq.Relative[0];
456 cdr.Result[4] = cdr.subq.Relative[1] | 0x80;
457 cdr.Result[5] = cdr.subq.Relative[2];
458 }
459 else {
460 cdr.Result[3] = cdr.subq.Absolute[0];
461 cdr.Result[4] = cdr.subq.Absolute[1];
462 cdr.Result[5] = cdr.subq.Absolute[2];
463 }
464
465 cdr.Result[6] = 0;
466 cdr.Result[7] = 0;
467
468 // Rayman: Logo freeze (resultready + dataready)
469 cdr.ResultReady = 1;
470 cdr.Stat = DataReady;
471
472 SetResultSize(8);
473 setIrq();
474 }
475}
476
477// also handles seek
478void cdrPlayInterrupt()
479{
480 if (cdr.Seeked == SEEK_PENDING) {
481 if (cdr.Stat) {
482 CDR_LOG_I("cdrom: seek stat hack\n");
483 CDRMISC_INT(0x1000);
484 return;
485 }
486 SetResultSize(1);
487 cdr.StatP |= STATUS_ROTATING;
488 cdr.StatP &= ~STATUS_SEEK;
489 cdr.Result[0] = cdr.StatP;
490 cdr.Seeked = SEEK_DONE;
491 if (cdr.Irq == 0) {
492 cdr.Stat = Complete;
493 setIrq();
494 }
495
496 if (cdr.SetlocPending) {
497 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
498 cdr.SetlocPending = 0;
499 cdr.m_locationChanged = TRUE;
500 }
501 Find_CurTrack(cdr.SetSectorPlay);
502 ReadTrack(cdr.SetSectorPlay);
503 cdr.TrackChanged = FALSE;
504 }
505
506 if (!cdr.Play) return;
507
508 CDR_LOG( "CDDA - %d:%d:%d\n",
509 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2] );
510
511 if (memcmp(cdr.SetSectorPlay, cdr.SetSectorEnd, 3) == 0) {
512 StopCdda();
513 cdr.TrackChanged = TRUE;
514 }
515
516 if (!cdr.Irq && !cdr.Stat && (cdr.Mode & (MODE_AUTOPAUSE|MODE_REPORT)))
517 cdrPlayInterrupt_Autopause();
518
519 if (!cdr.Play) return;
520
521 cdr.SetSectorPlay[2]++;
522 if (cdr.SetSectorPlay[2] == 75) {
523 cdr.SetSectorPlay[2] = 0;
524 cdr.SetSectorPlay[1]++;
525 if (cdr.SetSectorPlay[1] == 60) {
526 cdr.SetSectorPlay[1] = 0;
527 cdr.SetSectorPlay[0]++;
528 }
529 }
530
531 if (cdr.m_locationChanged)
532 {
533 CDRMISC_INT(cdReadTime * 30);
534 cdr.m_locationChanged = FALSE;
535 }
536 else
537 {
538 CDRMISC_INT(cdReadTime);
539 }
540
541 // update for CdlGetlocP/autopause
542 generate_subq(cdr.SetSectorPlay);
543}
544
545void cdrInterrupt() {
546 u16 Irq = cdr.Irq;
547 int no_busy_error = 0;
548 int start_rotating = 0;
549 int error = 0;
550 int delay;
551 unsigned int seekTime = 0;
552
553 // Reschedule IRQ
554 if (cdr.Stat) {
555 CDR_LOG_I("cdrom: stat hack: %02x %x\n", cdr.Irq, cdr.Stat);
556 CDR_INT(0x1000);
557 return;
558 }
559
560 cdr.Ctrl &= ~0x80;
561
562 // default response
563 SetResultSize(1);
564 cdr.Result[0] = cdr.StatP;
565 cdr.Stat = Acknowledge;
566
567 if (cdr.IrqRepeated) {
568 cdr.IrqRepeated = 0;
569 if (cdr.eCycle > psxRegs.cycle) {
570 CDR_INT(cdr.eCycle);
571 goto finish;
572 }
573 }
574
575 cdr.Irq = 0;
576
577 switch (Irq) {
578 case CdlNop:
579 if (cdr.DriveState != DRIVESTATE_LID_OPEN)
580 cdr.StatP &= ~STATUS_SHELLOPEN;
581 no_busy_error = 1;
582 break;
583
584 case CdlSetloc:
585 break;
586
587 do_CdlPlay:
588 case CdlPlay:
589 StopCdda();
590 if (cdr.Seeked == SEEK_PENDING) {
591 // XXX: wrong, should seek instead..
592 cdr.Seeked = SEEK_DONE;
593 }
594 if (cdr.SetlocPending) {
595 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
596 cdr.SetlocPending = 0;
597 cdr.m_locationChanged = TRUE;
598 }
599
600 // BIOS CD Player
601 // - Pause player, hit Track 01/02/../xx (Setloc issued!!)
602
603 if (cdr.ParamC == 0 || cdr.Param[0] == 0) {
604 CDR_LOG("PLAY Resume @ %d:%d:%d\n",
605 cdr.SetSectorPlay[0], cdr.SetSectorPlay[1], cdr.SetSectorPlay[2]);
606 }
607 else
608 {
609 int track = btoi( cdr.Param[0] );
610
611 if (track <= cdr.ResultTN[1])
612 cdr.CurTrack = track;
613
614 CDR_LOG("PLAY track %d\n", cdr.CurTrack);
615
616 if (CDR_getTD((u8)cdr.CurTrack, cdr.ResultTD) != -1) {
617 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
618 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
619 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
620 }
621 }
622
623 /*
624 Rayman: detect track changes
625 - fixes logo freeze
626
627 Twisted Metal 2: skip PREGAP + starting accurate SubQ
628 - plays tracks without retry play
629
630 Wild 9: skip PREGAP + starting accurate SubQ
631 - plays tracks without retry play
632 */
633 Find_CurTrack(cdr.SetSectorPlay);
634 ReadTrack(cdr.SetSectorPlay);
635 cdr.TrackChanged = FALSE;
636
637 if (!Config.Cdda)
638 CDR_play(cdr.SetSectorPlay);
639
640 // Vib Ribbon: gameplay checks flag
641 cdr.StatP &= ~STATUS_SEEK;
642 cdr.Result[0] = cdr.StatP;
643
644 cdr.StatP |= STATUS_PLAY;
645
646 // BIOS player - set flag again
647 cdr.Play = TRUE;
648
649 CDRMISC_INT( cdReadTime );
650 start_rotating = 1;
651 break;
652
653 case CdlForward:
654 // TODO: error 80 if stopped
655 cdr.Stat = Complete;
656
657 // GameShark CD Player: Calls 2x + Play 2x
658 if( cdr.FastForward == 0 ) cdr.FastForward = 2;
659 else cdr.FastForward++;
660
661 cdr.FastBackward = 0;
662 break;
663
664 case CdlBackward:
665 cdr.Stat = Complete;
666
667 // GameShark CD Player: Calls 2x + Play 2x
668 if( cdr.FastBackward == 0 ) cdr.FastBackward = 2;
669 else cdr.FastBackward++;
670
671 cdr.FastForward = 0;
672 break;
673
674 case CdlStandby:
675 if (cdr.DriveState != DRIVESTATE_STOPPED) {
676 error = ERROR_INVALIDARG;
677 goto set_error;
678 }
679 AddIrqQueue(CdlStandby + 0x100, cdReadTime * 125 / 2);
680 start_rotating = 1;
681 break;
682
683 case CdlStandby + 0x100:
684 cdr.Stat = Complete;
685 break;
686
687 case CdlStop:
688 if (cdr.Play) {
689 // grab time for current track
690 CDR_getTD((u8)(cdr.CurTrack), cdr.ResultTD);
691
692 cdr.SetSectorPlay[0] = cdr.ResultTD[2];
693 cdr.SetSectorPlay[1] = cdr.ResultTD[1];
694 cdr.SetSectorPlay[2] = cdr.ResultTD[0];
695 }
696
697 StopCdda();
698 StopReading();
699
700 delay = 0x800;
701 if (cdr.DriveState == DRIVESTATE_STANDBY)
702 delay = cdReadTime * 30 / 2;
703
704 cdr.DriveState = DRIVESTATE_STOPPED;
705 AddIrqQueue(CdlStop + 0x100, delay);
706 break;
707
708 case CdlStop + 0x100:
709 cdr.StatP &= ~STATUS_ROTATING;
710 cdr.Result[0] = cdr.StatP;
711 cdr.Stat = Complete;
712 break;
713
714 case CdlPause:
715 /*
716 Gundam Battle Assault 2: much slower (*)
717 - Fixes boot, gameplay
718
719 Hokuto no Ken 2: slower
720 - Fixes intro + subtitles
721
722 InuYasha - Feudal Fairy Tale: slower
723 - Fixes battles
724 */
725 /* Gameblabla - Tightening the timings (as taken from Mednafen). */
726 if (cdr.DriveState != DRIVESTATE_STANDBY)
727 {
728 delay = 5000;
729 }
730 else
731 {
732 delay = (1124584 + (msf2sec(cdr.SetSectorPlay) * 42596 / (75 * 60))) * ((cdr.Mode & MODE_SPEED) ? 1 : 2);
733 CDRMISC_INT((cdr.Mode & MODE_SPEED) ? cdReadTime / 2 : cdReadTime);
734 }
735 AddIrqQueue(CdlPause + 0x100, delay);
736 cdr.Ctrl |= 0x80;
737 break;
738
739 case CdlPause + 0x100:
740 cdr.StatP &= ~STATUS_READ;
741 cdr.Result[0] = cdr.StatP;
742 cdr.Stat = Complete;
743 break;
744
745 case CdlReset:
746 cdr.Muted = FALSE;
747 cdr.Mode = 0x20; /* This fixes This is Football 2, Pooh's Party lockups */
748 AddIrqQueue(CdlReset + 0x100, 4100000);
749 no_busy_error = 1;
750 start_rotating = 1;
751 break;
752
753 case CdlReset + 0x100:
754 cdr.Stat = Complete;
755 break;
756
757 case CdlMute:
758 cdr.Muted = TRUE;
759 break;
760
761 case CdlDemute:
762 cdr.Muted = FALSE;
763 break;
764
765 case CdlSetfilter:
766 cdr.File = cdr.Param[0];
767 cdr.Channel = cdr.Param[1];
768 break;
769
770 case CdlSetmode:
771 no_busy_error = 1;
772 break;
773
774 case CdlGetparam:
775 /* Gameblabla : According to mednafen, Result size should be 5 and done this way. */
776 SetResultSize(5);
777 cdr.Result[1] = cdr.Mode;
778 cdr.Result[2] = 0;
779 cdr.Result[3] = cdr.File;
780 cdr.Result[4] = cdr.Channel;
781 no_busy_error = 1;
782 break;
783
784 case CdlGetlocL:
785 SetResultSize(8);
786 memcpy(cdr.Result, cdr.Transfer, 8);
787 break;
788
789 case CdlGetlocP:
790 SetResultSize(8);
791 memcpy(&cdr.Result, &cdr.subq, 8);
792
793 if (!cdr.Play && !cdr.Reading)
794 cdr.Result[1] = 0; // HACK?
795 break;
796
797 case CdlReadT: // SetSession?
798 // really long
799 AddIrqQueue(CdlReadT + 0x100, cdReadTime * 290 / 4);
800 start_rotating = 1;
801 break;
802
803 case CdlReadT + 0x100:
804 cdr.Stat = Complete;
805 break;
806
807 case CdlGetTN:
808 SetResultSize(3);
809 if (CDR_getTN(cdr.ResultTN) == -1) {
810 cdr.Stat = DiskError;
811 cdr.Result[0] |= STATUS_ERROR;
812 } else {
813 cdr.Stat = Acknowledge;
814 cdr.Result[1] = itob(cdr.ResultTN[0]);
815 cdr.Result[2] = itob(cdr.ResultTN[1]);
816 }
817 break;
818
819 case CdlGetTD:
820 cdr.Track = btoi(cdr.Param[0]);
821 SetResultSize(4);
822 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
823 cdr.Stat = DiskError;
824 cdr.Result[0] |= STATUS_ERROR;
825 } else {
826 cdr.Stat = Acknowledge;
827 cdr.Result[0] = cdr.StatP;
828 cdr.Result[1] = itob(cdr.ResultTD[2]);
829 cdr.Result[2] = itob(cdr.ResultTD[1]);
830 /* According to Nocash's documentation, the function doesn't care about ff.
831 * This can be seen also in Mednafen's implementation. */
832 //cdr.Result[3] = itob(cdr.ResultTD[0]);
833 }
834 break;
835
836 case CdlSeekL:
837 case CdlSeekP:
838 StopCdda();
839 StopReading();
840 cdr.StatP |= STATUS_SEEK;
841
842 /*
843 Crusaders of Might and Magic = 0.5x-4x
844 - fix cutscene speech start
845
846 Eggs of Steel = 2x-?
847 - fix new game
848
849 Medievil = ?-4x
850 - fix cutscene speech
851
852 Rockman X5 = 0.5-4x
853 - fix capcom logo
854 */
855 CDRMISC_INT(cdr.Seeked == SEEK_DONE ? 0x800 : cdReadTime * 4);
856 cdr.Seeked = SEEK_PENDING;
857 start_rotating = 1;
858 break;
859
860 case CdlTest:
861 switch (cdr.Param[0]) {
862 case 0x20: // System Controller ROM Version
863 SetResultSize(4);
864 memcpy(cdr.Result, Test20, 4);
865 break;
866 case 0x22:
867 SetResultSize(8);
868 memcpy(cdr.Result, Test22, 4);
869 break;
870 case 0x23: case 0x24:
871 SetResultSize(8);
872 memcpy(cdr.Result, Test23, 4);
873 break;
874 }
875 no_busy_error = 1;
876 break;
877
878 case CdlID:
879 AddIrqQueue(CdlID + 0x100, 20480);
880 break;
881
882 case CdlID + 0x100:
883 SetResultSize(8);
884 cdr.Result[0] = cdr.StatP;
885 cdr.Result[1] = 0;
886 cdr.Result[2] = 0;
887 cdr.Result[3] = 0;
888
889 // 0x10 - audio | 0x40 - disk missing | 0x80 - unlicensed
890 if (CDR_getStatus(&stat) == -1 || stat.Type == 0 || stat.Type == 0xff) {
891 cdr.Result[1] = 0xc0;
892 }
893 else {
894 if (stat.Type == 2)
895 cdr.Result[1] |= 0x10;
896 if (CdromId[0] == '\0')
897 cdr.Result[1] |= 0x80;
898 }
899 cdr.Result[0] |= (cdr.Result[1] >> 4) & 0x08;
900
901 strncpy((char *)&cdr.Result[4], "PCSX", 4);
902 cdr.Stat = Complete;
903 break;
904
905 case CdlInit:
906 // yes, it really sets STATUS_SHELLOPEN
907 cdr.StatP |= STATUS_SHELLOPEN;
908 cdr.DriveState = DRIVESTATE_RESCAN_CD;
909 CDRLID_INT(20480);
910 no_busy_error = 1;
911 start_rotating = 1;
912 break;
913
914 case CdlGetQ:
915 no_busy_error = 1;
916 break;
917
918 case CdlReadToc:
919 AddIrqQueue(CdlReadToc + 0x100, cdReadTime * 180 / 4);
920 no_busy_error = 1;
921 start_rotating = 1;
922 break;
923
924 case CdlReadToc + 0x100:
925 cdr.Stat = Complete;
926 no_busy_error = 1;
927 break;
928
929 case CdlReadN:
930 case CdlReadS:
931 if (cdr.SetlocPending) {
932 seekTime = abs(msf2sec(cdr.SetSectorPlay) - msf2sec(cdr.SetSector)) * (cdReadTime / 200);
933 if(seekTime > 1000000) seekTime = 1000000;
934 memcpy(cdr.SetSectorPlay, cdr.SetSector, 4);
935 cdr.SetlocPending = 0;
936 cdr.m_locationChanged = TRUE;
937 }
938 Find_CurTrack(cdr.SetSectorPlay);
939
940 if ((cdr.Mode & MODE_CDDA) && cdr.CurTrack > 1)
941 // Read* acts as play for cdda tracks in cdda mode
942 goto do_CdlPlay;
943
944 cdr.Reading = 1;
945 cdr.FirstSector = 1;
946
947 // Fighting Force 2 - update subq time immediately
948 // - fixes new game
949 ReadTrack(cdr.SetSectorPlay);
950
951
952 // Crusaders of Might and Magic - update getlocl now
953 // - fixes cutscene speech
954 {
955 u8 *buf = CDR_getBuffer();
956 if (buf != NULL)
957 memcpy(cdr.Transfer, buf, 8);
958 }
959
960 /*
961 Duke Nukem: Land of the Babes - seek then delay read for one frame
962 - fixes cutscenes
963 C-12 - Final Resistance - doesn't like seek
964 */
965
966 if (cdr.Seeked != SEEK_DONE) {
967 cdr.StatP |= STATUS_SEEK;
968 cdr.StatP &= ~STATUS_READ;
969
970 // Crusaders of Might and Magic - use short time
971 // - fix cutscene speech (startup)
972
973 // ??? - use more accurate seek time later
974 CDREAD_INT(((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1) + seekTime);
975 } else {
976 cdr.StatP |= STATUS_READ;
977 cdr.StatP &= ~STATUS_SEEK;
978
979 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime * 1);
980 }
981
982 cdr.Result[0] = cdr.StatP;
983 start_rotating = 1;
984 break;
985 case CdlSync:
986 default:
987 CDR_LOG_I("Invalid command: %02x\n", Irq);
988 error = ERROR_INVALIDCMD;
989 // FALLTHROUGH
990
991 set_error:
992 SetResultSize(2);
993 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
994 cdr.Result[1] = error;
995 cdr.Stat = DiskError;
996 break;
997 }
998
999 if (cdr.DriveState == DRIVESTATE_STOPPED && start_rotating) {
1000 cdr.DriveState = DRIVESTATE_STANDBY;
1001 cdr.StatP |= STATUS_ROTATING;
1002 }
1003
1004 if (!no_busy_error) {
1005 switch (cdr.DriveState) {
1006 case DRIVESTATE_LID_OPEN:
1007 case DRIVESTATE_RESCAN_CD:
1008 case DRIVESTATE_PREPARE_CD:
1009 SetResultSize(2);
1010 cdr.Result[0] = cdr.StatP | STATUS_ERROR;
1011 cdr.Result[1] = ERROR_NOTREADY;
1012 cdr.Stat = DiskError;
1013 break;
1014 }
1015 }
1016
1017finish:
1018 setIrq();
1019 cdr.ParamC = 0;
1020
1021#ifdef CDR_LOG_CMD_IRQ
1022 {
1023 int i;
1024 SysPrintf("CDR IRQ %d cmd %02x stat %02x: ",
1025 !!(cdr.Stat & cdr.Reg2), Irq, cdr.Stat);
1026 for (i = 0; i < cdr.ResultC; i++)
1027 SysPrintf("%02x ", cdr.Result[i]);
1028 SysPrintf("\n");
1029 }
1030#endif
1031}
1032
1033#ifdef HAVE_ARMV7
1034 #define ssat32_to_16(v) \
1035 asm("ssat %0,#16,%1" : "=r" (v) : "r" (v))
1036#else
1037 #define ssat32_to_16(v) do { \
1038 if (v < -32768) v = -32768; \
1039 else if (v > 32767) v = 32767; \
1040 } while (0)
1041#endif
1042
1043void cdrAttenuate(s16 *buf, int samples, int stereo)
1044{
1045 int i, l, r;
1046 int ll = cdr.AttenuatorLeftToLeft;
1047 int lr = cdr.AttenuatorLeftToRight;
1048 int rl = cdr.AttenuatorRightToLeft;
1049 int rr = cdr.AttenuatorRightToRight;
1050
1051 if (lr == 0 && rl == 0 && 0x78 <= ll && ll <= 0x88 && 0x78 <= rr && rr <= 0x88)
1052 return;
1053
1054 if (!stereo && ll == 0x40 && lr == 0x40 && rl == 0x40 && rr == 0x40)
1055 return;
1056
1057 if (stereo) {
1058 for (i = 0; i < samples; i++) {
1059 l = buf[i * 2];
1060 r = buf[i * 2 + 1];
1061 l = (l * ll + r * rl) >> 7;
1062 r = (r * rr + l * lr) >> 7;
1063 ssat32_to_16(l);
1064 ssat32_to_16(r);
1065 buf[i * 2] = l;
1066 buf[i * 2 + 1] = r;
1067 }
1068 }
1069 else {
1070 for (i = 0; i < samples; i++) {
1071 l = buf[i];
1072 l = l * (ll + rl) >> 7;
1073 //r = r * (rr + lr) >> 7;
1074 ssat32_to_16(l);
1075 //ssat32_to_16(r);
1076 buf[i] = l;
1077 }
1078 }
1079}
1080
1081void cdrReadInterrupt() {
1082 u8 *buf;
1083
1084 if (!cdr.Reading)
1085 return;
1086
1087 if (cdr.Irq || cdr.Stat) {
1088 CDR_LOG_I("cdrom: read stat hack %02x %x\n", cdr.Irq, cdr.Stat);
1089 CDREAD_INT(0x1000);
1090 return;
1091 }
1092
1093 cdr.OCUP = 1;
1094 SetResultSize(1);
1095 cdr.StatP |= STATUS_READ|STATUS_ROTATING;
1096 cdr.StatP &= ~STATUS_SEEK;
1097 cdr.Result[0] = cdr.StatP;
1098 cdr.Seeked = SEEK_DONE;
1099
1100 ReadTrack(cdr.SetSectorPlay);
1101
1102 buf = CDR_getBuffer();
1103 if (buf == NULL)
1104 cdr.RErr = -1;
1105
1106 if (cdr.RErr == -1) {
1107 CDR_LOG_I("cdrReadInterrupt() Log: err\n");
1108 memset(cdr.Transfer, 0, DATA_SIZE);
1109 cdr.Stat = DiskError;
1110 cdr.Result[0] |= STATUS_ERROR;
1111 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1112 return;
1113 }
1114
1115 memcpy(cdr.Transfer, buf, DATA_SIZE);
1116 CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
1117
1118
1119 CDR_LOG("cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
1120
1121 if ((!cdr.Muted) && (cdr.Mode & MODE_STRSND) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
1122 // Firemen 2: Multi-XA files - briefings, cutscenes
1123 if( cdr.FirstSector == 1 && (cdr.Mode & MODE_SF)==0 ) {
1124 cdr.File = cdr.Transfer[4 + 0];
1125 cdr.Channel = cdr.Transfer[4 + 1];
1126 }
1127
1128 /* Gameblabla
1129 * Skips playing on channel 255.
1130 * Fixes missing audio in Blue's Clues : Blue's Big Musical. (Should also fix Taxi 2)
1131 * TODO : Check if this is the proper behaviour.
1132 * */
1133 if((cdr.Transfer[4 + 2] & 0x4) &&
1134 (cdr.Transfer[4 + 1] == cdr.Channel) &&
1135 (cdr.Transfer[4 + 0] == cdr.File) && cdr.Channel != 255) {
1136 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
1137 if (!ret) {
1138 cdrAttenuate(cdr.Xa.pcm, cdr.Xa.nsamples, cdr.Xa.stereo);
1139 SPU_playADPCMchannel(&cdr.Xa);
1140 cdr.FirstSector = 0;
1141 }
1142 else cdr.FirstSector = -1;
1143 }
1144 }
1145
1146 cdr.SetSectorPlay[2]++;
1147 if (cdr.SetSectorPlay[2] == 75) {
1148 cdr.SetSectorPlay[2] = 0;
1149 cdr.SetSectorPlay[1]++;
1150 if (cdr.SetSectorPlay[1] == 60) {
1151 cdr.SetSectorPlay[1] = 0;
1152 cdr.SetSectorPlay[0]++;
1153 }
1154 }
1155
1156 cdr.Readed = 0;
1157
1158 uint32_t delay = (cdr.Mode & MODE_SPEED) ? (cdReadTime / 2) : cdReadTime;
1159 if (cdr.m_locationChanged) {
1160 CDREAD_INT(delay * 30);
1161 cdr.m_locationChanged = FALSE;
1162 } else {
1163 CDREAD_INT(delay);
1164 }
1165
1166 /*
1167 Croc 2: $40 - only FORM1 (*)
1168 Judge Dredd: $C8 - only FORM1 (*)
1169 Sim Theme Park - no adpcm at all (zero)
1170 */
1171
1172 if (!(cdr.Mode & MODE_STRSND) || !(cdr.Transfer[4+2] & 0x4)) {
1173 cdr.Stat = DataReady;
1174 setIrq();
1175 }
1176
1177 // update for CdlGetlocP
1178 ReadTrack(cdr.SetSectorPlay);
1179}
1180
1181/*
1182cdrRead0:
1183 bit 0,1 - mode
1184 bit 2 - unknown
1185 bit 3 - unknown
1186 bit 4 - unknown
1187 bit 5 - 1 result ready
1188 bit 6 - 1 dma ready
1189 bit 7 - 1 command being processed
1190*/
1191
1192unsigned char cdrRead0(void) {
1193 if (cdr.ResultReady)
1194 cdr.Ctrl |= 0x20;
1195 else
1196 cdr.Ctrl &= ~0x20;
1197
1198 if (cdr.OCUP)
1199 cdr.Ctrl |= 0x40;
1200// else
1201// cdr.Ctrl &= ~0x40;
1202
1203 // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
1204 cdr.Ctrl |= 0x18;
1205
1206 CDR_LOG_IO("cdr r0: %02x\n", cdr.Ctrl);
1207
1208 return psxHu8(0x1800) = cdr.Ctrl;
1209}
1210
1211void cdrWrite0(unsigned char rt) {
1212 CDR_LOG_IO("cdr w0: %02x\n", rt);
1213
1214 cdr.Ctrl = (rt & 3) | (cdr.Ctrl & ~3);
1215}
1216
1217unsigned char cdrRead1(void) {
1218 if ((cdr.ResultP & 0xf) < cdr.ResultC)
1219 psxHu8(0x1801) = cdr.Result[cdr.ResultP & 0xf];
1220 else
1221 psxHu8(0x1801) = 0;
1222 cdr.ResultP++;
1223 if (cdr.ResultP == cdr.ResultC)
1224 cdr.ResultReady = 0;
1225
1226 CDR_LOG_IO("cdr r1: %02x\n", psxHu8(0x1801));
1227
1228 return psxHu8(0x1801);
1229}
1230
1231void cdrWrite1(unsigned char rt) {
1232 u8 set_loc[3];
1233 int i;
1234
1235 CDR_LOG_IO("cdr w1: %02x\n", rt);
1236
1237 switch (cdr.Ctrl & 3) {
1238 case 0:
1239 break;
1240 case 3:
1241 cdr.AttenuatorRightToRightT = rt;
1242 return;
1243 default:
1244 return;
1245 }
1246
1247 cdr.Cmd = rt;
1248 cdr.OCUP = 0;
1249
1250#ifdef CDR_LOG_CMD_IRQ
1251 SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
1252 if (cdr.ParamC) {
1253 SysPrintf(" Param[%d] = {", cdr.ParamC);
1254 for (i = 0; i < cdr.ParamC; i++)
1255 SysPrintf(" %x,", cdr.Param[i]);
1256 SysPrintf("}\n");
1257 } else {
1258 SysPrintf("\n");
1259 }
1260#endif
1261
1262 cdr.ResultReady = 0;
1263 cdr.Ctrl |= 0x80;
1264 // cdr.Stat = NoIntr;
1265 AddIrqQueue(cdr.Cmd, 0x800);
1266
1267 switch (cdr.Cmd) {
1268 case CdlSetloc:
1269 CDR_LOG("CDROM setloc command (%02X, %02X, %02X)\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1270
1271 // MM must be BCD, SS must be BCD and <0x60, FF must be BCD and <0x75
1272 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))
1273 {
1274 CDR_LOG("Invalid/out of range seek to %02X:%02X:%02X\n", cdr.Param[0], cdr.Param[1], cdr.Param[2]);
1275 }
1276 else
1277 {
1278 for (i = 0; i < 3; i++)
1279 {
1280 set_loc[i] = btoi(cdr.Param[i]);
1281 }
1282
1283 i = msf2sec(cdr.SetSectorPlay);
1284 i = abs(i - msf2sec(set_loc));
1285 if (i > 16)
1286 cdr.Seeked = SEEK_PENDING;
1287
1288 memcpy(cdr.SetSector, set_loc, 3);
1289 cdr.SetSector[3] = 0;
1290 cdr.SetlocPending = 1;
1291 }
1292 break;
1293
1294 case CdlReadN:
1295 case CdlReadS:
1296 case CdlPause:
1297 StopCdda();
1298 StopReading();
1299 break;
1300
1301 case CdlInit:
1302 case CdlReset:
1303 cdr.Seeked = SEEK_DONE;
1304 StopCdda();
1305 StopReading();
1306 break;
1307
1308 case CdlSetmode:
1309 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
1310
1311 cdr.Mode = cdr.Param[0];
1312
1313 // Squaresoft on PlayStation 1998 Collector's CD Vol. 1
1314 // - fixes choppy movie sound
1315 if( cdr.Play && (cdr.Mode & MODE_CDDA) == 0 )
1316 StopCdda();
1317 break;
1318 }
1319}
1320
1321unsigned char cdrRead2(void) {
1322 unsigned char ret;
1323
1324 if (cdr.Readed == 0) {
1325 ret = 0;
1326 } else {
1327 ret = *pTransfer++;
1328 }
1329
1330 CDR_LOG_IO("cdr r2: %02x\n", ret);
1331 return ret;
1332}
1333
1334void cdrWrite2(unsigned char rt) {
1335 CDR_LOG_IO("cdr w2: %02x\n", rt);
1336
1337 switch (cdr.Ctrl & 3) {
1338 case 0:
1339 if (cdr.ParamC < 8) // FIXME: size and wrapping
1340 cdr.Param[cdr.ParamC++] = rt;
1341 return;
1342 case 1:
1343 cdr.Reg2 = rt;
1344 setIrq();
1345 return;
1346 case 2:
1347 cdr.AttenuatorLeftToLeftT = rt;
1348 return;
1349 case 3:
1350 cdr.AttenuatorRightToLeftT = rt;
1351 return;
1352 }
1353}
1354
1355unsigned char cdrRead3(void) {
1356 if (cdr.Ctrl & 0x1)
1357 psxHu8(0x1803) = cdr.Stat | 0xE0;
1358 else
1359 psxHu8(0x1803) = cdr.Reg2 | 0xE0;
1360
1361 CDR_LOG_IO("cdr r3: %02x\n", psxHu8(0x1803));
1362 return psxHu8(0x1803);
1363}
1364
1365void cdrWrite3(unsigned char rt) {
1366 CDR_LOG_IO("cdr w3: %02x\n", rt);
1367
1368 switch (cdr.Ctrl & 3) {
1369 case 0:
1370 break; // transfer
1371 case 1:
1372 cdr.Stat &= ~rt;
1373
1374 if (rt & 0x40)
1375 cdr.ParamC = 0;
1376 return;
1377 case 2:
1378 cdr.AttenuatorLeftToRightT = rt;
1379 return;
1380 case 3:
1381 if (rt & 0x20) {
1382 memcpy(&cdr.AttenuatorLeftToLeft, &cdr.AttenuatorLeftToLeftT, 4);
1383 CDR_LOG_I("CD-XA Volume: %02x %02x | %02x %02x\n",
1384 cdr.AttenuatorLeftToLeft, cdr.AttenuatorLeftToRight,
1385 cdr.AttenuatorRightToLeft, cdr.AttenuatorRightToRight);
1386 }
1387 return;
1388 }
1389
1390 if ((rt & 0x80) && cdr.Readed == 0) {
1391 cdr.Readed = 1;
1392 pTransfer = cdr.Transfer;
1393
1394 switch (cdr.Mode & 0x30) {
1395 case MODE_SIZE_2328:
1396 case 0x00:
1397 pTransfer += 12;
1398 break;
1399
1400 case MODE_SIZE_2340:
1401 pTransfer += 0;
1402 break;
1403
1404 default:
1405 break;
1406 }
1407 }
1408}
1409
1410void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1411 u32 cdsize;
1412 int size;
1413 u8 *ptr;
1414
1415 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1416
1417 switch (chcr) {
1418 case 0x11000000:
1419 case 0x11400100:
1420 if (cdr.Readed == 0) {
1421 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1422 break;
1423 }
1424
1425 cdsize = (bcr & 0xffff) * 4;
1426
1427 // Ape Escape: bcr = 0001 / 0000
1428 // - fix boot
1429 if( cdsize == 0 )
1430 {
1431 switch (cdr.Mode & (MODE_SIZE_2340|MODE_SIZE_2328)) {
1432 case MODE_SIZE_2340: cdsize = 2340; break;
1433 case MODE_SIZE_2328: cdsize = 2328; break;
1434 default:
1435 case MODE_SIZE_2048: cdsize = 2048; break;
1436 }
1437 }
1438
1439
1440 ptr = (u8 *)PSXM(madr);
1441 if (ptr == NULL) {
1442 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1443 break;
1444 }
1445
1446 /*
1447 GS CDX: Enhancement CD crash
1448 - Setloc 0:0:0
1449 - CdlPlay
1450 - Spams DMA3 and gets buffer overrun
1451 */
1452 size = CD_FRAMESIZE_RAW - (pTransfer - cdr.Transfer);
1453 if (size > cdsize)
1454 size = cdsize;
1455 if (size > 0)
1456 {
1457 memcpy(ptr, pTransfer, size);
1458 }
1459
1460 psxCpu->Clear(madr, cdsize / 4);
1461 pTransfer += cdsize;
1462
1463 if( chcr == 0x11400100 ) {
1464 HW_DMA3_MADR = SWAPu32(madr + cdsize);
1465 CDRDMA_INT( (cdsize/4) / 4 );
1466 }
1467 else if( chcr == 0x11000000 ) {
1468 // CDRDMA_INT( (cdsize/4) * 1 );
1469 // halted
1470 psxRegs.cycle += (cdsize/4) * 24/2;
1471 CDRDMA_INT(16);
1472 }
1473 return;
1474
1475 default:
1476 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1477 break;
1478 }
1479
1480 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1481 DMA_INTERRUPT(3);
1482}
1483
1484void cdrDmaInterrupt()
1485{
1486 if (HW_DMA3_CHCR & SWAP32(0x01000000))
1487 {
1488 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1489 DMA_INTERRUPT(3);
1490 }
1491}
1492
1493static void getCdInfo(void)
1494{
1495 u8 tmp;
1496
1497 CDR_getTN(cdr.ResultTN);
1498 CDR_getTD(0, cdr.SetSectorEnd);
1499 tmp = cdr.SetSectorEnd[0];
1500 cdr.SetSectorEnd[0] = cdr.SetSectorEnd[2];
1501 cdr.SetSectorEnd[2] = tmp;
1502}
1503
1504void cdrReset() {
1505 memset(&cdr, 0, sizeof(cdr));
1506 cdr.CurTrack = 1;
1507 cdr.File = 1;
1508 cdr.Channel = 1;
1509 cdr.Reg2 = 0x1f;
1510 cdr.Stat = NoIntr;
1511 cdr.DriveState = DRIVESTATE_STANDBY;
1512 cdr.StatP = STATUS_ROTATING;
1513 pTransfer = cdr.Transfer;
1514 cdr.SetlocPending = 0;
1515 cdr.m_locationChanged = FALSE;
1516
1517 // BIOS player - default values
1518 cdr.AttenuatorLeftToLeft = 0x80;
1519 cdr.AttenuatorLeftToRight = 0x00;
1520 cdr.AttenuatorRightToLeft = 0x00;
1521 cdr.AttenuatorRightToRight = 0x80;
1522
1523 getCdInfo();
1524}
1525
1526int cdrFreeze(void *f, int Mode) {
1527 u32 tmp;
1528 u8 tmpp[3];
1529
1530 if (Mode == 0 && !Config.Cdda)
1531 CDR_stop();
1532
1533 cdr.freeze_ver = 0x63647202;
1534 gzfreeze(&cdr, sizeof(cdr));
1535
1536 if (Mode == 1) {
1537 cdr.ParamP = cdr.ParamC;
1538 tmp = pTransfer - cdr.Transfer;
1539 }
1540
1541 gzfreeze(&tmp, sizeof(tmp));
1542
1543 if (Mode == 0) {
1544 getCdInfo();
1545
1546 pTransfer = cdr.Transfer + tmp;
1547
1548 // read right sub data
1549 tmpp[0] = btoi(cdr.Prev[0]);
1550 tmpp[1] = btoi(cdr.Prev[1]);
1551 tmpp[2] = btoi(cdr.Prev[2]);
1552 cdr.Prev[0]++;
1553 ReadTrack(tmpp);
1554
1555 if (cdr.Play) {
1556 if (cdr.freeze_ver < 0x63647202)
1557 memcpy(cdr.SetSectorPlay, cdr.SetSector, 3);
1558
1559 Find_CurTrack(cdr.SetSectorPlay);
1560 if (!Config.Cdda)
1561 CDR_play(cdr.SetSectorPlay);
1562 }
1563
1564 if ((cdr.freeze_ver & 0xffffff00) != 0x63647200) {
1565 // old versions did not latch Reg2, have to fixup..
1566 if (cdr.Reg2 == 0) {
1567 SysPrintf("cdrom: fixing up old savestate\n");
1568 cdr.Reg2 = 7;
1569 }
1570 // also did not save Attenuator..
1571 if ((cdr.AttenuatorLeftToLeft | cdr.AttenuatorLeftToRight
1572 | cdr.AttenuatorRightToLeft | cdr.AttenuatorRightToRight) == 0)
1573 {
1574 cdr.AttenuatorLeftToLeft = cdr.AttenuatorRightToRight = 0x80;
1575 }
1576 }
1577 }
1578
1579 return 0;
1580}
1581
1582void LidInterrupt() {
1583 getCdInfo();
1584 StopCdda();
1585 cdrLidSeekInterrupt();
1586}
ARM optimized PCSX fork