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