ref: 7f9fc68a99d1056963e74a37e921d449a3c99cca
dir: /psx/dev/cdrom.c/
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#include "cdrom.h"
#include "../log.h"
#include "../msf.h"
/*
Drive Status 1st Response 2nd Response
Door Open INT5(11h,80h) N/A
Spin-up INT5(01h,80h) N/A
Detect busy INT5(03h,80h) N/A
No Disk INT3(stat) INT5(08h,40h, 00h,00h, 00h,00h,00h,00h)
Audio Disk INT3(stat) INT5(0Ah,90h, 00h,00h, 00h,00h,00h,00h)
Unlicensed:Mode1 INT3(stat) INT5(0Ah,80h, 00h,00h, 00h,00h,00h,00h)
Unlicensed:Mode2 INT3(stat) INT5(0Ah,80h, 20h,00h, 00h,00h,00h,00h)
Unlicensed:Mode2+Audio INT3(stat) INT5(0Ah,90h, 20h,00h, 00h,00h,00h,00h)
Debug/Yaroze:Mode2 INT3(stat) INT2(02h,00h, 20h,00h, 20h,20h,20h,20h)
Licensed:Mode2 INT3(stat) INT2(02h,00h, 20h,00h, 53h,43h,45h,4xh)
Modchip:Audio/Mode1 INT3(stat) INT2(02h,00h, 00h,00h, 53h,43h,45h,4xh)
*/
msf_t cdrom_get_track_addr(psx_cdrom_t* cdrom, msf_t msf) {
uint32_t lba = msf_to_address(msf);
int num_tracks, track;
psx_disc_get_track_count(cdrom->disc, &num_tracks);
for (track = 1; track < num_tracks - 1; track++) {
msf_t curr, next;
psx_disc_get_track_addr(cdrom->disc, &curr, track);
psx_disc_get_track_addr(cdrom->disc, &next, track + 1);
uint32_t curr_lba = msf_to_address(curr);
uint32_t next_lba = msf_to_address(next);
// printf("lba=%02u:%02u:%02u (%08x) curr=%02u:%02u:%02u (%08x) next=%02u:%02u:%02u (%08x)\n",
// msf.m,
// msf.s,
// msf.f,
// lba,
// curr.m,
// curr.s,
// curr.f,
// curr_lba,
// next.m,
// next.s,
// next.f,
// next_lba
// );
if ((lba >= curr_lba) && (lba < next_lba))
break;
}
msf_t track_msf;
psx_disc_get_track_addr(cdrom->disc, &track_msf, track);
return track_msf;
}
void cdrom_fetch_video_sector(psx_cdrom_t* cdrom) {
while (true) {
if (psx_disc_seek(cdrom->disc, cdrom->seek_msf))
return;
psx_disc_read_sector(cdrom->disc, cdrom->dfifo);
msf_add_f(&cdrom->seek_msf, 1);
// Check RT and Video/Data bit
// if (cdrom->dfifo[0x12] & 4)
// continue;
// If we get here it means this is a real-time video sector.
// If the XA filter is disabled, we're done
if (!(cdrom->mode & MODE_XA_FILTER))
return;
// Else check XA file/channel
int file_eq = cdrom->dfifo[0x10] == cdrom->xa_file;
int channel_eq = cdrom->dfifo[0x11] == cdrom->xa_channel;
// If they are equal to our filter values, we're done
// else keep searching
if (file_eq && channel_eq)
return;
}
}
#define GETID_RESPONSE_SIZE 8
#define GETID_RESPONSE_END (GETID_RESPONSE_SIZE - 1)
static const int16_t g_zigzag_table0[] = {
0x0000, 0x0000, 0x0000, 0x0000,
0x0000, -0x0002, 0x000a, -0x0022,
0x0041, -0x0054, 0x0034, 0x0009,
-0x010a, 0x0400, -0x0a78, 0x234c,
0x6794, -0x1780, 0x0bcd, -0x0623,
0x0350, -0x016d, 0x006b, 0x000a,
-0x0010, 0x0011, -0x0008, 0x0003,
-0x0001
};
static const int16_t g_zigzag_table1[] = {
0x0000, 0x0000, 0x0000, -0x0002,
0x0000, 0x0003, -0x0013, 0x003c,
-0x004b, 0x00a2, -0x00e3, 0x0132,
-0x0043, -0x0267, 0x0c9d, 0x74bb,
-0x11b4, 0x09b8, -0x05bf, 0x0372,
-0x01a8, 0x00a6, -0x001b, 0x0005,
0x0006, -0x0008, 0x0003, -0x0001,
0x0000
};
static const int16_t g_zigzag_table2[] = {
0x0000, 0x0000, -0x0001, 0x0003,
-0x0002, -0x0005, 0x001f, -0x004a,
0x00b3, -0x0192, 0x02b1, -0x039e,
0x04f8, -0x05a6, 0x7939, -0x05a6,
0x04f8, -0x039e, 0x02b1, -0x0192,
0x00b3, -0x004a, 0x001f, -0x0005,
-0x0002, 0x0003, -0x0001, 0x0000,
0x0000
};
static const int16_t g_zigzag_table3[] = {
0x0000, -0x0001, 0x0003, -0x0008,
0x0006, 0x0005, -0x001b, 0x00a6,
-0x01a8, 0x0372, -0x05bf, 0x09b8,
-0x11b4, 0x74bb, 0x0c9d, -0x0267,
-0x0043, 0x0132, -0x00e3, 0x00a2,
-0x004b, 0x003c, -0x0013, 0x0003,
0x0000, -0x0002, 0x0000, 0x0000,
0x0000
};
static const int16_t g_zigzag_table4[] = {
-0x0001, 0x0003, -0x0008, 0x0011,
-0x0010, 0x000a, 0x006b, -0x016d,
0x0350, -0x0623, 0x0bcd, -0x1780,
0x6794, 0x234c, -0x0a78, 0x0400,
-0x010a, 0x0009, 0x0034, -0x0054,
0x0041, -0x0022, 0x000a, -0x0001,
0x0000, 0x0001, 0x0000, 0x0000,
0x0000
};
static const int16_t g_zigzag_table5[] = {
0x0002, -0x0008, 0x0010, -0x0023,
0x002b, 0x001a, -0x00eb, 0x027b,
-0x0548, 0x0afa, -0x16fa, 0x53e0,
0x3c07, -0x1249, 0x080e, -0x0347,
0x015b, -0x0044, -0x0017, 0x0046,
-0x0023, 0x0011, -0x0005, 0x0000,
0x0000, 0x0000, 0x0000, 0x0000,
0x0000
};
static const int16_t g_zigzag_table6[] = {
-0x0005, 0x0011, -0x0023, 0x0046,
-0x0017, -0x0044, 0x015b, -0x0347,
0x080e, -0x1249, 0x3c07, 0x53e0,
-0x16fa, 0x0afa, -0x0548, 0x027b,
-0x00eb, 0x001a, 0x002b, -0x0023,
0x0010, -0x0008, 0x0002, 0x0000,
0x0000, 0x0000, 0x0000, 0x0000,
0x0000
};
static const int16_t* g_zigzag_table[] = {
g_zigzag_table0,
g_zigzag_table1,
g_zigzag_table2,
g_zigzag_table3,
g_zigzag_table4,
g_zigzag_table5,
g_zigzag_table6
};
static const uint8_t g_getid_no_disc[] = {
0x08, 0x40, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00
};
static const uint8_t g_getid_audio[] = {
0x0a, 0x90, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00
};
static const uint8_t g_getid_unlicensed[] = {
0x0a, 0x80, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00
};
static const uint8_t g_getid_licensed[] = {
0x02, 0x00, 0x20, 0x00,
'S' , 'C' , 'E' , 'A'
};
#define RESP_PUSH(data) { \
cdrom->rfifo[cdrom->rfifo_index++] = data; \
cdrom->rfifo_index &= 15; \
SET_BITS(status, STAT_RSLRRDY_MASK, STAT_RSLRRDY_MASK); }
#define PFIFO_POP (cdrom->pfifo[--cdrom->pfifo_index])
#define VALID_BCD(v) (((v & 0xf) <= 9) && ((v & 0xf0) <= 0x90))
void cdrom_cmd_error(psx_cdrom_t* cdrom) {
SET_BITS(ifr, IFR_INT, IFR_INT5);
RESP_PUSH(cdrom->error);
RESP_PUSH(GETSTAT_MOTOR | cdrom->error_flags);
cdrom->pfifo_index = 0;
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
void cdrom_cmd_unimplemented(psx_cdrom_t* cdrom) {
// log_set_quiet(0);
log_fatal("Unimplemented CDROM command (%u)", cdrom->command);
log_set_quiet(1);
exit(1);
}
void cdrom_cmd_getstat(psx_cdrom_t* cdrom) {
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
// if (cdrom->ongoing_read_command) {
// cdrom->status |= STAT_BUSYSTS_MASK;
// // printf("command=%02x\n", cdrom->ongoing_read_command);
// cdrom->state = CD_STATE_SEND_RESP2;
// cdrom->delayed_command = cdrom->ongoing_read_command;
// cdrom->irq_delay = DELAY_1MS;
// return;
// }
if (cdrom->pfifo_index) {
log_fatal("CdlGetStat: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_GETSTAT;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(
GETSTAT_MOTOR |
((cdrom->cdda_playing || cdrom->xa_playing) ? GETSTAT_PLAY : 0) |
(cdrom->ongoing_read_command ? GETSTAT_READ : 0) |
(cdrom->disc ? 0 : GETSTAT_TRAYOPEN)
);
if (cdrom->ongoing_read_command) {
// printf("getstat command=%02x\n", cdrom->ongoing_read_command);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
}
}
void cdrom_cmd_setloc(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index != 3) {
log_fatal("CdlSetloc: Expected exactly 3 parameters, got %u instead",
cdrom->pfifo_index
);
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
int f = PFIFO_POP;
int s = PFIFO_POP;
int m = PFIFO_POP;
if (!(VALID_BCD(m) && VALID_BCD(s) && VALID_BCD(f) && (f < 0x75))) {
printf("setloc: invalid msf\n");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->seek_msf.m = m;
cdrom->seek_msf.s = s;
cdrom->seek_msf.f = f;
msf_from_bcd(&cdrom->seek_msf);
cdrom->cdda_msf = cdrom->seek_msf;
cdrom->seek_pending = 1;
// printf("setloc: %02x:%02x:%02x\n",
// cdrom->seek_msf.m,
// cdrom->seek_msf.s,
// cdrom->seek_msf.f
// );
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_SETLOC;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_SEEK);
if (cdrom->ongoing_read_command) {
// printf("command=%02x\n", cdrom->ongoing_read_command);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
// Read ongoing
case CD_STATE_SEND_RESP2: {
int f = PFIFO_POP;
int s = PFIFO_POP;
int m = PFIFO_POP;
if (!(VALID_BCD(m) && VALID_BCD(s) && VALID_BCD(f) && (f < 0x75))) {
cdrom->ongoing_read_command = false;
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->seek_msf.m = m;
cdrom->seek_msf.s = s;
cdrom->seek_msf.f = f;
} break;
}
}
void cdrom_cmd_play(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
int track = 0;
if (cdrom->cdda_playing) {
cdrom->pfifo_index = 0;
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_PLAY;
return;
}
// Optional track number parameter
if (cdrom->pfifo_index)
track = PFIFO_POP;
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_PLAY;
printf("play track %u\n", track);
if (track) {
psx_disc_get_track_addr(cdrom->disc, &cdrom->cdda_msf, track);
msf_to_bcd(&cdrom->cdda_msf);
cdrom->cdda_track = track;
cdrom->seek_msf.m = cdrom->cdda_msf.m;
cdrom->seek_msf.s = cdrom->cdda_msf.s;
cdrom->seek_msf.f = cdrom->cdda_msf.f;
cdrom->seek_pending = 1;
}
if (cdrom->seek_pending) {
cdrom->seek_pending = 0;
// printf("Seeked to location\n");
cdrom->cdda_msf = cdrom->seek_msf;
// Seek to that address and read sector
psx_disc_seek(cdrom->disc, cdrom->cdda_msf);
psx_disc_read_sector(cdrom->disc, cdrom->cdda_buf);
// Increment sector
msf_add_f(&cdrom->cdda_msf, 1);
cdrom->cdda_sector_offset = 0;
}
cdrom->cdda_playing = 1;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_PLAY);
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_readn(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
cdrom->ongoing_read_command = CDL_READN;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
log_fatal("CdlReadN: CD_STATE_RECV_CMD");
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_READN;
} break;
case CD_STATE_SEND_RESP1: {
log_fatal("CdlReadN: CD_STATE_SEND_RESP1");
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(GETSTAT_MOTOR);
if (cdrom->mode & MODE_XA_ADPCM) {
cdrom->xa_msf = cdrom->seek_msf;
cdrom->xa_playing = 1;
cdrom->xa_remaining_samples = 0;
SET_BITS(status, STAT_ADPBUSY_MASK, STAT_ADPBUSY_MASK);
printf("Play XA-ADPCM encoded song at %02u:%02u:%02u, filter=%u, file=%02x, channel=%02x (ReadN)\n",
cdrom->xa_msf.m,
cdrom->xa_msf.s,
cdrom->xa_msf.f,
(cdrom->mode & MODE_XA_FILTER) != 0,
cdrom->xa_file,
cdrom->xa_channel
);
}
int err = psx_disc_seek(cdrom->disc, cdrom->seek_msf);
if (err) {
// log_set_quiet(0);
log_fatal("CdlReadN: Out of bounds seek");
log_set_quiet(1);
cdrom->irq_delay = DELAY_1MS * 600;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_SEEKERROR;
return;
}
psx_disc_read_sector(cdrom->disc, cdrom->dfifo);
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = double_speed ? READ_DOUBLE_DELAY : READ_SINGLE_DELAY;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_READN;
if (cdrom->spin_delay) {
cdrom->irq_delay += cdrom->spin_delay;
cdrom->spin_delay = 0;
}
} break;
case CD_STATE_SEND_RESP2: {
log_fatal("CdlReadS: CD_STATE_SEND_RESP2");
// Returning only non-ADPCM sectors causes desync for some
// reason. I'll keep returning all sectors for now
if (cdrom->mode & MODE_XA_ADPCM) {
// printf("ReadS fetching non ADPCM sector...\n");
cdrom_fetch_video_sector(cdrom);
// printf("%02u:%02u:%02u - file=%02x channel=%02x sm=%02x ci=%02x\n",
// cdrom->seek_msf.m,
// cdrom->seek_msf.s,
// cdrom->seek_msf.f,
// cdrom->dfifo[0x10],
// cdrom->dfifo[0x11],
// cdrom->dfifo[0x12],
// cdrom->dfifo[0x13]
// );
} else {
psx_disc_seek(cdrom->disc, cdrom->seek_msf);
psx_disc_read_sector(cdrom->disc, cdrom->dfifo);
msf_add_f(&cdrom->seek_msf, 1);
}
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = double_speed ? READ_DOUBLE_DELAY : READ_SINGLE_DELAY;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_READN;
cdrom->dfifo_index = 0;
SET_BITS(ifr, IFR_INT, IFR_INT1);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_READ);
} break;
}
}
void cdrom_cmd_motoron(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->ongoing_read_command = CDL_NONE;
cdrom->cdda_playing = 0;
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_MOTORON;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_READ);
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = DELAY_1MS * (double_speed ? 70 : 65);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_MOTORON;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_stop(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->ongoing_read_command = CDL_NONE;
cdrom->cdda_playing = 0;
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_STOP;
cdrom->seek_msf.m = 0;
cdrom->seek_msf.s = 0;
cdrom->seek_msf.f = 0;
cdrom->cdda_msf = cdrom->seek_msf;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_READ);
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = DELAY_1MS * (double_speed ? 70 : 65);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_STOP;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_pause(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->ongoing_read_command = CDL_NONE;
cdrom->cdda_playing = 0;
cdrom->xa_playing = 0;
SET_BITS(status, STAT_ADPBUSY_MASK, 0);
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_PAUSE;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_READ);
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = DELAY_1MS * (double_speed ? 70 : 65);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_PAUSE;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_init(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_INIT;
cdrom->ongoing_read_command = CDL_NONE;
cdrom->mode = 0;
cdrom->dfifo_index = 0;
cdrom->dfifo_full = 0;
cdrom->pfifo_index = 0;
cdrom->rfifo_index = 0;
cdrom->seek_msf.m = 0;
cdrom->seek_msf.s = 2;
cdrom->seek_msf.f = 0;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_INIT;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_mute(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index) {
log_fatal("CdlMute: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_MUTE;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(cdrom->stat);
if (cdrom->ongoing_read_command) {
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
}
}
void cdrom_cmd_unmute(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index) {
log_fatal("CdlUnmute: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_DEMUTE;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(cdrom->stat);
if (cdrom->ongoing_read_command) {
// printf("command=%02x\n", cdrom->ongoing_read_command);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
}
}
void cdrom_cmd_setfilter(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index != 2) {
log_fatal("CdlSetfilter: Expected exactly 2 parameter");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->xa_channel = PFIFO_POP;
cdrom->xa_file = PFIFO_POP;
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_SETFILTER;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
cdrom->delayed_command = CDL_NONE;
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(cdrom->stat);
if (cdrom->ongoing_read_command) {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->state = CD_STATE_SEND_RESP2;
}
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_setmode(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
// Not doing this fixes a graphical issue in
// Castlevania - Symphony of the Night, but breaks
// Road Rash.
// cdrom->ongoing_read_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index != 1) {
log_fatal("CdlSetmode: Expected exactly 1 parameter");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
int prev_speed = cdrom->mode & MODE_SPEED;
cdrom->mode = PFIFO_POP;
if ((cdrom->mode & MODE_SPEED) != prev_speed)
cdrom->spin_delay = 0; // DELAY_1MS * 650;
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_SETMODE;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
cdrom->delayed_command = CDL_NONE;
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(GETSTAT_MOTOR);
if (cdrom->ongoing_read_command) {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->state = CD_STATE_SEND_RESP2;
return;
}
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_getparam(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_GETPARAM;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
cdrom->delayed_command = CDL_NONE;
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(cdrom->xa_channel);
RESP_PUSH(cdrom->xa_file);
RESP_PUSH(0x00);
RESP_PUSH(cdrom->mode);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_getlocl(psx_cdrom_t* cdrom) {
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_GETLOCL;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(cdrom->xa_sector_buf[0x13]);
RESP_PUSH(cdrom->xa_sector_buf[0x12]);
RESP_PUSH(cdrom->xa_sector_buf[0x11]);
RESP_PUSH(cdrom->xa_sector_buf[0x10]);
RESP_PUSH(cdrom->xa_sector_buf[0x0f]);
RESP_PUSH(cdrom->xa_sector_buf[0x0e]);
RESP_PUSH(cdrom->xa_sector_buf[0x0d]);
RESP_PUSH(cdrom->xa_sector_buf[0x0c]);
if (cdrom->ongoing_read_command) {
// printf("command=%02x\n", cdrom->ongoing_read_command);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
}
}
void cdrom_cmd_getlocp(psx_cdrom_t* cdrom) {
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_GETLOCP;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
msf_t absolute = cdrom->xa_playing ? cdrom->xa_msf : cdrom->seek_msf;
msf_t relative = absolute;
msf_t track_msf = cdrom_get_track_addr(cdrom, absolute);
relative.m -= track_msf.m;
relative.s -= track_msf.s;
relative.f -= track_msf.f;
msf_adjust_sub(&relative);
// printf("abs=%02u:%02u:%02u tra=%02u:%02u:%02u rel=%02u:%02u:%02u\n",
// absolute.m,
// absolute.s,
// absolute.f,
// track_msf.m,
// track_msf.s,
// track_msf.f,
// relative.m,
// relative.s,
// relative.f
// );
msf_to_bcd(&absolute);
msf_to_bcd(&relative);
// printf("getlocp 01 01 %02x:%02x:%02x %02x:%02x:%02x\n",
// relative.m,
// relative.s,
// relative.f,
// absolute.m,
// absolute.s,
// absolute.f
// );
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(absolute.f);
RESP_PUSH(absolute.s);
RESP_PUSH(absolute.m);
RESP_PUSH(relative.f);
RESP_PUSH(relative.s);
RESP_PUSH(relative.m);
RESP_PUSH(0x01);
RESP_PUSH(0x01);
if (cdrom->ongoing_read_command) {
printf("getlocp command=%02x\n", cdrom->ongoing_read_command);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
}
}
void cdrom_cmd_setsession(psx_cdrom_t* cdrom) {
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_SETSESSION;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->pfifo_index = 0;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(GETSTAT_SEEK | GETSTAT_MOTOR);
cdrom->delayed_command = CDL_SETSESSION;
cdrom->state = CD_STATE_SEND_RESP2;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, IFR_INT2);
RESP_PUSH(GETSTAT_SEEK | GETSTAT_MOTOR);
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_gettn(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index) {
log_fatal("CdlGetTN: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_GETTN;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
int tn;
psx_disc_get_track_count(cdrom->disc, &tn);
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(tn);
RESP_PUSH(0x01);
RESP_PUSH(GETSTAT_MOTOR);
if (cdrom->ongoing_read_command) {
//// printf("command=%02x\n", cdrom->ongoing_read_command);
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = cdrom->ongoing_read_command;
cdrom->irq_delay = DELAY_1MS;
} else {
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
}
} break;
}
}
void cdrom_cmd_gettd(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index != 1) {
log_fatal("CdlGetTD: Expected exactly 1 parameter");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->gettd_track = PFIFO_POP;
if (!VALID_BCD(cdrom->gettd_track)) {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
int err = psx_disc_get_track_addr(cdrom->disc, NULL, cdrom->gettd_track);
if (err) {
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_GETTD;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
msf_t td;
psx_disc_get_track_addr(cdrom->disc, &td, cdrom->gettd_track);
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(ITOB(td.s));
RESP_PUSH(ITOB(td.m));
RESP_PUSH(GETSTAT_MOTOR);
cdrom->delayed_command = CDL_NONE;
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_seekl(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index) {
log_fatal("CdlSeekL: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_SEEKL;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_SEEKL;
psx_disc_seek(cdrom->disc, cdrom->seek_msf);
cdrom->seek_pending = 0;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_seekp(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index) {
log_fatal("CdlSeekP: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_SEEKP;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_SEEKP;
psx_disc_seek(cdrom->disc, cdrom->seek_msf);
cdrom->seek_pending = 0;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_test(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index != 1) {
log_fatal("CdlTest: Expected exactly 1 parameter");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
if (PFIFO_POP != 0x20) {
log_fatal("CdlTest: Unhandled subcommand");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_TEST;
cdrom->state = CD_STATE_SEND_RESP1;
} break;
case CD_STATE_SEND_RESP1: {
cdrom->delayed_command = CDL_NONE;
// 95h,05h,16h,C1h
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(0xc1);
RESP_PUSH(0x16);
RESP_PUSH(0x05);
RESP_PUSH(0x95);
cdrom->state = CD_STATE_RECV_CMD;
} break;
}
}
void cdrom_cmd_getid(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
if (cdrom->pfifo_index) {
log_fatal("CdlGetID: Expected exactly 0 parameters");
cdrom->irq_delay = DELAY_1MS;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_PCOUNT;
cdrom->error_flags = GETSTAT_ERROR;
return;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_GETID;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_GETID;
} break;
case CD_STATE_SEND_RESP2: {
if (cdrom->disc) {
SET_BITS(ifr, IFR_INT, 2);
switch (cdrom->cd_type) {
case CDT_LICENSED: {
for (int i = 0; i < GETID_RESPONSE_SIZE; i++)
RESP_PUSH(g_getid_licensed[GETID_RESPONSE_END - i]);
} break;
case CDT_AUDIO: {
for (int i = 0; i < GETID_RESPONSE_SIZE; i++)
RESP_PUSH(g_getid_audio[GETID_RESPONSE_END - i]);
} break;
case CDT_UNKNOWN: {
for (int i = 0; i < GETID_RESPONSE_SIZE; i++)
RESP_PUSH(g_getid_unlicensed[GETID_RESPONSE_END - i]);
} break;
}
} else {
SET_BITS(ifr, IFR_INT, 5);
for (int i = 0; i < GETID_RESPONSE_SIZE; i++)
RESP_PUSH(g_getid_no_disc[GETID_RESPONSE_END - i]);
}
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_reads(psx_cdrom_t* cdrom) {
cdrom->delayed_command = CDL_NONE;
cdrom->ongoing_read_command = CDL_READS;
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
log_fatal("CdlReadS: CD_STATE_RECV_CMD");
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_READS;
} break;
case CD_STATE_SEND_RESP1: {
printf("CdlReadS: CD_STATE_SEND_RESP1\n");
log_fatal("CdlReadS: CD_STATE_SEND_RESP1");
SET_BITS(ifr, IFR_INT, IFR_INT3);
RESP_PUSH(GETSTAT_MOTOR);
if (cdrom->mode & MODE_XA_ADPCM) {
cdrom->xa_msf = cdrom->seek_msf;
cdrom->xa_playing = 1;
cdrom->xa_remaining_samples = 0;
SET_BITS(status, STAT_ADPBUSY_MASK, STAT_ADPBUSY_MASK);
printf("Play XA-ADPCM encoded song at %02u:%02u:%02u, filter=%u, file=%02x, channel=%02x (ReadS)\n",
cdrom->xa_msf.m,
cdrom->xa_msf.s,
cdrom->xa_msf.f,
(cdrom->mode & MODE_XA_FILTER) != 0,
cdrom->xa_file,
cdrom->xa_channel
);
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = double_speed ? READ_DOUBLE_DELAY : READ_SINGLE_DELAY;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_READS;
// if (cdrom->spin_delay) {
// cdrom->irq_delay += cdrom->spin_delay;
// cdrom->spin_delay = 0;
// }
return;
}
int err = psx_disc_seek(cdrom->disc, cdrom->seek_msf);
if (err) {
log_fatal("CdlReadS: Out of bounds seek");
cdrom->irq_delay = DELAY_1MS * 600;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_SEEKERROR;
return;
}
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = double_speed ? READ_DOUBLE_DELAY : READ_SINGLE_DELAY;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_READS;
if (cdrom->spin_delay) {
cdrom->irq_delay += cdrom->spin_delay;
cdrom->spin_delay = 0;
}
} break;
case CD_STATE_SEND_RESP2: {
log_fatal("CdlReadS: CD_STATE_SEND_RESP2");
// Returning only non-ADPCM sectors causes desync for some
// reason. I'll keep returning all sectors for now
if (cdrom->mode & MODE_XA_ADPCM) {
// printf("ReadS fetching non ADPCM sector...\n");
cdrom_fetch_video_sector(cdrom);
// printf("%02u:%02u:%02u - file=%02x channel=%02x sm=%02x ci=%02x\n",
// cdrom->seek_msf.m,
// cdrom->seek_msf.s,
// cdrom->seek_msf.f,
// cdrom->dfifo[0x10],
// cdrom->dfifo[0x11],
// cdrom->dfifo[0x12],
// cdrom->dfifo[0x13]
// );
} else {
psx_disc_seek(cdrom->disc, cdrom->seek_msf);
psx_disc_read_sector(cdrom->disc, cdrom->dfifo);
msf_add_f(&cdrom->seek_msf, 1);
}
int double_speed = cdrom->mode & MODE_SPEED;
cdrom->irq_delay = double_speed ? READ_DOUBLE_DELAY : READ_SINGLE_DELAY;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_READS;
cdrom->dfifo_index = 0;
SET_BITS(ifr, IFR_INT, IFR_INT1);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_READ);
} break;
}
}
void cdrom_cmd_readtoc(psx_cdrom_t* cdrom) {
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->status |= STAT_BUSYSTS_MASK;
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_READTOC;
} break;
case CD_STATE_SEND_RESP1: {
SET_BITS(ifr, IFR_INT, 3);
RESP_PUSH(GETSTAT_MOTOR | GETSTAT_READ);
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP2;
cdrom->delayed_command = CDL_READTOC;
} break;
case CD_STATE_SEND_RESP2: {
SET_BITS(ifr, IFR_INT, 2);
RESP_PUSH(GETSTAT_MOTOR);
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
void cdrom_cmd_videocd(psx_cdrom_t* cdrom) {
switch (cdrom->state) {
case CD_STATE_RECV_CMD: {
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_SEND_RESP1;
cdrom->delayed_command = CDL_VIDEOCD;
cdrom->pfifo_index = 0;
} break;
case CD_STATE_SEND_RESP1: {
printf("VideoCD task %02x\n", cdrom->pfifo[4]);
SET_BITS(ifr, IFR_INT, 3);
switch (cdrom->pfifo[4]) {
case 0: {
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(GETSTAT_MOTOR);
} break;
case 1: {
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x81);
RESP_PUSH(GETSTAT_MOTOR);
} break;
case 2: {
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x00);
RESP_PUSH(0x05);
RESP_PUSH(GETSTAT_MOTOR);
} break;
}
cdrom->irq_delay = DELAY_1MS;
cdrom->state = CD_STATE_RECV_CMD;
cdrom->delayed_command = CDL_NONE;
} break;
}
}
typedef void (*cdrom_cmd_t)(psx_cdrom_t*);
const char* g_psx_cdrom_command_names[] = {
"CdlUnimplemented",
"CdlGetstat",
"CdlSetloc",
"CdlPlay",
"CdlUnimplemented",
"CdlUnimplemented",
"CdlReadn",
"CdlMotoron",
"CdlStop",
"CdlPause",
"CdlInit",
"CdlMute",
"CdlUnmute",
"CdlSetfilter",
"CdlSetmode",
"CdlGetparam",
"CdlGetlocl",
"CdlGetlocp",
"CdlSetsession",
"CdlGettn",
"CdlGettd",
"CdlSeekl",
"CdlSeekp",
"CdlUnimplemented",
"CdlUnimplemented",
"CdlTest",
"CdlGetid",
"CdlReads",
"CdlUnimplemented",
"CdlUnimplemented",
"CdlReadtoc",
"CdlVideoCD"
};
cdrom_cmd_t g_psx_cdrom_command_table[] = {
cdrom_cmd_unimplemented,
cdrom_cmd_getstat,
cdrom_cmd_setloc,
cdrom_cmd_play,
cdrom_cmd_unimplemented,
cdrom_cmd_unimplemented,
cdrom_cmd_readn,
cdrom_cmd_motoron,
cdrom_cmd_stop,
cdrom_cmd_pause,
cdrom_cmd_init,
cdrom_cmd_mute,
cdrom_cmd_unmute,
cdrom_cmd_setfilter,
cdrom_cmd_setmode,
cdrom_cmd_getparam,
cdrom_cmd_getlocl,
cdrom_cmd_getlocp,
cdrom_cmd_setsession,
cdrom_cmd_gettn,
cdrom_cmd_gettd,
cdrom_cmd_seekl,
cdrom_cmd_seekp,
cdrom_cmd_unimplemented,
cdrom_cmd_unimplemented,
cdrom_cmd_test,
cdrom_cmd_getid,
cdrom_cmd_reads,
cdrom_cmd_unimplemented,
cdrom_cmd_unimplemented,
cdrom_cmd_readtoc,
cdrom_cmd_videocd,
// Actually an unimplemented command, we use this
// index for CD error handling
cdrom_cmd_error
};
typedef uint8_t (*psx_cdrom_read_function_t)(psx_cdrom_t*);
typedef void (*psx_cdrom_write_function_t)(psx_cdrom_t*, uint8_t);
uint8_t cdrom_read_status(psx_cdrom_t* cdrom) {
return cdrom->status;
}
uint8_t cdrom_read_rfifo(psx_cdrom_t* cdrom) {
if (cdrom->rfifo_index < 0)
return 0;
uint8_t data = cdrom->rfifo[--cdrom->rfifo_index];
if (cdrom->rfifo_index == 0)
SET_BITS(status, STAT_RSLRRDY_MASK, 0);
return data;
}
uint8_t cdrom_read_dfifo(psx_cdrom_t* cdrom) {
if (!cdrom->dfifo_full)
return 0;
int sector_size_bit = cdrom->mode & MODE_SECTOR_SIZE;
uint32_t sector_size = sector_size_bit ? 0x924 : 0x800;
uint32_t offset = sector_size_bit ? 12 : 24;
if (cdrom->dfifo_index < sector_size) {
SET_BITS(status, STAT_DRQSTS_MASK, STAT_DRQSTS_MASK);
uint8_t data = cdrom->dfifo[offset + (cdrom->dfifo_index++)];
if (cdrom->dfifo_index >= sector_size)
SET_BITS(status, STAT_DRQSTS_MASK, 0);
return data;
}
return 0;
}
uint8_t cdrom_read_ier(psx_cdrom_t* cdrom) {
return cdrom->ier;
}
uint8_t cdrom_read_ifr(psx_cdrom_t* cdrom) {
return 0xe0 | cdrom->ifr;
}
void cdrom_write_status(psx_cdrom_t* cdrom, uint8_t value) {
SET_BITS(status, STAT_INDEX_MASK, value);
}
void cdrom_write_cmd(psx_cdrom_t* cdrom, uint8_t value) {
printf("%s(%02x) %u params=[%02x, %02x, %02x, %02x, %02x, %02x]\n",
g_psx_cdrom_command_names[value],
value,
cdrom->pfifo_index,
cdrom->pfifo[0],
cdrom->pfifo[1],
cdrom->pfifo[2],
cdrom->pfifo[3],
cdrom->pfifo[4],
cdrom->pfifo[5]
);
cdrom->command = value;
cdrom->state = CD_STATE_RECV_CMD;
// Required for Spyro - The Year of the Dragon
if (!cdrom->command) {
cdrom->irq_delay = DELAY_1MS * 600;
cdrom->delayed_command = CDL_ERROR;
cdrom->state = CD_STATE_ERROR;
cdrom->error = ERR_INVSUBF;
cdrom->error_flags = GETSTAT_SEEKERROR;
return;
}
g_psx_cdrom_command_table[value](cdrom);
}
void cdrom_write_pfifo(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->pfifo[(cdrom->pfifo_index++) & 0xf] = value;
SET_BITS(status, STAT_PRMWRDY_MASK, (cdrom->pfifo_index & 0x10) ? 0x0 : 0xff);
cdrom->pfifo_index &= 0x1f;
}
void cdrom_write_req(psx_cdrom_t* cdrom, uint8_t value) {
if (value & REQ_BFRD) {
SET_BITS(status, STAT_DRQSTS_MASK, STAT_DRQSTS_MASK);
cdrom->dfifo_full = 1;
} else {
SET_BITS(status, STAT_DRQSTS_MASK, 0);
cdrom->dfifo_full = 0;
}
}
void cdrom_write_smdout(psx_cdrom_t* cdrom, uint8_t value) {
log_fatal("Sound map data out unimplemented");
}
void cdrom_write_ier(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->ier = value;
}
void cdrom_write_ifr(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->ifr &= ~(value & 0x1f);
// Clear Parameter FIFO
if (value & 0x40) {
cdrom->pfifo_index = 0;
SET_BITS(
status,
(STAT_PRMEMPT_MASK | STAT_PRMWRDY_MASK),
(STAT_PRMEMPT_MASK | STAT_PRMWRDY_MASK)
);
}
}
void cdrom_write_sminfo(psx_cdrom_t* cdrom, uint8_t value) {
log_fatal("Sound map coding info unimplemented");
}
void cdrom_write_lcdlspuv(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->vapp[0] = value;
}
void cdrom_write_rcdrspuv(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->vapp[3] = value;
}
void cdrom_write_rcdlspuv(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->vapp[2] = value;
}
void cdrom_write_lcdrspuv(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->vapp[1] = value;
}
void cdrom_write_volume(psx_cdrom_t* cdrom, uint8_t value) {
cdrom->xa_mute = value & 1;
if (value & 0x20) {
cdrom->vol[0] = cdrom->vapp[0];
cdrom->vol[1] = cdrom->vapp[1];
cdrom->vol[2] = cdrom->vapp[2];
cdrom->vol[3] = cdrom->vapp[3];
}
}
psx_cdrom_read_function_t g_psx_cdrom_read_table[] = {
cdrom_read_status, cdrom_read_rfifo, cdrom_read_dfifo, cdrom_read_ier,
cdrom_read_status, cdrom_read_rfifo, cdrom_read_dfifo, cdrom_read_ifr,
cdrom_read_status, cdrom_read_rfifo, cdrom_read_dfifo, cdrom_read_ier,
cdrom_read_status, cdrom_read_rfifo, cdrom_read_dfifo, cdrom_read_ifr
};
psx_cdrom_write_function_t g_psx_cdrom_write_table[] = {
cdrom_write_status, cdrom_write_cmd , cdrom_write_pfifo , cdrom_write_req ,
cdrom_write_status, cdrom_write_smdout , cdrom_write_ier , cdrom_write_ifr ,
cdrom_write_status, cdrom_write_sminfo , cdrom_write_lcdlspuv, cdrom_write_lcdrspuv,
cdrom_write_status, cdrom_write_rcdrspuv, cdrom_write_rcdlspuv, cdrom_write_volume
};
const char* g_psx_cdrom_read_names_table[] = {
"cdrom_read_status", "cdrom_read_rfifo", "cdrom_read_dfifo", "cdrom_read_ier",
"cdrom_read_status", "cdrom_read_rfifo", "cdrom_read_dfifo", "cdrom_read_ifr",
"cdrom_read_status", "cdrom_read_rfifo", "cdrom_read_dfifo", "cdrom_read_ier",
"cdrom_read_status", "cdrom_read_rfifo", "cdrom_read_dfifo", "cdrom_read_ifr"
};
const char* g_psx_cdrom_write_names_table[] = {
"cdrom_write_status", "cdrom_write_cmd" , "cdrom_write_pfifo" , "cdrom_write_req" ,
"cdrom_write_status", "cdrom_write_smdout" , "cdrom_write_ier" , "cdrom_write_ifr" ,
"cdrom_write_status", "cdrom_write_sminfo" , "cdrom_write_lcdlspuv", "cdrom_write_lcdrspuv",
"cdrom_write_status", "cdrom_write_rcdrspuv", "cdrom_write_rcdlspuv", "cdrom_write_volume"
};
psx_cdrom_t* psx_cdrom_create(void) {
return (psx_cdrom_t*)malloc(sizeof(psx_cdrom_t));
}
#define XA_STEREO_SAMPLES 2016
#define XA_MONO_SAMPLES 4032
#define XA_DECODED_SAMPLES 37632
#define XA_RINGBUF_SIZE 32
#define XA_STEREO_RESAMPLE_SIZE 2352
#define XA_MONO_RESAMPLE_SIZE 4704
void psx_cdrom_init(psx_cdrom_t* cdrom, psx_ic_t* ic) {
memset(cdrom, 0, sizeof(psx_cdrom_t));
cdrom->io_base = PSX_CDROM_BEGIN;
cdrom->io_size = PSX_CDROM_SIZE;
cdrom->ic = ic;
cdrom->status = STAT_PRMEMPT_MASK | STAT_PRMWRDY_MASK | STAT_RSLRRDY_MASK;
cdrom->dfifo = malloc(CD_SECTOR_SIZE);
cdrom->cdda_buf = malloc(CD_SECTOR_SIZE);
// Initialize XA state
cdrom->xa_sector_buf = malloc(CD_SECTOR_SIZE);
cdrom->xa_left_buf = malloc(XA_STEREO_SAMPLES * sizeof(int16_t));
cdrom->xa_right_buf = malloc(XA_STEREO_SAMPLES * sizeof(int16_t));
cdrom->xa_mono_buf = malloc(XA_MONO_SAMPLES * sizeof(int16_t));
cdrom->xa_upsample_buf = malloc(((14112 * 2) + 6) * sizeof(int16_t));
cdrom->xa_left_resample_buf = malloc((XA_STEREO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
cdrom->xa_right_resample_buf = malloc((XA_STEREO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
cdrom->xa_mono_resample_buf = malloc((XA_MONO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
cdrom->xa_step = 6;
// We will use this whenever we implement proper
// XA interpolation
(void)g_zigzag_table;
memset(cdrom->xa_left_buf, 0, XA_STEREO_SAMPLES * sizeof(int16_t));
memset(cdrom->xa_right_buf, 0, XA_STEREO_SAMPLES * sizeof(int16_t));
memset(cdrom->xa_mono_buf, 0, XA_MONO_SAMPLES * sizeof(int16_t));
memset(cdrom->xa_upsample_buf, 0, ((14112 * 2) + 6) * sizeof(int16_t));
memset(cdrom->xa_left_resample_buf, 0, (XA_STEREO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
memset(cdrom->xa_right_resample_buf, 0, (XA_STEREO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
memset(cdrom->xa_mono_resample_buf, 0, (XA_MONO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
cdrom->seek_msf.m = 0;
cdrom->seek_msf.s = 2;
cdrom->seek_msf.f = 0;
}
uint32_t psx_cdrom_read32(psx_cdrom_t* cdrom, uint32_t offset) {
// log_set_quiet(0);
log_fatal("Unhandled 32-bit CDROM read at offset %08x", offset);
// exit(1);
return 0x0;
}
uint16_t psx_cdrom_read16(psx_cdrom_t* cdrom, uint32_t offset) {
// log_set_quiet(0);
log_fatal("Unhandled 16-bit CDROM read at offset %08x", offset);
// exit(1);
return 0x0;
}
uint8_t psx_cdrom_read8(psx_cdrom_t* cdrom, uint32_t offset) {
uint8_t data = g_psx_cdrom_read_table[(STAT_INDEX << 2) | offset](cdrom);
if (((STAT_INDEX << 2) | offset) == 2)
return data;
// // log_set_quiet(0);
// log_fatal("%s (read %02x)", g_psx_cdrom_read_names_table[(STAT_INDEX << 2) | offset], data);
// log_set_quiet(1);
return data;
}
void psx_cdrom_write32(psx_cdrom_t* cdrom, uint32_t offset, uint32_t value) {
// log_set_quiet(0);
log_fatal("Unhandled 32-bit CDROM write at offset %08x (%08x)", offset, value);
// exit(1);
}
void psx_cdrom_write16(psx_cdrom_t* cdrom, uint32_t offset, uint16_t value) {
// log_set_quiet(0);
log_fatal("Unhandled 16-bit CDROM write at offset %08x (%04x)", offset, value);
// exit(1);
}
void psx_cdrom_write8(psx_cdrom_t* cdrom, uint32_t offset, uint8_t value) {
// // log_set_quiet(0);
// log_fatal("%s (write %02x)", g_psx_cdrom_write_names_table[(STAT_INDEX << 2) | offset], value);
// log_set_quiet(1);
g_psx_cdrom_write_table[(STAT_INDEX << 2) | offset](cdrom, value);
}
void psx_cdrom_update(psx_cdrom_t* cdrom, int cyc) {
if (cdrom->irq_delay) {
cdrom->irq_delay -= cyc;
if (cdrom->irq_delay <= 0) {
if (!cdrom->irq_disable) {
psx_ic_irq(cdrom->ic, IC_CDROM);
} else {
cdrom->irq_disable = 0;
}
cdrom->irq_delay = 0;
if (cdrom->delayed_command) {
// // log_set_quiet(0);
// log_fatal("%s(%02x) (Delayed)",
// g_psx_cdrom_command_names[cdrom->delayed_command],
// cdrom->delayed_command
// );
// log_set_quiet(1);
g_psx_cdrom_command_table[cdrom->delayed_command](cdrom);
}
// // log_set_quiet(0);
// log_fatal("CDROM INT%u", cdrom->ifr & 0x7);
// log_set_quiet(1);
}
}
}
const char* g_psx_cdrom_extensions[] = {
"cue",
"bin",
0
};
enum {
CD_EXT_CUE,
CD_EXT_BIN,
CD_EXT_UNSUPPORTED
};
int cdrom_get_extension(const char* path) {
const char* ptr = &path[strlen(path) - 1];
int i = 0;
while ((*ptr != '.') && (ptr != path))
ptr--;
if (ptr == path)
return CD_EXT_UNSUPPORTED;
while (g_psx_cdrom_extensions[i]) {
if (!strcmp(ptr + 1, g_psx_cdrom_extensions[i]))
return i;
++i;
}
return CD_EXT_UNSUPPORTED;
}
void cdrom_check_cd_type(psx_cdrom_t* cdrom) {
char buf[CD_SECTOR_SIZE];
// Seek to Primary Volume Descriptor
msf_t pvd = { 0, 2, 16 };
// If the disc is smaller than 16 sectors
// then it can't be a PlayStation game.
// Audio discs should also have ISO volume
// descriptors, so it's probably something else
// entirely.
if (psx_disc_seek(cdrom->disc, pvd)) {
cdrom->cd_type = CDT_UNKNOWN;
return;
}
psx_disc_read_sector(cdrom->disc, buf);
// Check for the "PLAYSTATION" string at PVD offset 20h
// Patch 20 byte so comparison is done correctly
buf[0x2b] = 0;
if (strncmp(&buf[0x20], "PLAYSTATION", 12)) {
cdrom->cd_type = CDT_AUDIO;
return;
}
cdrom->cd_type = CDT_LICENSED;
}
void psx_cdrom_open(psx_cdrom_t* cdrom, const char* path) {
cdrom->disc = psx_disc_create();
int len = strlen(path);
char* lower = malloc(len + 1);
for (int i = 0; i < len; i++)
lower[i] = tolower(path[i]);
lower[len] = '\0';
int ext = cdrom_get_extension(lower);
int error = 0;
switch (ext) {
case CD_EXT_CUE: {
psxd_cue_t* cue = psxd_cue_create();
psxd_cue_init_disc(cue, cdrom->disc);
psxd_cue_init(cue);
error = psxd_cue_load(cue, path);
if (error)
break;
cdrom_check_cd_type(cdrom);
} break;
case CD_EXT_BIN: {
psxd_bin_t* bin = psxd_bin_create();
psxd_bin_init_disc(bin, cdrom->disc);
psxd_bin_init(bin);
error = psxd_bin_load(bin, path);
if (error)
break;
cdrom_check_cd_type(cdrom);
} break;
case CD_EXT_UNSUPPORTED: {
log_fatal("Unsupported disc format");
cdrom->cd_type = CDT_UNKNOWN;
} break;
}
free(lower);
if (error) {
log_fatal("Error loading file \'%s\'", path);
exit(1);
}
}
static const int g_spu_pos_adpcm_table[] = {
0, +60, +115, +98, +122
};
static const int g_spu_neg_adpcm_table[] = {
0, 0, -52, -55, -60
};
void cdrom_resample_xa_buf(psx_cdrom_t* cdrom, int16_t* dst, int16_t* src, int stereo, int16_t ls) {
int f18khz = ((cdrom->xa_sector_buf[0x13] >> 2) & 1) == 1;
int sample_count = stereo ? XA_STEREO_SAMPLES : XA_MONO_SAMPLES;
int resample_count = stereo ? XA_STEREO_RESAMPLE_SIZE : XA_MONO_RESAMPLE_SIZE;
resample_count *= f18khz + 1;
// Nearest neighbor
// for (int i = 0; i < sample_count; i++)
// for (int k = 0; k < 7; k++)
// cdrom->xa_upsample_buf[(i*7)+k] = src[i];
// Linear Upsampling
int16_t a = ls;
int16_t b = src[0];
for (int k = 0; k < 7; k++)
cdrom->xa_upsample_buf[k] = a + ((k+1)/8) * (b - a);
for (int i = 1; i < sample_count; i++) {
a = b;
b = src[i];
for (int k = 0; k < 7; k++)
cdrom->xa_upsample_buf[(i*7)+k] =
a + ((k+1)/8) * (b - a);
}
int m = f18khz ? 3 : 6;
for (int i = 0; i < resample_count; i++)
dst[i] = cdrom->xa_upsample_buf[i*m];
cdrom->xa_remaining_samples = resample_count;
}
void cdrom_decode_xa_block(psx_cdrom_t* cdrom, int idx, int blk, int nib, int16_t* buf, int16_t* h) {
int shift = 12 - (cdrom->xa_sector_buf[idx + 4 + blk * 2 + nib] & 0x0F);
int filter = (cdrom->xa_sector_buf[idx + 4 + blk * 2 + nib] & 0x30) >> 4;
int32_t f0 = g_spu_pos_adpcm_table[filter];
int32_t f1 = g_spu_neg_adpcm_table[filter];
for (int j = 0; j < 28; j++) {
uint16_t n = (cdrom->xa_sector_buf[idx + 16 + blk + j * 4] >> (nib * 4)) & 0x0f;
int16_t t = (int16_t)(n << 12) >> 12;
int16_t s = (t << shift) + (((h[0] * f0) + (h[1] * f1) + 32) / 64);
s = (s < INT16_MIN) ? INT16_MIN : ((s > INT16_MAX) ? INT16_MAX : s);
h[1] = h[0];
h[0] = s;
buf[j] = s;
}
}
void cdrom_decode_xa_sector(psx_cdrom_t* cdrom, void* buf) {
int src = 24;
int16_t left[28];
int16_t right[28];
int16_t left_h[2] = { 0, 0 };
int16_t right_h[2] = { 0, 0 };
int16_t* left_ptr = cdrom->xa_left_buf;
int16_t* right_ptr = cdrom->xa_right_buf;
int16_t* mono_ptr = cdrom->xa_mono_buf;
for (int i = 0; i < 18; i++) {
for (int blk = 0; blk < 4; blk++) {
if (cdrom->xa_sector_buf[0x13] & 1) {
cdrom_decode_xa_block(cdrom, src, blk, 0, left, left_h);
cdrom_decode_xa_block(cdrom, src, blk, 1, right, right_h);
for (int i = 0; i < 28; i++) {
*left_ptr++ = left[i];
*right_ptr++ = right[i];
}
} else {
cdrom_decode_xa_block(cdrom, src, blk, 0, left, left_h);
for (int i = 0; i < 28; i++)
*mono_ptr++ = left[i];
cdrom_decode_xa_block(cdrom, src, blk, 1, left, left_h);
for (int i = 0; i < 28; i++)
*mono_ptr++ = left[i];
}
}
src += 128;
}
}
void cdrom_fetch_xa_sector(psx_cdrom_t* cdrom) {
while (true) {
if (psx_disc_seek(cdrom->disc, cdrom->xa_msf)) {
cdrom->xa_playing = 0;
return;
}
psx_disc_read_sector(cdrom->disc, cdrom->xa_sector_buf);
msf_add_f(&cdrom->xa_msf, 1);
// Check for EOR, EOF bits
if (cdrom->xa_sector_buf[0x12] & 0x80)
return;
// Check RT and Audio bit
if ((cdrom->xa_sector_buf[0x12] & 4) != 4)
continue;
// If we get here it means this is a real-time audio sector.
// If the XA filter is disabled, we're done
if (!(cdrom->mode & MODE_XA_FILTER))
return;
// Else check XA file/channel
int file_eq = cdrom->xa_sector_buf[0x10] == cdrom->xa_file;
int channel_eq = cdrom->xa_sector_buf[0x11] == cdrom->xa_channel;
// If they are equal to our filter values, we're done
// else keep searching
if (file_eq && channel_eq)
return;
}
}
void cdrom_apply_volume_settings(psx_cdrom_t* cdrom) {
int16_t* ptr = cdrom->cdda_buf;
float ll_vol = (((float)cdrom->vol[0]) / 255.0f);
float lr_vol = (((float)cdrom->vol[1]) / 255.0f);
float rl_vol = (((float)cdrom->vol[2]) / 255.0f);
float rr_vol = (((float)cdrom->vol[3]) / 255.0f);
for (int i = 0; i < CD_SECTOR_SIZE >> 1; i += 2) {
ptr[i ] = ptr[i ] * ll_vol + ptr[i+1] * rl_vol;
ptr[i+1] = ptr[i+1] * rr_vol + ptr[i ] * lr_vol;
}
}
void psx_cdrom_get_cdda_samples(psx_cdrom_t* cdrom, void* buf, int size, psx_spu_t* spu) {
memset(buf, 0, size);
if (!cdrom->disc)
return;
if (cdrom->xa_playing) {
int16_t* ptr = (int16_t*)buf;
for (int i = 0; i < (size >> 2); i++) {
int stereo = (cdrom->xa_sector_buf[0x13] & 1) == 1;
if (!cdrom->xa_remaining_samples) {
cdrom_fetch_xa_sector(cdrom);
if (cdrom->xa_sector_buf[0x12] & 0x80) {
SET_BITS(status, STAT_ADPBUSY_MASK, 0);
cdrom->xa_playing = 0;
cdrom->xa_remaining_samples = 0;
return;
}
stereo = (cdrom->xa_sector_buf[0x13] & 1) == 1;
cdrom_decode_xa_sector(cdrom, buf);
memset(cdrom->xa_upsample_buf, 0, ((14112 * 2) + 6) * sizeof(int16_t));
memset(cdrom->xa_left_resample_buf, 0, (XA_STEREO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
memset(cdrom->xa_right_resample_buf, 0, (XA_STEREO_RESAMPLE_SIZE * 2) * sizeof(int16_t));
if (stereo) {
cdrom_resample_xa_buf(cdrom, cdrom->xa_left_resample_buf, cdrom->xa_left_buf, stereo, cdrom->xa_last_left_sample);
cdrom_resample_xa_buf(cdrom, cdrom->xa_right_resample_buf, cdrom->xa_right_buf, stereo, cdrom->xa_last_right_sample);
} else {
cdrom_resample_xa_buf(cdrom, cdrom->xa_mono_resample_buf, cdrom->xa_mono_buf, stereo, cdrom->xa_last_mono_sample);
}
cdrom->xa_sample_idx = 0;
}
if (cdrom->xa_mute) {
*ptr++ = 0;
*ptr++ = 0;
return;
}
float ll_vol = (((float)cdrom->vol[0]) / 255.0f);
float rr_vol = (((float)cdrom->vol[3]) / 255.0f);
if (stereo) {
cdrom->xa_last_left_sample = cdrom->xa_left_resample_buf[cdrom->xa_sample_idx];
cdrom->xa_last_right_sample = cdrom->xa_right_resample_buf[cdrom->xa_sample_idx++];
float lr_vol = (((float)cdrom->vol[1]) / 255.0f);
float rl_vol = (((float)cdrom->vol[2]) / 255.0f);
*ptr++ = (cdrom->xa_last_left_sample * ll_vol) + (cdrom->xa_last_right_sample * rl_vol);
*ptr++ = (cdrom->xa_last_left_sample * lr_vol) + (cdrom->xa_last_right_sample * rr_vol);
} else {
cdrom->xa_last_mono_sample = cdrom->xa_mono_resample_buf[cdrom->xa_sample_idx++];
*ptr++ = cdrom->xa_last_mono_sample * ll_vol;
*ptr++ = cdrom->xa_last_mono_sample * rr_vol;
}
--cdrom->xa_remaining_samples;
}
return;
}
if (!cdrom->cdda_playing) {
memset(buf, 0, size);
return;
}
// Seek to that address and read sector
if (psx_disc_seek(cdrom->disc, cdrom->cdda_msf))
cdrom->cdda_playing = 0;
psx_disc_read_sector(cdrom->disc, cdrom->cdda_buf);
++cdrom->cdda_sectors_played;
// Increment sector
msf_add_f(&cdrom->cdda_msf, 1);
cdrom_apply_volume_settings(cdrom);
memcpy(buf, cdrom->cdda_buf, size);
psx_spu_update_cdda_buffer(spu, cdrom->cdda_buf);
// Handle report IRQ
if (cdrom->cdda_sectors_played == CD_SECTORS_PS) {
if (cdrom->mode & MODE_REPORT) {
SET_BITS(ifr, IFR_INT, 1);
msf_t track, current = cdrom->cdda_msf;
msf_from_bcd(¤t);
psx_disc_get_track_addr(cdrom->disc, &track, cdrom->cdda_track);
unsigned int track_s = (track.m * 60) + track.s;
unsigned int current_s = (current.m * 60) + current.s;
unsigned int diff = current_s - track_s;
current.s = diff;
current.m = 0;
msf_adjust(¤t);
//msf_to_bcd(¤t);
RESP_PUSH(0);
RESP_PUSH(0);
RESP_PUSH(cdrom->cdda_msf.f);
RESP_PUSH(current.s | 0x80);
RESP_PUSH(current.m);
RESP_PUSH(0);
RESP_PUSH(cdrom->cdda_track);
RESP_PUSH(GETSTAT_PLAY);
psx_ic_irq(cdrom->ic, IC_CDROM);
}
cdrom->cdda_sectors_played = 0;
}
}
void psx_cdrom_destroy(psx_cdrom_t* cdrom) {
if (cdrom->disc)
psx_disc_destroy(cdrom->disc);
free(cdrom);
}