mirror of
https://github.com/fail0verflow/mini.git
synced 2024-11-05 19:25:12 +01:00
127 lines
2.9 KiB
C
127 lines
2.9 KiB
C
/*-----------------------------------------------------------------------*/
|
|
/* Low level disk I/O module skeleton for FatFs (C)ChaN, 2007 */
|
|
/*-----------------------------------------------------------------------*/
|
|
/* This is a stub disk I/O module that acts as front end of the existing */
|
|
/* disk I/O modules and attach it to FatFs module with common interface. */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
#include "diskio.h"
|
|
#include "string.h"
|
|
#include "sdhc.h"
|
|
|
|
#ifndef MEM2_BSS
|
|
#define MEM2_BSS
|
|
#endif
|
|
|
|
static sdhci_t sdhci;
|
|
static u8 buffer[512] MEM2_BSS ALIGNED(32);
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Inidialize a Drive */
|
|
|
|
DSTATUS disk_initialize (
|
|
BYTE drv /* Physical drive nmuber (0..) */
|
|
)
|
|
{
|
|
s32 ret;
|
|
|
|
sd_init(&sdhci, 0);
|
|
ret = sd_mount(&sdhci);
|
|
|
|
if (ret < 0)
|
|
return STA_NOINIT;
|
|
else
|
|
return disk_status(drv);
|
|
}
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Return Disk Status */
|
|
|
|
DSTATUS disk_status (
|
|
BYTE drv /* Physical drive nmuber (0..) */
|
|
)
|
|
{
|
|
if (sd_inserted(&sdhci) == 0)
|
|
return STA_NODISK;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Read Sector(s) */
|
|
|
|
DRESULT disk_read (
|
|
BYTE drv, /* Physical drive nmuber (0..) */
|
|
BYTE *buff, /* Data buffer to store read data */
|
|
DWORD sector, /* Sector address (LBA) */
|
|
BYTE count /* Number of sectors to read (1..255) */
|
|
)
|
|
{
|
|
int i;
|
|
DRESULT res;
|
|
|
|
res = RES_OK;
|
|
for (i = 0; i < count; i++) {
|
|
if (sd_read(&sdhci, sector + i, 1, buffer) != 0) {
|
|
res = RES_ERROR;
|
|
break;
|
|
}
|
|
|
|
memcpy(buff + i * 512, buffer, 512);
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Write Sector(s) */
|
|
|
|
#if _READONLY == 0
|
|
DRESULT disk_write (
|
|
BYTE drv, /* Physical drive nmuber (0..) */
|
|
const BYTE *buff, /* Data to be written */
|
|
DWORD sector, /* Sector address (LBA) */
|
|
BYTE count /* Number of sectors to write (1..255) */
|
|
)
|
|
{
|
|
int i;
|
|
DRESULT res;
|
|
|
|
res = RES_OK;
|
|
for (i = 0; i < count; i++) {
|
|
memcpy(buffer, buff + i * 512, 512);
|
|
|
|
if(sd_write(&sdhci, sector + i, 1, buffer) != 0) {
|
|
res = RES_ERROR;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return res;
|
|
}
|
|
#endif /* _READONLY */
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Miscellaneous Functions */
|
|
|
|
DRESULT disk_ioctl (
|
|
BYTE drv, /* Physical drive nmuber (0..) */
|
|
BYTE ctrl, /* Control code */
|
|
void *buff /* Buffer to send/receive control data */
|
|
)
|
|
{
|
|
if (ctrl == CTRL_SYNC)
|
|
return RES_OK;
|
|
|
|
return RES_PARERR;
|
|
}
|
|
|