void psxDma3(u32 madr, u32 bcr, u32 chcr) {
u32 cdsize;
CDVD_LOG("*** DMA 3 *** %lx addr = %lx size = %lx", chcr, madr, bcr);
switch (chcr) {
case 0x11000000:
case 0x11400100:
if (cdr.Readed == 0) {
CDVD_LOG("*** DMA 3 *** NOT READY");
return;
}
cdsize = (bcr & 0xffff) * 4;
memcpy(iopPhysMem(madr), cdr.pTransfer, cdsize);
psxCpu->Clear(madr, cdsize/4);
cdr.pTransfer+=cdsize;
break;
case 0x41000200:
//SysPrintf("unhandled cdrom dma3: madr: %x, bcr: %x, chcr %x\n", madr, bcr, chcr);
return;
default:
CDVD_LOG("Unknown cddma %lx", chcr);
break;
}
HW_DMA3_CHCR &= ~0x01000000;
psxDmaInterrupt(3);
}
void cdrWrite2(u8 rt) {
CDVD_LOG("CD2 write: %x", rt);
if (cdr.Ctrl & 0x1) {
switch (rt) {
case 0x07:
cdr.ParamP = 0;
cdr.ParamC = 0;
cdr.ResultReady = 0;
cdr.Ctrl = 0;
break;
default:
cdr.Reg2 = rt;
break;
}
}
else
{
if (!(cdr.Ctrl & 0x1) && cdr.ParamP < 8) {
cdr.Param[cdr.ParamP++] = rt;
cdr.ParamC++;
}
}
}
static void ReadTrack() {
cdr.Prev[0] = itob(cdr.SetSector[0]);
cdr.Prev[1] = itob(cdr.SetSector[1]);
cdr.Prev[2] = itob(cdr.SetSector[2]);
CDVD_LOG("KEY *** %x:%x:%x", cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
cdr.RErr = DoCDVDreadTrack(msf_to_lsn(cdr.SetSector), CDVD_MODE_2340);
}
static void ReadTrack() {
cdr.Prev[0] = itob(cdr.SetSector[0]);
cdr.Prev[1] = itob(cdr.SetSector[1]);
cdr.Prev[2] = itob(cdr.SetSector[2]);
CDVD_LOG("KEY *** %x:%x:%x", cdr.Prev[0], cdr.Prev[1], cdr.Prev[2]);
if (EmuConfig.CdvdVerboseReads)
DevCon.WriteLn("CD Read Sector %x", msf_to_lsn(cdr.SetSector));
cdr.RErr = DoCDVDreadTrack(msf_to_lsn(cdr.SetSector), CDVD_MODE_2340);
}
u8 cdrRead3(void) {
if (cdr.Stat) {
if (cdr.Ctrl & 0x1)
psxHu8(0x1803) = cdr.Stat | 0xE0;
else
psxHu8(0x1803) = 0xff;
} else psxHu8(0x1803) = 0;
CDVD_LOG("CD3 Read: %x", psxHu8(0x1803));
return psxHu8(0x1803);
}
u8 cdrRead1(void) {
if (cdr.ResultReady && cdr.Ctrl & 0x1) {
psxHu8(0x1801) = cdr.Result[cdr.ResultP++];
if (cdr.ResultP == cdr.ResultC) cdr.ResultReady = 0;
}
else
psxHu8(0x1801) = 0;
CDVD_LOG("CD1 Read: %x", psxHu8(0x1801));
return psxHu8(0x1801);
}
void cdrWrite0(u8 rt) {
CDVD_LOG("CD0 write: %x", rt);
cdr.Ctrl = rt | (cdr.Ctrl & ~0x3);
if (rt == 0) {
cdr.ParamP = 0;
cdr.ParamC = 0;
cdr.ResultReady = 0;
}
}
u8 cdrRead2(void) {
u8 ret;
if (cdr.Readed == 0) {
ret = 0;
} else {
ret = *cdr.pTransfer++;
}
CDVD_LOG("CD2 Read: %x", ret);
return ret;
}
u8 cdrRead0(void) {
if (cdr.ResultReady)
cdr.Ctrl |= 0x20;
else
cdr.Ctrl &= ~0x20;
if (cdr.OCUP)
cdr.Ctrl |= 0x40;
else
cdr.Ctrl &= ~0x40;
// what means the 0x10 and the 0x08 bits? i only saw it used by the bios
cdr.Ctrl|=0x18;
CDVD_LOG("CD0 Read: %x", cdr.Ctrl);
return psxHu8(0x1800) = cdr.Ctrl;
}
void cdrWrite3(u8 rt) {
CDVD_LOG("CD3 write: %x", rt);
if (rt == 0x07 && cdr.Ctrl & 0x1) {
cdr.Stat = 0;
if (cdr.Irq == 0xff) { cdr.Irq = 0; return; }
if (cdr.Irq) {
CDR_INT(cdr.eCycle);
}
return;
}
if (rt == 0x80 && !(cdr.Ctrl & 0x1) && cdr.Readed == 0) {
cdr.Readed = 1;
cdr.pTransfer = cdr.Transfer;
switch (cdr.Mode&0x30) {
case 0x10:
case 0x00: cdr.pTransfer+=12; break;
default: break;
}
}
}
void cdrWrite1(u8 rt) {
int i;
CDVD_LOG("CD1 write: %x (%s)", rt, CmdName[rt]);
cdr.Cmd = rt;
cdr.OCUP = 0;
#ifdef CDRCMD_DEBUG
SysPrintf("CD1 write: %x (%s)", rt, CmdName[rt]);
if (cdr.ParamC) {
SysPrintf(" Param[%d] = {", cdr.ParamC);
for (i=0;i<cdr.ParamC;i++) SysPrintf(" %x,", cdr.Param[i]);
SysPrintf("}\n");
} else SysPrintf("\n");
#endif
if (cdr.Ctrl & 0x1) return;
switch(cdr.Cmd) {
case CdlSync:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlNop:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlSetloc:
StopReading();
for (i=0; i<3; i++) cdr.SetSector[i] = btoi(cdr.Param[i]);
cdr.SetSector[3] = 0;
if ((cdr.SetSector[0] | cdr.SetSector[1] | cdr.SetSector[2]) == 0) {
*(u32 *)cdr.SetSector = *(u32 *)cdr.SetSectorSeek;
}
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlPlay:
cdr.Play = 1;
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlForward:
if (cdr.CurTrack < 0xaa) cdr.CurTrack++;
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlBackward:
if (cdr.CurTrack > 1) cdr.CurTrack--;
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlReadN:
cdr.Irq = 0;
StopReading();
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
StartReading(1);
break;
case CdlStandby:
StopCdda();
StopReading();
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlStop:
StopCdda();
StopReading();
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlPause:
StopCdda();
StopReading();
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x40000);
break;
case CdlReset:
case CdlInit:
StopCdda();
StopReading();
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlMute:
cdr.Muted = 0;
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlDemute:
cdr.Muted = 1;
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlSetfilter:
cdr.File = cdr.Param[0];
cdr.Channel = cdr.Param[1];
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlSetmode:
CDVD_LOG("Setmode %x", cdr.Param[0]);
cdr.Mode = cdr.Param[0];
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlGetmode:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlGetlocL:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlGetlocP:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlGetTN:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlGetTD:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlSeekL:
((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlSeekP:
((u32 *)cdr.SetSectorSeek)[0] = ((u32 *)cdr.SetSector)[0];
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlTest:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlID:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
case CdlReadS:
cdr.Irq = 0;
StopReading();
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
StartReading(2);
break;
case CdlReadToc:
cdr.Ctrl|= 0x80;
cdr.Stat = NoIntr;
AddIrqQueue(cdr.Cmd, 0x800);
break;
default:
CDVD_LOG("Unknown Cmd: %x\n", cdr.Cmd);
return;
}
if (cdr.Stat != NoIntr)
iopIntcIrq( 2 );
}
void cdrReadInterrupt() {
if (!cdr.Reading)
return;
if (cdr.Stat) {
CDREAD_INT(0x800);
return;
}
CDVD_LOG("KEY END");
cdr.OCUP = 1;
SetResultSize(1);
cdr.StatP|= 0x22;
cdr.Result[0] = cdr.StatP;
if( cdr.RErr == 0 )
{
while( (cdr.RErr = DoCDVDgetBuffer(cdr.Transfer)), cdr.RErr == -2 )
{
// not finished yet ... block on the read until it finishes.
Threading::Sleep( 0 );
Threading::SpinWait();
}
}
if (cdr.RErr == -1)
{
CDVD_LOG(" err\n");
memzero(cdr.Transfer);
cdr.Stat = DiskError;
cdr.Result[0] |= 0x01;
ReadTrack();
CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
return;
}
cdr.Stat = DataReady;
CDVD_LOG(" %x:%x:%x", cdr.Transfer[0], cdr.Transfer[1], cdr.Transfer[2]);
cdr.SetSector[2]++;
if (cdr.SetSector[2] == 75) {
cdr.SetSector[2] = 0;
cdr.SetSector[1]++;
if (cdr.SetSector[1] == 60) {
cdr.SetSector[1] = 0;
cdr.SetSector[0]++;
}
}
cdr.Readed = 0;
if ((cdr.Transfer[4+2] & 0x80) && (cdr.Mode & 0x2)) { // EOF
CDVD_LOG("AutoPausing Read");
AddIrqQueue(CdlPause, 0x800);
}
else {
ReadTrack();
CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
}
psxHu32(0x1070)|= 0x4;
return;
}
void cdrInterrupt() {
cdvdTD trackInfo;
int i;
u8 Irq = cdr.Irq;
if (cdr.Stat) {
CDR_INT(0x800);
return;
}
cdr.Irq = 0xff;
cdr.Ctrl&=~0x80;
switch (Irq) {
case CdlSync:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlNop:
SetResultSize(1);
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlSetloc:
cdr.CmdProcess = 0;
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlPlay:
cdr.CmdProcess = 0;
SetResultSize(1);
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
cdr.StatP|= 0x82;
break;
case CdlForward:
cdr.CmdProcess = 0;
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case CdlBackward:
cdr.CmdProcess = 0;
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case CdlStandby:
cdr.CmdProcess = 0;
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case CdlStop:
cdr.CmdProcess = 0;
SetResultSize(1);
cdr.StatP&=~0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
// cdr.Stat = Acknowledge;
break;
case CdlPause:
SetResultSize(1);
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
AddIrqQueue(CdlPause + 0x20, 0x800);
break;
case CdlPause + 0x20:
SetResultSize(1);
cdr.StatP&=~0x20;
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case CdlInit:
SetResultSize(1);
cdr.StatP = 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
AddIrqQueue(CdlInit + 0x20, 0x800);
break;
case CdlInit + 0x20:
SetResultSize(1);
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
cdr.Init = 1;
break;
case CdlMute:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlDemute:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlSetfilter:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlSetmode:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlGetmode:
SetResultSize(6);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Result[1] = cdr.Mode;
cdr.Result[2] = cdr.File;
cdr.Result[3] = cdr.Channel;
cdr.Result[4] = 0;
cdr.Result[5] = 0;
cdr.Stat = Acknowledge;
break;
case CdlGetlocL:
SetResultSize(8);
for (i=0; i<8; i++)
cdr.Result[i] = cdr.Transfer[i];
cdr.Stat = Acknowledge;
break;
case CdlGetlocP:
SetResultSize(8);
cdr.Result[0] = 1;
cdr.Result[1] = 1;
cdr.Result[2] = cdr.Prev[0];
cdr.Result[3] = itob((btoi(cdr.Prev[1])) - 2);
cdr.Result[4] = cdr.Prev[2];
cdr.Result[5] = cdr.Prev[0];
cdr.Result[6] = cdr.Prev[1];
cdr.Result[7] = cdr.Prev[2];
cdr.Stat = Acknowledge;
break;
case CdlGetTN:
cdr.CmdProcess = 0;
SetResultSize(3);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
if (CDVD->getTN(&cdr.ResultTN) == -1) {
cdr.Stat = DiskError;
cdr.Result[0]|= 0x01;
} else {
cdr.Stat = Acknowledge;
cdr.Result[1] = itob(cdr.ResultTN.strack);
cdr.Result[2] = itob(cdr.ResultTN.etrack);
}
break;
case CdlGetTD:
cdr.CmdProcess = 0;
cdr.Track = btoi(cdr.Param[0]);
SetResultSize(4);
cdr.StatP|= 0x2;
if (CDVD->getTD(cdr.Track, &trackInfo) == -1) {
cdr.Stat = DiskError;
cdr.Result[0]|= 0x01;
} else {
lsn_to_msf(cdr.ResultTD, trackInfo.lsn);
cdr.Stat = Acknowledge;
cdr.Result[0] = cdr.StatP;
cdr.Result[1] = cdr.ResultTD[2];
cdr.Result[2] = cdr.ResultTD[1];
cdr.Result[3] = cdr.ResultTD[0];
}
break;
case CdlSeekL:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
AddIrqQueue(CdlSeekL + 0x20, 0x800);
break;
case CdlSeekL + 0x20:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case CdlSeekP:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
AddIrqQueue(CdlSeekP + 0x20, 0x800);
break;
case CdlSeekP + 0x20:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case CdlTest:
cdr.Stat = Acknowledge;
switch (cdr.Param[0]) {
case 0x20: // System Controller ROM Version
SetResultSize(4);
*(int*)cdr.Result = *(int*)Test20;
break;
case 0x22:
SetResultSize(8);
*(int*)cdr.Result = *(int*)Test22;
break;
case 0x23:
case 0x24:
SetResultSize(8);
*(int*)cdr.Result = *(int*)Test23;
break;
}
break;
case CdlID:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
AddIrqQueue(CdlID + 0x20, 0x800);
break;
case CdlID + 0x20:
SetResultSize(8);
cdr.Result[0] = 0x00; // 0x08 and cdr.Result[1]|0x10 : audio cd, enters cd player
cdr.Result[1] = 0x00; // 0x80 leads to the menu in the bios, else loads CD
if (!LoadCdBios) cdr.Result[1] |= 0x80;
cdr.Result[2] = 0x00;
cdr.Result[3] = 0x00;
strncpy((char *)&cdr.Result[4], "PCSX", 4);
cdr.Stat = Complete;
break;
case CdlReset:
SetResultSize(1);
cdr.StatP = 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
break;
case CdlReadToc:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
AddIrqQueue(CdlReadToc + 0x20, 0x800);
break;
case CdlReadToc + 0x20:
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Complete;
break;
case AUTOPAUSE:
cdr.OCUP = 0;
AddIrqQueue(CdlPause, 0x400);
break;
case READ_ACK:
if (!cdr.Reading) return;
SetResultSize(1);
cdr.StatP|= 0x2;
cdr.Result[0] = cdr.StatP;
cdr.Stat = Acknowledge;
ReadTrack();
CDREAD_INT((cdr.Mode & 0x80) ? (cdReadTime / 2) : cdReadTime);
break;
case REPPLAY_ACK:
cdr.Stat = Acknowledge;
cdr.Result[0] = cdr.StatP;
SetResultSize(1);
AddIrqQueue(REPPLAY, cdReadTime);
break;
case REPPLAY:
//if ((cdr.Mode & 5) != 5) break;
break;
case 0xff:
return;
default:
cdr.Stat = Complete;
break;
}
if (cdr.Stat != NoIntr && cdr.Reg2 != 0x18)
psxHu32(0x1070)|= 0x4;
CDVD_LOG("Cdr Interrupt %x\n", Irq);
}