alt64/mem.c

161 lines
2.7 KiB
C

#include "types.h"
#include "everdrive.h"
#include "sys.h"
u8 spi_dma;
#include "errors.h"
#include "mem.h"
u8 memSpiReadDma(void *dst, u16 slen);
u8 memSpiReadPio(void *dst, u16 slen);
u8 mem_buff[512];
void memSpiSetDma(u8 mode) {
spi_dma = mode;
}
void memcopy(void *src, void *dst, u16 len) {
u8 *s = (u8 *) src;
u8 *d = (u8 *) dst;
while (len--)*d++ = *s++;
}
void memfill(void *dst, u8 val, u16 len) {
u8 *d = (u8 *) dst;
while (len--)*d++ = val;
}
// buff len
u8 memSpiRead(void *dst, u16 slen) {
u8 copy_to_rom = 0;
u32 addr = (u32) dst; //if ROM_ADDR 0xb0000000
if (addr >= ROM_ADDR && addr < ROM_END_ADDR)copy_to_rom = 1;
//if (copy_to_rom || spi_dma) {
if ((copy_to_rom || spi_dma) && addr % 4 == 0) {
return memSpiReadDma(dst, slen);
} else {
return memSpiReadPio(dst, slen);
}
}
u8 memSpiReadPio(void *dst, u16 slen) {
u16 i;
u16 u;
u8 *ptr8 = (u8 *) dst;
for (i = 0; i < slen; i++) {
evd_SDdatReadMode(1);
for (u = 0; u < 65535; u++)if ((evd_SPI(0xff) & 0xf1) == 0xf0)break;
evd_SDdatReadMode(0);
if (u == 65535) {
evd_spiSSOff();
return DISK_RD_FE_TOUT;
}
for (u = 0; u < 512; u++)*ptr8++ = evd_SPI(0xff);
u = evd_isSDMode() ? 8 : 2;
while (u--) {
// console_printf("XRC: %02X", evd_SPI(0xff));
//console_printf("%02X\n", evd_SPI(0xff));
u--;
evd_SPI(0xff);
evd_SPI(0xff);
}
//evd_SPI(0xff);
//evd_SPI(0xff);
}
return 0;
}
u8 memSpiReadDma(void *dst, u16 slen) {
u8 resp = 0;
u8 copy_to_rom = 0;
u32 addr = (u32) dst;
evd_SDdatReadMode(0);
// console_printf("dma\n");
if (addr >= ROM_ADDR && addr < ROM_END_ADDR)copy_to_rom = 1;
if (copy_to_rom) {
return evd_mmcReadToCart(addr, slen);
} else {
resp = evd_mmcReadToCart(0, slen);
dma_read_s(dst, ROM_ADDR, slen * 512);
}
return resp;
}
u8 memSpiWrite(void *src) {
u16 i;
u8 *ptr8 = (u8 *) src;
if ((u32) src >= ROM_ADDR && (u32) src < ROM_END_ADDR) {
dma_read_s(mem_buff, (u32) src, 512);
for (i = 0; i < 512; i++)mem_spi(mem_buff[i]);
} else {
for (i = 0; i < 512; i++)mem_spi(*ptr8++);
}
return 0;
}
void memSpiBusy() {
while (evd_isSpiBusy());
}
void memRomWrite32(u32 addr, u32 val) {
vu32 *ptr = (u32 *) (addr + ROM_ADDR);
vu8 tmp;
tmp = *ptr;
*ptr = val;
tmp = *ptr;
}
u32 memRomRead32(u32 addr) {
vu32 *ptr = (u32 *) (addr + ROM_ADDR);
vu8 tmp;
vu32 val;
tmp = *ptr;
val = *ptr;
return val;
}
/*
u8 mem_spi(u8 dat) {
return evd_SPI(dat);
}
*/