notaz.gp2x.de / pcsx_rearmed.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
drc: bugfix
[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"
26
27cdrStruct cdr;
28
29/* CD-ROM magic numbers */
30#define CdlSync 0
31#define CdlNop 1
32#define CdlSetloc 2
33#define CdlPlay 3
34#define CdlForward 4
35#define CdlBackward 5
36#define CdlReadN 6
37#define CdlStandby 7
38#define CdlStop 8
39#define CdlPause 9
40#define CdlInit 10
41#define CdlMute 11
42#define CdlDemute 12
43#define CdlSetfilter 13
44#define CdlSetmode 14
45#define CdlGetmode 15
46#define CdlGetlocL 16
47#define CdlGetlocP 17
48#define CdlReadT 18
49#define CdlGetTN 19
50#define CdlGetTD 20
51#define CdlSeekL 21
52#define CdlSeekP 22
53#define CdlSetclock 23
54#define CdlGetclock 24
55#define CdlTest 25
56#define CdlID 26
57#define CdlReadS 27
58#define CdlReset 28
59#define CdlReadToc 30
60
61#define AUTOPAUSE 249
62#define READ_ACK 250
63#define READ 251
64#define REPPLAY_ACK 252
65#define REPPLAY 253
66#define ASYNC 254
67/* don't set 255, it's reserved */
68
69char *CmdName[0x100]= {
70 "CdlSync", "CdlNop", "CdlSetloc", "CdlPlay",
71 "CdlForward", "CdlBackward", "CdlReadN", "CdlStandby",
72 "CdlStop", "CdlPause", "CdlInit", "CdlMute",
73 "CdlDemute", "CdlSetfilter", "CdlSetmode", "CdlGetmode",
74 "CdlGetlocL", "CdlGetlocP", "CdlReadT", "CdlGetTN",
75 "CdlGetTD", "CdlSeekL", "CdlSeekP", "CdlSetclock",
76 "CdlGetclock", "CdlTest", "CdlID", "CdlReadS",
77 "CdlReset", NULL, "CDlReadToc", NULL
78};
79
80unsigned char Test04[] = { 0 };
81unsigned char Test05[] = { 0 };
82unsigned char Test20[] = { 0x98, 0x06, 0x10, 0xC3 };
83unsigned char Test22[] = { 0x66, 0x6F, 0x72, 0x20, 0x45, 0x75, 0x72, 0x6F };
84unsigned char Test23[] = { 0x43, 0x58, 0x44, 0x32, 0x39 ,0x34, 0x30, 0x51 };
85
86// 1x = 75 sectors per second
87// PSXCLK = 1 sec in the ps
88// so (PSXCLK / 75) = cdr read time (linuzappz)
89#define cdReadTime (PSXCLK / 75)
90
91static struct CdrStat stat;
92static struct SubQ *subq;
93
94#define CDR_INT(eCycle) { \
95 psxRegs.interrupt |= 0x4; \
96 psxRegs.intCycle[2 + 1] = eCycle; \
97 psxRegs.intCycle[2] = psxRegs.cycle; }
98
99#define CDREAD_INT(eCycle) { \
100 psxRegs.interrupt |= 0x40000; \
101 psxRegs.intCycle[2 + 16 + 1] = eCycle; \
102 psxRegs.intCycle[2 + 16] = psxRegs.cycle; }
103
104#define StartReading(type, eCycle) { \
105 cdr.Reading = type; \
106 cdr.FirstSector = 1; \
107 cdr.Readed = 0xff; \
108 AddIrqQueue(READ_ACK, eCycle); \
109}
110
111#define StopReading() { \
112 if (cdr.Reading) { \
113 cdr.Reading = 0; \
114 psxRegs.interrupt &= ~0x40000; \
115 } \
116 cdr.StatP &= ~0x20;\
117}
118
119#define StopCdda() { \
120 if (cdr.Play) { \
121 if (!Config.Cdda) CDR_stop(); \
122 cdr.StatP &= ~0x80; \
123 cdr.Play = FALSE; \
124 } \
125}
126
127#define SetResultSize(size) { \
128 cdr.ResultP = 0; \
129 cdr.ResultC = size; \
130 cdr.ResultReady = 1; \
131}
132
133static void ReadTrack() {
134 cdr.Prev[0] = itob(cdr.SetSector[0]);
135 cdr.Prev[1] = itob(cdr.SetSector[1]);
136 cdr.Prev[2] = itob(cdr.SetSector[2]);
137
138#ifdef CDR_LOG
139 CDR_LOG("ReadTrack() Log: KEY *** %x:%x:%x\n", cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
140#endif
141 cdr.RErr = CDR_readTrack(cdr.Prev);
142}
143
144// cdr.Stat:
145#define NoIntr 0
146#define DataReady 1
147#define Complete 2
148#define Acknowledge 3
149#define DataEnd 4
150#define DiskError 5
151
152void AddIrqQueue(unsigned char irq, unsigned long ecycle) {
153 cdr.Irq = irq;
154 if (cdr.Stat) {
155 cdr.eCycle = ecycle;
156 } else {
157 CDR_INT(ecycle);
158 }
159}
160
161void cdrInterrupt() {
162 int i;
163 unsigned char Irq = cdr.Irq;
164
165 if (cdr.Stat) {
166 CDR_INT(0x1000);
167 return;
168 }
169
170 cdr.Irq = 0xff;
171 cdr.Ctrl &= ~0x80;
172
173 switch (Irq) {
174 case CdlSync:
175 SetResultSize(1);
176 cdr.StatP |= 0x2;
177 cdr.Result[0] = cdr.StatP;
178 cdr.Stat = Acknowledge;
179 break;
180
181 case CdlNop:
182 SetResultSize(1);
183 cdr.Result[0] = cdr.StatP;
184 cdr.Stat = Acknowledge;
185 i = stat.Status;
186 if (CDR_getStatus(&stat) != -1) {
187 if (stat.Type == 0xff) cdr.Stat = DiskError;
188 if (stat.Status & 0x10) {
189 cdr.Stat = DiskError;
190 cdr.Result[0] |= 0x11;
191 cdr.Result[0] &= ~0x02;
192 }
193 else if (i & 0x10) {
194 cdr.StatP |= 0x2;
195 cdr.Result[0] |= 0x2;
196 CheckCdrom();
197 }
198 }
199 break;
200
201 case CdlSetloc:
202 cdr.CmdProcess = 0;
203 SetResultSize(1);
204 cdr.StatP |= 0x2;
205 cdr.Result[0] = cdr.StatP;
206 cdr.Stat = Acknowledge;
207 break;
208
209 case CdlPlay:
210 cdr.CmdProcess = 0;
211 SetResultSize(1);
212 cdr.StatP |= 0x2;
213 cdr.Result[0] = cdr.StatP;
214 cdr.Stat = Acknowledge;
215 cdr.StatP |= 0x80;
216// if ((cdr.Mode & 0x5) == 0x5) AddIrqQueue(REPPLAY, cdReadTime);
217 break;
218
219 case CdlForward:
220 cdr.CmdProcess = 0;
221 SetResultSize(1);
222 cdr.StatP |= 0x2;
223 cdr.Result[0] = cdr.StatP;
224 cdr.Stat = Complete;
225 break;
226
227 case CdlBackward:
228 cdr.CmdProcess = 0;
229 SetResultSize(1);
230 cdr.StatP |= 0x2;
231 cdr.Result[0] = cdr.StatP;
232 cdr.Stat = Complete;
233 break;
234
235 case CdlStandby:
236 cdr.CmdProcess = 0;
237 SetResultSize(1);
238 cdr.StatP |= 0x2;
239 cdr.Result[0] = cdr.StatP;
240 cdr.Stat = Complete;
241 break;
242
243 case CdlStop:
244 cdr.CmdProcess = 0;
245 SetResultSize(1);
246 cdr.StatP &= ~0x2;
247 cdr.Result[0] = cdr.StatP;
248 cdr.Stat = Complete;
249// cdr.Stat = Acknowledge;
250
251 // check case open/close -shalma
252 i = stat.Status;
253 if (CDR_getStatus(&stat) != -1) {
254 if (stat.Type == 0xff) cdr.Stat = DiskError;
255 if (stat.Status & 0x10) {
256 cdr.Stat = DiskError;
257 cdr.Result[0] |= 0x11;
258 cdr.Result[0] &= ~0x02;
259 }
260 else if (i & 0x10) {
261 cdr.StatP |= 0x2;
262 cdr.Result[0] |= 0x2;
263 CheckCdrom();
264 }
265 }
266 break;
267
268 case CdlPause:
269 SetResultSize(1);
270 cdr.Result[0] = cdr.StatP;
271 cdr.Stat = Acknowledge;
272 AddIrqQueue(CdlPause + 0x20, 0x1000);
273 cdr.Ctrl |= 0x80;
274 break;
275
276 case CdlPause + 0x20:
277 SetResultSize(1);
278 cdr.StatP &= ~0x20;
279 cdr.StatP |= 0x2;
280 cdr.Result[0] = cdr.StatP;
281 cdr.Stat = Complete;
282 break;
283
284 case CdlInit:
285 SetResultSize(1);
286 cdr.StatP = 0x2;
287 cdr.Result[0] = cdr.StatP;
288 cdr.Stat = Acknowledge;
289// if (!cdr.Init) {
290 AddIrqQueue(CdlInit + 0x20, 0x1000);
291// }
292 break;
293
294 case CdlInit + 0x20:
295 SetResultSize(1);
296 cdr.Result[0] = cdr.StatP;
297 cdr.Stat = Complete;
298 cdr.Init = 1;
299 break;
300
301 case CdlMute:
302 SetResultSize(1);
303 cdr.StatP |= 0x2;
304 cdr.Result[0] = cdr.StatP;
305 cdr.Stat = Acknowledge;
306 break;
307
308 case CdlDemute:
309 SetResultSize(1);
310 cdr.StatP |= 0x2;
311 cdr.Result[0] = cdr.StatP;
312 cdr.Stat = Acknowledge;
313 break;
314
315 case CdlSetfilter:
316 SetResultSize(1);
317 cdr.StatP |= 0x2;
318 cdr.Result[0] = cdr.StatP;
319 cdr.Stat = Acknowledge;
320 break;
321
322 case CdlSetmode:
323 SetResultSize(1);
324 cdr.StatP |= 0x2;
325 cdr.Result[0] = cdr.StatP;
326 cdr.Stat = Acknowledge;
327 break;
328
329 case CdlGetmode:
330 SetResultSize(6);
331 cdr.StatP |= 0x2;
332 cdr.Result[0] = cdr.StatP;
333 cdr.Result[1] = cdr.Mode;
334 cdr.Result[2] = cdr.File;
335 cdr.Result[3] = cdr.Channel;
336 cdr.Result[4] = 0;
337 cdr.Result[5] = 0;
338 cdr.Stat = Acknowledge;
339 break;
340
341 case CdlGetlocL:
342 SetResultSize(8);
343// for (i = 0; i < 8; i++)
344// cdr.Result[i] = itob(cdr.Transfer[i]);
345 for (i = 0; i < 8; i++)
346 cdr.Result[i] = cdr.Transfer[i];
347 cdr.Stat = Acknowledge;
348 break;
349
350 case CdlGetlocP:
351 SetResultSize(8);
352 subq = (struct SubQ *)CDR_getBufferSub();
353
354 if (subq != NULL) {
355 cdr.Result[0] = subq->TrackNumber;
356 cdr.Result[1] = subq->IndexNumber;
357 memcpy(cdr.Result + 2, subq->TrackRelativeAddress, 3);
358 memcpy(cdr.Result + 5, subq->AbsoluteAddress, 3);
359
360 // subQ integrity check
361 if (calcCrc((u8 *)subq + 12, 10) != (((u16)subq->CRC[0] << 8) | subq->CRC[1])) {
362 memset(cdr.Result + 2, 0, 3 + 3); // CRC wrong, wipe out time data
363 }
364 } else {
365 cdr.Result[0] = 1;
366 cdr.Result[1] = 1;
367
368 cdr.Result[2] = btoi(cdr.Prev[0]);
369 cdr.Result[3] = btoi(cdr.Prev[1]) - 2;
370 cdr.Result[4] = cdr.Prev[2];
371
372 // m:s adjustment
373 if ((s8)cdr.Result[3] < 0) {
374 cdr.Result[3] += 60;
375 cdr.Result[2] -= 1;
376 }
377
378 cdr.Result[2] = itob(cdr.Result[2]);
379 cdr.Result[3] = itob(cdr.Result[3]);
380
381 memcpy(cdr.Result + 5, cdr.Prev, 3);
382 }
383
384 cdr.Stat = Acknowledge;
385 break;
386
387 case CdlGetTN:
388 cdr.CmdProcess = 0;
389 SetResultSize(3);
390 cdr.StatP |= 0x2;
391 cdr.Result[0] = cdr.StatP;
392 if (CDR_getTN(cdr.ResultTN) == -1) {
393 cdr.Stat = DiskError;
394 cdr.Result[0] |= 0x01;
395 } else {
396 cdr.Stat = Acknowledge;
397 cdr.Result[1] = itob(cdr.ResultTN[0]);
398 cdr.Result[2] = itob(cdr.ResultTN[1]);
399 }
400 break;
401
402 case CdlGetTD:
403 cdr.CmdProcess = 0;
404 cdr.Track = btoi(cdr.Param[0]);
405 SetResultSize(4);
406 cdr.StatP |= 0x2;
407 if (CDR_getTD(cdr.Track, cdr.ResultTD) == -1) {
408 cdr.Stat = DiskError;
409 cdr.Result[0] |= 0x01;
410 } else {
411 cdr.Stat = Acknowledge;
412 cdr.Result[0] = cdr.StatP;
413 cdr.Result[1] = itob(cdr.ResultTD[2]);
414 cdr.Result[2] = itob(cdr.ResultTD[1]);
415 cdr.Result[3] = itob(cdr.ResultTD[0]);
416 }
417 break;
418
419 case CdlSeekL:
420 SetResultSize(1);
421 cdr.StatP |= 0x2;
422 cdr.Result[0] = cdr.StatP;
423 cdr.StatP |= 0x40;
424 cdr.Stat = Acknowledge;
425 cdr.Seeked = TRUE;
426 AddIrqQueue(CdlSeekL + 0x20, 0x1000);
427 break;
428
429 case CdlSeekL + 0x20:
430 SetResultSize(1);
431 cdr.StatP |= 0x2;
432 cdr.StatP &= ~0x40;
433 cdr.Result[0] = cdr.StatP;
434 cdr.Stat = Complete;
435 break;
436
437 case CdlSeekP:
438 SetResultSize(1);
439 cdr.StatP |= 0x2;
440 cdr.Result[0] = cdr.StatP;
441 cdr.StatP |= 0x40;
442 cdr.Stat = Acknowledge;
443 AddIrqQueue(CdlSeekP + 0x20, 0x1000);
444 break;
445
446 case CdlSeekP + 0x20:
447 SetResultSize(1);
448 cdr.StatP |= 0x2;
449 cdr.StatP &= ~0x40;
450 cdr.Result[0] = cdr.StatP;
451 cdr.Stat = Complete;
452 break;
453
454 case CdlTest:
455 cdr.Stat = Acknowledge;
456 switch (cdr.Param[0]) {
457 case 0x20: // System Controller ROM Version
458 SetResultSize(4);
459 memcpy(cdr.Result, Test20, 4);
460 break;
461 case 0x22:
462 SetResultSize(8);
463 memcpy(cdr.Result, Test22, 4);
464 break;
465 case 0x23: case 0x24:
466 SetResultSize(8);
467 memcpy(cdr.Result, Test23, 4);
468 break;
469 }
470 break;
471
472 case CdlID:
473 SetResultSize(1);
474 cdr.StatP |= 0x2;
475 cdr.Result[0] = cdr.StatP;
476 cdr.Stat = Acknowledge;
477 AddIrqQueue(CdlID + 0x20, 0x1000);
478 break;
479
480 case CdlID + 0x20:
481 SetResultSize(8);
482 if (CDR_getStatus(&stat) == -1) {
483 cdr.Result[0] = 0x00; // 0x08 and cdr.Result[1]|0x10 : audio cd, enters cd player
484 cdr.Result[1] = 0x00; // 0x80 leads to the menu in the bios, else loads CD
485 }
486 else {
487 if (stat.Type == 2) {
488 cdr.Result[0] = 0x08;
489 cdr.Result[1] = 0x10;
490 }
491 else {
492 cdr.Result[0] = 0x00;
493 cdr.Result[1] = 0x00;
494 }
495 }
496 cdr.Result[1] |= 0x80;
497 cdr.Result[2] = 0x00;
498 cdr.Result[3] = 0x00;
499 strncpy((char *)&cdr.Result[4], "PCSX", 4);
500 cdr.Stat = Complete;
501 break;
502
503 case CdlReset:
504 SetResultSize(1);
505 cdr.StatP = 0x2;
506 cdr.Result[0] = cdr.StatP;
507 cdr.Stat = Acknowledge;
508 break;
509
510 case CdlReadToc:
511 SetResultSize(1);
512 cdr.StatP |= 0x2;
513 cdr.Result[0] = cdr.StatP;
514 cdr.Stat = Acknowledge;
515 AddIrqQueue(CdlReadToc + 0x20, 0x1000);
516 break;
517
518 case CdlReadToc + 0x20:
519 SetResultSize(1);
520 cdr.StatP |= 0x2;
521 cdr.Result[0] = cdr.StatP;
522 cdr.Stat = Complete;
523 break;
524
525 case AUTOPAUSE:
526 cdr.OCUP = 0;
527/* SetResultSize(1);
528 StopCdda();
529 StopReading();
530 cdr.OCUP = 0;
531 cdr.StatP&=~0x20;
532 cdr.StatP|= 0x2;
533 cdr.Result[0] = cdr.StatP;
534 cdr.Stat = DataEnd;
535*/ AddIrqQueue(CdlPause, 0x800);
536 break;
537
538 case READ_ACK:
539 if (!cdr.Reading) return;
540
541 SetResultSize(1);
542 cdr.StatP |= 0x2;
543 cdr.Result[0] = cdr.StatP;
544 if (!cdr.Seeked) {
545 cdr.Seeked = TRUE;
546 cdr.StatP |= 0x40;
547 }
548 cdr.StatP |= 0x20;
549 cdr.Stat = Acknowledge;
550
551// CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
552 CDREAD_INT(0x80000);
553 break;
554
555 case REPPLAY_ACK:
556 cdr.Stat = Acknowledge;
557 cdr.Result[0] = cdr.StatP;
558 SetResultSize(1);
559 AddIrqQueue(REPPLAY, cdReadTime);
560 break;
561
562 case REPPLAY:
563 if ((cdr.Mode & 5) != 5) break;
564/* if (CDR_getStatus(&stat) == -1) {
565 cdr.Result[0] = 0;
566 cdr.Result[1] = 0;
567 cdr.Result[2] = 0;
568 cdr.Result[3] = 0;
569 cdr.Result[4] = 0;
570 cdr.Result[5] = 0;
571 cdr.Result[6] = 0;
572 cdr.Result[7] = 0;
573 } else memcpy(cdr.Result, &stat.Track, 8);
574 cdr.Stat = 1;
575 SetResultSize(8);
576 AddIrqQueue(REPPLAY_ACK, cdReadTime);
577*/ break;
578
579 case 0xff:
580 return;
581
582 default:
583 cdr.Stat = Complete;
584 break;
585 }
586
587 if (cdr.Stat != NoIntr && cdr.Reg2 != 0x18) {
588 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
589 }
590
591#ifdef CDR_LOG
592 CDR_LOG("cdrInterrupt() Log: CDR Interrupt IRQ %x\n", Irq);
593#endif
594}
595
596void cdrReadInterrupt() {
597 u8 *buf;
598
599 if (!cdr.Reading)
600 return;
601
602 if (cdr.Stat) {
603 CDREAD_INT(0x1000);
604 return;
605 }
606
607#ifdef CDR_LOG
608 CDR_LOG("cdrReadInterrupt() Log: KEY END");
609#endif
610
611 cdr.OCUP = 1;
612 SetResultSize(1);
613 cdr.StatP |= 0x22;
614 cdr.StatP &= ~0x40;
615 cdr.Result[0] = cdr.StatP;
616
617 ReadTrack();
618
619 buf = CDR_getBuffer();
620 if (buf == NULL)
621 cdr.RErr = -1;
622
623 if (cdr.RErr == -1) {
624#ifdef CDR_LOG
625 fprintf(emuLog, "cdrReadInterrupt() Log: err\n");
626#endif
627 memset(cdr.Transfer, 0, DATA_SIZE);
628 cdr.Stat = DiskError;
629 cdr.Result[0] |= 0x01;
630 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
631 return;
632 }
633
634 memcpy(cdr.Transfer, buf, DATA_SIZE);
635 CheckPPFCache(cdr.Transfer, cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
636
637 cdr.Stat = DataReady;
638
639#ifdef CDR_LOG
640 fprintf(emuLog, "cdrReadInterrupt() Log: cdr.Transfer %x:%x:%x\n", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
641#endif
642
643 if ((!cdr.Muted) && (cdr.Mode & 0x40) && (!Config.Xa) && (cdr.FirstSector != -1)) { // CD-XA
644 if ((cdr.Transfer[4 + 2] & 0x4) &&
645 ((cdr.Mode & 0x8) ? (cdr.Transfer[4 + 1] == cdr.Channel) : 1) &&
646 (cdr.Transfer[4 + 0] == cdr.File)) {
647 int ret = xa_decode_sector(&cdr.Xa, cdr.Transfer+4, cdr.FirstSector);
648
649 if (!ret) {
650 SPU_playADPCMchannel(&cdr.Xa);
651 cdr.FirstSector = 0;
652 }
653 else cdr.FirstSector = -1;
654 }
655 }
656
657 cdr.SetSector[2]++;
658 if (cdr.SetSector[2] == 75) {
659 cdr.SetSector[2] = 0;
660 cdr.SetSector[1]++;
661 if (cdr.SetSector[1] == 60) {
662 cdr.SetSector[1] = 0;
663 cdr.SetSector[0]++;
664 }
665 }
666
667 cdr.Readed = 0;
668
669 if ((cdr.Transfer[4 + 2] & 0x80) && (cdr.Mode & 0x2)) { // EOF
670#ifdef CDR_LOG
671 CDR_LOG("cdrReadInterrupt() Log: Autopausing read\n");
672#endif
673// AddIrqQueue(AUTOPAUSE, 0x1000);
674 AddIrqQueue(CdlPause, 0x1000);
675 }
676 else {
677 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
678 }
679 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
680}
681
682/*
683cdrRead0:
684 bit 0 - 0 REG1 command send / 1 REG1 data read
685 bit 1 - 0 data transfer finish / 1 data transfer ready/in progress
686 bit 2 - unknown
687 bit 3 - unknown
688 bit 4 - unknown
689 bit 5 - 1 result ready
690 bit 6 - 1 dma ready
691 bit 7 - 1 command being processed
692*/
693
694unsigned char cdrRead0(void) {
695 if (cdr.ResultReady)
696 cdr.Ctrl |= 0x20;
697 else
698 cdr.Ctrl &= ~0x20;
699
700 if (cdr.OCUP)
701 cdr.Ctrl |= 0x40;
702// else
703// cdr.Ctrl &= ~0x40;
704
705 // What means the 0x10 and the 0x08 bits? I only saw it used by the bios
706 cdr.Ctrl |= 0x18;
707
708#ifdef CDR_LOG
709 CDR_LOG("cdrRead0() Log: CD0 Read: %x\n", cdr.Ctrl);
710#endif
711
712 return psxHu8(0x1800) = cdr.Ctrl;
713}
714
715/*
716cdrWrite0:
717 0 - to send a command / 1 - to get the result
718*/
719
720void cdrWrite0(unsigned char rt) {
721#ifdef CDR_LOG
722 CDR_LOG("cdrWrite0() Log: CD0 write: %x\n", rt);
723#endif
724 cdr.Ctrl = rt | (cdr.Ctrl & ~0x3);
725
726 if (rt == 0) {
727 cdr.ParamP = 0;
728 cdr.ParamC = 0;
729 cdr.ResultReady = 0;
730 }
731}
732
733unsigned char cdrRead1(void) {
734 if (cdr.ResultReady) { // && cdr.Ctrl & 0x1) {
735 psxHu8(0x1801) = cdr.Result[cdr.ResultP++];
736 if (cdr.ResultP == cdr.ResultC)
737 cdr.ResultReady = 0;
738 } else {
739 psxHu8(0x1801) = 0;
740 }
741#ifdef CDR_LOG
742 CDR_LOG("cdrRead1() Log: CD1 Read: %x\n", psxHu8(0x1801));
743#endif
744 return psxHu8(0x1801);
745}
746
747void cdrWrite1(unsigned char rt) {
748 int i;
749
750#ifdef CDR_LOG
751 CDR_LOG("cdrWrite1() Log: CD1 write: %x (%s)\n", rt, CmdName[rt]);
752#endif
753// psxHu8(0x1801) = rt;
754 cdr.Cmd = rt;
755 cdr.OCUP = 0;
756
757#ifdef CDRCMD_DEBUG
758 SysPrintf("cdrWrite1() Log: CD1 write: %x (%s)", rt, CmdName[rt]);
759 if (cdr.ParamC) {
760 SysPrintf(" Param[%d] = {", cdr.ParamC);
761 for (i = 0; i < cdr.ParamC; i++)
762 SysPrintf(" %x,", cdr.Param[i]);
763 SysPrintf("}\n");
764 } else {
765 SysPrintf("\n");
766 }
767#endif
768
769 if (cdr.Ctrl & 0x1) return;
770
771 switch (cdr.Cmd) {
772 case CdlSync:
773 cdr.Ctrl |= 0x80;
774 cdr.Stat = NoIntr;
775 AddIrqQueue(cdr.Cmd, 0x1000);
776 break;
777
778 case CdlNop:
779 cdr.Ctrl |= 0x80;
780 cdr.Stat = NoIntr;
781 AddIrqQueue(cdr.Cmd, 0x1000);
782 break;
783
784 case CdlSetloc:
785 StopReading();
786 cdr.Seeked = FALSE;
787 for (i = 0; i < 3; i++)
788 cdr.SetSector[i] = btoi(cdr.Param[i]);
789 cdr.SetSector[3] = 0;
790/* if ((cdr.SetSector[0] | cdr.SetSector[1] | cdr.SetSector[2]) == 0) {
791 *(u32 *)cdr.SetSector = *(u32 *)cdr.SetSectorSeek;
792 }*/
793 cdr.Ctrl |= 0x80;
794 cdr.Stat = NoIntr;
795 AddIrqQueue(cdr.Cmd, 0x1000);
796 break;
797
798 case CdlPlay:
799 if (!cdr.SetSector[0] & !cdr.SetSector[1] & !cdr.SetSector[2]) {
800 if (CDR_getTN(cdr.ResultTN) != -1) {
801 if (cdr.CurTrack > cdr.ResultTN[1])
802 cdr.CurTrack = cdr.ResultTN[1];
803 if (CDR_getTD((unsigned char)(cdr.CurTrack), cdr.ResultTD) != -1) {
804 int tmp = cdr.ResultTD[2];
805 cdr.ResultTD[2] = cdr.ResultTD[0];
806 cdr.ResultTD[0] = tmp;
807 if (!Config.Cdda) CDR_play(cdr.ResultTD);
808 }
809 }
810 } else if (!Config.Cdda) {
811 CDR_play(cdr.SetSector);
812 }
813 cdr.Play = TRUE;
814 cdr.Ctrl |= 0x80;
815 cdr.Stat = NoIntr;
816 AddIrqQueue(cdr.Cmd, 0x1000);
817 break;
818
819 case CdlForward:
820 if (cdr.CurTrack < 0xaa)
821 cdr.CurTrack++;
822 cdr.Ctrl |= 0x80;
823 cdr.Stat = NoIntr;
824 AddIrqQueue(cdr.Cmd, 0x1000);
825 break;
826
827 case CdlBackward:
828 if (cdr.CurTrack > 1)
829 cdr.CurTrack--;
830 cdr.Ctrl |= 0x80;
831 cdr.Stat = NoIntr;
832 AddIrqQueue(cdr.Cmd, 0x1000);
833 break;
834
835 case CdlReadN:
836 cdr.Irq = 0;
837 StopReading();
838 cdr.Ctrl|= 0x80;
839 cdr.Stat = NoIntr;
840 StartReading(1, 0x1000);
841 break;
842
843 case CdlStandby:
844 StopCdda();
845 StopReading();
846 cdr.Ctrl |= 0x80;
847 cdr.Stat = NoIntr;
848 AddIrqQueue(cdr.Cmd, 0x1000);
849 break;
850
851 case CdlStop:
852 StopCdda();
853 StopReading();
854 cdr.Ctrl |= 0x80;
855 cdr.Stat = NoIntr;
856 AddIrqQueue(cdr.Cmd, 0x1000);
857 break;
858
859 case CdlPause:
860 StopCdda();
861 StopReading();
862 cdr.Ctrl |= 0x80;
863 cdr.Stat = NoIntr;
864 AddIrqQueue(cdr.Cmd, 0x80000);
865 break;
866
867 case CdlReset:
868 case CdlInit:
869 StopCdda();
870 StopReading();
871 cdr.Ctrl |= 0x80;
872 cdr.Stat = NoIntr;
873 AddIrqQueue(cdr.Cmd, 0x1000);
874 break;
875
876 case CdlMute:
877 cdr.Muted = TRUE;
878 cdr.Ctrl |= 0x80;
879 cdr.Stat = NoIntr;
880 AddIrqQueue(cdr.Cmd, 0x1000);
881 break;
882
883 case CdlDemute:
884 cdr.Muted = FALSE;
885 cdr.Ctrl |= 0x80;
886 cdr.Stat = NoIntr;
887 AddIrqQueue(cdr.Cmd, 0x1000);
888 break;
889
890 case CdlSetfilter:
891 cdr.File = cdr.Param[0];
892 cdr.Channel = cdr.Param[1];
893 cdr.Ctrl |= 0x80;
894 cdr.Stat = NoIntr;
895 AddIrqQueue(cdr.Cmd, 0x1000);
896 break;
897
898 case CdlSetmode:
899#ifdef CDR_LOG
900 CDR_LOG("cdrWrite1() Log: Setmode %x\n", cdr.Param[0]);
901#endif
902 cdr.Mode = cdr.Param[0];
903 cdr.Ctrl |= 0x80;
904 cdr.Stat = NoIntr;
905 AddIrqQueue(cdr.Cmd, 0x1000);
906 break;
907
908 case CdlGetmode:
909 cdr.Ctrl |= 0x80;
910 cdr.Stat = NoIntr;
911 AddIrqQueue(cdr.Cmd, 0x1000);
912 break;
913
914 case CdlGetlocL:
915 cdr.Ctrl |= 0x80;
916 cdr.Stat = NoIntr;
917 AddIrqQueue(cdr.Cmd, 0x1000);
918 break;
919
920 case CdlGetlocP:
921 cdr.Ctrl |= 0x80;
922 cdr.Stat = NoIntr;
923 AddIrqQueue(cdr.Cmd, 0x1000);
924 break;
925
926 case CdlGetTN:
927 cdr.Ctrl |= 0x80;
928 cdr.Stat = NoIntr;
929 AddIrqQueue(cdr.Cmd, 0x1000);
930 break;
931
932 case CdlGetTD:
933 cdr.Ctrl |= 0x80;
934 cdr.Stat = NoIntr;
935 AddIrqQueue(cdr.Cmd, 0x1000);
936 break;
937
938 case CdlSeekL:
939// ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
940 cdr.Ctrl |= 0x80;
941 cdr.Stat = NoIntr;
942 AddIrqQueue(cdr.Cmd, 0x1000);
943 break;
944
945 case CdlSeekP:
946// ((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
947 cdr.Ctrl |= 0x80;
948 cdr.Stat = NoIntr;
949 AddIrqQueue(cdr.Cmd, 0x1000);
950 break;
951
952 case CdlTest:
953 cdr.Ctrl |= 0x80;
954 cdr.Stat = NoIntr;
955 AddIrqQueue(cdr.Cmd, 0x1000);
956 break;
957
958 case CdlID:
959 cdr.Ctrl |= 0x80;
960 cdr.Stat = NoIntr;
961 AddIrqQueue(cdr.Cmd, 0x1000);
962 break;
963
964 case CdlReadS:
965 cdr.Irq = 0;
966 StopReading();
967 cdr.Ctrl |= 0x80;
968 cdr.Stat = NoIntr;
969 StartReading(2, 0x1000);
970 break;
971
972 case CdlReadToc:
973 cdr.Ctrl |= 0x80;
974 cdr.Stat = NoIntr;
975 AddIrqQueue(cdr.Cmd, 0x1000);
976 break;
977
978 default:
979#ifdef CDR_LOG
980 CDR_LOG("cdrWrite1() Log: Unknown command: %x\n", cdr.Cmd);
981#endif
982 return;
983 }
984 if (cdr.Stat != NoIntr) {
985 psxHu32ref(0x1070) |= SWAP32((u32)0x4);
986 }
987}
988
989unsigned char cdrRead2(void) {
990 unsigned char ret;
991
992 if (cdr.Readed == 0) {
993 ret = 0;
994 } else {
995 ret = *cdr.pTransfer++;
996 }
997
998#ifdef CDR_LOG
999 CDR_LOG("cdrRead2() Log: CD2 Read: %x\n", ret);
1000#endif
1001 return ret;
1002}
1003
1004void cdrWrite2(unsigned char rt) {
1005#ifdef CDR_LOG
1006 CDR_LOG("cdrWrite2() Log: CD2 write: %x\n", rt);
1007#endif
1008 if (cdr.Ctrl & 0x1) {
1009 switch (rt) {
1010 case 0x07:
1011 cdr.ParamP = 0;
1012 cdr.ParamC = 0;
1013 cdr.ResultReady = 1; //0;
1014 cdr.Ctrl &= ~3; //cdr.Ctrl = 0;
1015 break;
1016
1017 default:
1018 cdr.Reg2 = rt;
1019 break;
1020 }
1021 } else if (!(cdr.Ctrl & 0x1) && cdr.ParamP < 8) {
1022 cdr.Param[cdr.ParamP++] = rt;
1023 cdr.ParamC++;
1024 }
1025}
1026
1027unsigned char cdrRead3(void) {
1028 if (cdr.Stat) {
1029 if (cdr.Ctrl & 0x1)
1030 psxHu8(0x1803) = cdr.Stat | 0xE0;
1031 else
1032 psxHu8(0x1803) = 0xff;
1033 } else {
1034 psxHu8(0x1803) = 0;
1035 }
1036#ifdef CDR_LOG
1037 CDR_LOG("cdrRead3() Log: CD3 Read: %x\n", psxHu8(0x1803));
1038#endif
1039 return psxHu8(0x1803);
1040}
1041
1042void cdrWrite3(unsigned char rt) {
1043#ifdef CDR_LOG
1044 CDR_LOG("cdrWrite3() Log: CD3 write: %x\n", rt);
1045#endif
1046 if (rt == 0x07 && cdr.Ctrl & 0x1) {
1047 cdr.Stat = 0;
1048
1049 if (cdr.Irq == 0xff) {
1050 cdr.Irq = 0;
1051 return;
1052 }
1053 if (cdr.Irq)
1054 CDR_INT(cdr.eCycle);
1055 if (cdr.Reading && !cdr.ResultReady)
1056 CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
1057
1058 return;
1059 }
1060 if (rt == 0x80 && !(cdr.Ctrl & 0x1) && cdr.Readed == 0) {
1061 cdr.Readed = 1;
1062 cdr.pTransfer = cdr.Transfer;
1063
1064 switch (cdr.Mode & 0x30) {
1065 case 0x10:
1066 case 0x00:
1067 cdr.pTransfer += 12;
1068 break;
1069 default:
1070 break;
1071 }
1072 }
1073}
1074
1075void psxDma3(u32 madr, u32 bcr, u32 chcr) {
1076 u32 cdsize;
1077 u8 *ptr;
1078
1079#ifdef CDR_LOG
1080 CDR_LOG("psxDma3() Log: *** DMA 3 *** %x addr = %x size = %x\n", chcr, madr, bcr);
1081#endif
1082
1083 switch (chcr) {
1084 case 0x11000000:
1085 case 0x11400100:
1086 if (cdr.Readed == 0) {
1087#ifdef CDR_LOG
1088 CDR_LOG("psxDma3() Log: *** DMA 3 *** NOT READY\n");
1089#endif
1090 break;
1091 }
1092
1093 cdsize = (bcr & 0xffff) * 4;
1094
1095 ptr = (u8 *)PSXM(madr);
1096 if (ptr == NULL) {
1097#ifdef CPU_LOG
1098 CDR_LOG("psxDma3() Log: *** DMA 3 *** NULL Pointer!\n");
1099#endif
1100 break;
1101 }
1102 memcpy(ptr, cdr.pTransfer, cdsize);
1103 psxCpu->Clear(madr, cdsize / 4);
1104 cdr.pTransfer += cdsize;
1105 break;
1106 default:
1107#ifdef CDR_LOG
1108 CDR_LOG("psxDma3() Log: Unknown cddma %x\n", chcr);
1109#endif
1110 break;
1111 }
1112
1113 HW_DMA3_CHCR &= SWAP32(~0x01000000);
1114 DMA_INTERRUPT(3);
1115}
1116
1117void cdrReset() {
1118 memset(&cdr, 0, sizeof(cdr));
1119 cdr.CurTrack = 1;
1120 cdr.File = 1;
1121 cdr.Channel = 1;
1122}
1123
1124int cdrFreeze(gzFile f, int Mode) {
1125 uintptr_t tmp;
1126
1127 gzfreeze(&cdr, sizeof(cdr));
1128
1129 if (Mode == 1)
1130 tmp = cdr.pTransfer - cdr.Transfer;
1131
1132 gzfreeze(&tmp, sizeof(tmp));
1133
1134 if (Mode == 0)
1135 cdr.pTransfer = cdr.Transfer + tmp;
1136
1137 return 0;
1138}
ARM optimized PCSX fork