|
#include "diskio.h"
|
|
|
|
#include "mmc.h"
|
|
#include "spi.h"
|
|
|
|
#include "printf.h"
|
|
|
|
void mmcReadCached(u32 sector);
|
|
u32 n_actual_mmc_sector;
|
|
extern unsigned char mmc_sector_buffer[512];
|
|
|
|
void mmcReadCached(u32 sector)
|
|
{
|
|
//debug("mmcReadCached");
|
|
//plotnext(toatarichar(' '));
|
|
//plotnextnumber(sector);
|
|
//debug("\n");
|
|
if(sector==n_actual_mmc_sector) return;
|
|
//debug("mmcReadREAL");
|
|
//plotnext(toatarichar(' '));
|
|
//plotnextnumber(sector);
|
|
//debug("\n");
|
|
|
|
u08 ret,retry;
|
|
//predtim nez nacte jiny, musi ulozit soucasny
|
|
// TODO mmcWriteCachedFlush();
|
|
//az ted nacte novy
|
|
retry=0; //zkusi to maximalne 256x
|
|
do
|
|
{
|
|
ret = mmcRead(sector); //vraci 0 kdyz ok
|
|
retry--;
|
|
} while (ret && retry);
|
|
while(ret); //a pokud se vubec nepovedlo, tady zustane zablokovany cely SDrive!
|
|
n_actual_mmc_sector=sector;
|
|
}
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Initialize Disk Drive */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
DSTATUS disk_initialize (void)
|
|
{
|
|
DSTATUS stat;
|
|
|
|
printf(" in init ");
|
|
n_actual_mmc_sector = 0xffffffff;
|
|
do
|
|
{
|
|
mmcInit();
|
|
}
|
|
while(mmcReset()); //dokud nenulove, tak smycka (return 0 => ok!)
|
|
|
|
printf(" setting freq ");
|
|
|
|
set_spi_clock_freq();
|
|
|
|
stat = RES_OK;
|
|
|
|
return stat;
|
|
}
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Read Partial Sector */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
DRESULT disk_readp (
|
|
BYTE* dest, /* Pointer to the destination object */
|
|
DWORD sector, /* Sector number (LBA) */
|
|
WORD sofs, /* Offset in the sector */
|
|
WORD count /* Byte count (bit15:destination) */
|
|
)
|
|
{
|
|
DRESULT res;
|
|
|
|
/*debug("readp:");
|
|
plotnextnumber(sector);
|
|
debug(" ");
|
|
plotnextnumber((int)dest);
|
|
debug(" ");
|
|
plotnextnumber(sofs);
|
|
debug(" ");
|
|
plotnextnumber(count);
|
|
debug(" ");
|
|
plotnextnumber(atari_sector_buffer);
|
|
debug(" ");
|
|
plotnextnumber(mmc_sector_buffer);
|
|
debug("\n");
|
|
*/
|
|
// Put your code here
|
|
mmcReadCached(sector);
|
|
for(;count>0;++sofs,--count)
|
|
{
|
|
unsigned char x = mmc_sector_buffer[sofs];
|
|
//printf("char:%02x loc:%d", x,sofs);
|
|
*dest++ = x;
|
|
}
|
|
|
|
res = RES_OK;
|
|
|
|
return res;
|
|
}
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Write Partial Sector */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
DRESULT disk_writep (const BYTE* buff, DWORD sc)
|
|
{
|
|
DRESULT res;
|
|
|
|
|
|
if (!buff) {
|
|
if (sc) {
|
|
|
|
// Initiate write process
|
|
|
|
} else {
|
|
|
|
// Finalize write process
|
|
|
|
}
|
|
} else {
|
|
|
|
// Send data to the disk
|
|
|
|
}
|
|
|
|
return res;
|
|
}
|