Add MegaCD support code.
This commit is contained in:
sorgelig
219
support/megacd/megacd.cpp
Normal file
219
support/megacd/megacd.cpp
Normal file
@@ -0,0 +1,219 @@
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <inttypes.h>
|
||||
|
||||
#include "../../file_io.h"
|
||||
#include "../../user_io.h"
|
||||
#include "../../spi.h"
|
||||
#include "../../hardware.h"
|
||||
#include "megacd.h"
|
||||
|
||||
|
||||
int loaded = 0, unloaded = 0;
|
||||
static uint8_t has_command = 0;
|
||||
|
||||
void mcd_poll()
|
||||
{
|
||||
static uint32_t poll_timer = 0, stat_timer = 0;
|
||||
static uint8_t last_req = 255;
|
||||
static uint8_t adj = 0;
|
||||
|
||||
if (!stat_timer || CheckTimer(stat_timer))
|
||||
{
|
||||
stat_timer = GetTimer(15);
|
||||
|
||||
if (has_command) {
|
||||
spi_uio_cmd_cont(UIO_CD_SET);
|
||||
uint64_t s = cdd.GetStatus();
|
||||
spi_w((s >> 0) & 0xFFFF);
|
||||
spi_w((s >> 16) & 0xFFFF);
|
||||
spi_w(((s >> 32) & 0x00FF) | (cdd.isData ? 0x01 << 8 : 0x00 << 8));
|
||||
DisableIO();
|
||||
|
||||
has_command = 0;
|
||||
|
||||
//printf("\x1b[32mMCD: Send status, status = %04X%04X%04X, frame = %u\n\x1b[0m", (uint16_t)((s >> 32) & 0x00FF), (uint16_t)((s >> 16) & 0xFFFF), (uint16_t)((s >> 0) & 0xFFFF), frame);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
uint8_t req = spi_uio_cmd_cont(UIO_CD_GET);
|
||||
if (req != last_req)
|
||||
{
|
||||
last_req = req;
|
||||
|
||||
uint16_t data_in[4];
|
||||
data_in[0] = spi_w(0);
|
||||
data_in[1] = spi_w(0);
|
||||
data_in[2] = spi_w(0);
|
||||
DisableIO();
|
||||
|
||||
uint64_t c = *((uint64_t*)(data_in));
|
||||
cdd.SetCommand(c);
|
||||
cdd.CommandExec();
|
||||
has_command = 1;
|
||||
|
||||
|
||||
//printf("\x1b[32mMCD: Get command, command = %04X%04X%04X, has_command = %u\n\x1b[0m", data_in[2], data_in[1], data_in[0], has_command);
|
||||
}
|
||||
else
|
||||
DisableIO();
|
||||
|
||||
if (!poll_timer || CheckTimer(poll_timer))
|
||||
{
|
||||
poll_timer = GetTimer(13 + (!adj ? 1 : 0));
|
||||
if (++adj >= 3) adj = 0;
|
||||
|
||||
cdd.Update();
|
||||
}
|
||||
|
||||
|
||||
//static uint8_t state = 0;
|
||||
//
|
||||
//if (!poll_timer || CheckTimer(poll_timer))
|
||||
//{
|
||||
// if (!state) {
|
||||
// poll_timer = GetTimer(5 + (!adj ? 1 : 0));
|
||||
|
||||
// if (++adj >= 4) adj = 0;
|
||||
|
||||
// if (has_command) {
|
||||
// uint64_t s = cdd.GetStatus();
|
||||
// spi_uio_cmd_cont(UIO_CD_SET);
|
||||
// spi_w((s >> 0) & 0xFFFF);
|
||||
// spi_w((s >> 16) & 0xFFFF);
|
||||
// spi_w(((s >> 32) & 0x00FF) | (cdd.isData ? 0x01 << 8 : 0x00 << 8));
|
||||
// DisableIO();
|
||||
// //printf("\x1b[32mMCD: Send status, status = %02X%08X, frame = %u\n\x1b[0m", (uint32_t)(status >> 32), (uint32_t)status, frame);
|
||||
// }
|
||||
|
||||
// frame++;
|
||||
// }
|
||||
// else {
|
||||
// poll_timer = GetTimer(8);
|
||||
|
||||
// cdd.Update();
|
||||
|
||||
// uint16_t data_in[4];
|
||||
|
||||
// uint8_t req = spi_uio_cmd_cont(UIO_CD_GET);
|
||||
// //get the data from FPGA
|
||||
// data_in[0] = spi_w(0);
|
||||
// data_in[1] = spi_w(0);
|
||||
// data_in[2] = spi_w(0);
|
||||
// DisableIO();
|
||||
|
||||
// has_command = 0;
|
||||
// if (req != last_req)
|
||||
// {
|
||||
// last_req = req;
|
||||
|
||||
// uint64_t c = *((uint64_t*)(data_in));
|
||||
|
||||
// cdd.CommandExec(c);
|
||||
|
||||
// has_command = 1;
|
||||
|
||||
// //printf("\x1b[32mMCD: Receive command, command = %02X%08X, frame = %u\n\x1b[0m", (uint32_t)(c >> 32), (uint32_t)c, frame);
|
||||
// }
|
||||
// }
|
||||
|
||||
// state = ~state;
|
||||
//}
|
||||
}
|
||||
|
||||
|
||||
void mcd_set_image(int num, const char *filename)
|
||||
{
|
||||
(void)num;
|
||||
|
||||
if (*filename) {
|
||||
|
||||
if (cdd.Load(filename) > 0) {
|
||||
loaded = 1;
|
||||
cdd.status = cdd.loaded ? CD_STAT_STOP : CD_STAT_NO_DISC;
|
||||
cdd.latency = 10;
|
||||
//status = MakeStatus(CD_STAT_STOP, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0);
|
||||
}
|
||||
else {
|
||||
cdd.status = CD_STAT_NO_DISC;
|
||||
}
|
||||
}
|
||||
else {
|
||||
cdd.Unload();
|
||||
unloaded = 1;
|
||||
cdd.status = CD_STAT_OPEN;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
int cdd_t::SectorSend(uint8_t* header)
|
||||
{
|
||||
uint8_t buf[2352+2352];
|
||||
int len = 2352;
|
||||
|
||||
if (header) {
|
||||
memcpy(buf + 12, header, 4);
|
||||
ReadData(buf + 16);
|
||||
}
|
||||
else {
|
||||
len = ReadCDDA(buf);
|
||||
}
|
||||
|
||||
// set index byte
|
||||
user_io_set_index(CD_DATA_IO_INDEX);
|
||||
|
||||
// prepare transmission of new file
|
||||
EnableFpga();
|
||||
spi8(UIO_FILE_TX);
|
||||
spi8(0xff);
|
||||
DisableFpga();
|
||||
|
||||
EnableFpga();
|
||||
spi8(UIO_FILE_TX_DAT);
|
||||
spi_write(buf, len, 1);
|
||||
DisableFpga();
|
||||
|
||||
// signal end of transmission
|
||||
EnableFpga();
|
||||
spi8(UIO_FILE_TX);
|
||||
spi8(0x00);
|
||||
DisableFpga();
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
int cdd_t::SubcodeSend()
|
||||
{
|
||||
uint16_t buf[98/2];
|
||||
|
||||
ReadSubcode(buf);
|
||||
|
||||
// set index byte
|
||||
user_io_set_index(CD_SUB_IO_INDEX);
|
||||
|
||||
// prepare transmission of new file
|
||||
EnableFpga();
|
||||
spi8(UIO_FILE_TX);
|
||||
spi8(0xff);
|
||||
DisableFpga();
|
||||
|
||||
EnableFpga();
|
||||
spi8(UIO_FILE_TX_DAT);
|
||||
spi_write((uint8_t*)buf, 98, 1);
|
||||
DisableFpga();
|
||||
|
||||
// signal end of transmission
|
||||
EnableFpga();
|
||||
spi8(UIO_FILE_TX);
|
||||
spi8(0x00);
|
||||
DisableFpga();
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user