CfgUSBLoader/cios/dip_frag/sdhc.c

100 lines
1.8 KiB
C
Raw Normal View History

#include "syscalls.h"
#include "types.h"
#include "sdhc.h"
#include <stdio.h>
#include <string.h>
/* IOCTL commands */
#define IOCTL_SDHC_INIT 0x01
#define IOCTL_SDHC_READ 0x02
#define IOCTL_SDHC_WRITE 0x03
#define IOCTL_SDHC_ISINSERTED 0x04
/* Constants */
#define SDHC_SECTOR_SIZE 0x200
/* Variables */
static char fs[] ATTRIBUTE_ALIGN(32) = "/dev/sdio/sdhc";
static ioctlv io_vector[3] ATTRIBUTE_ALIGN(32);
static u32 io_buffer[3] ATTRIBUTE_ALIGN(32);
static s32 fd = -1;
static u32 sectorSz = SDHC_SECTOR_SIZE;
int sdhc_Init(void)
{
//s32 ret;
/* Already open */
if (fd >= 0)
return 0;
/* Open USB device */
fd = os_open(fs, 1);
if (fd < 0)
return -11;
/* Initialize USB storage */
os_ioctlv(fd, IOCTL_SDHC_INIT, 0, 0, NULL);
sectorSz = SDHC_SECTOR_SIZE;
return 0;
}
bool sdhc_Read(u32 sector, u32 numSectors, void *buffer)
{
u32 cnt;
s32 ret;
/* Device not opened */
if (fd < 0)
return false;
/* Sector info */
io_buffer[0] = sector;
io_buffer[1] = numSectors;
/* Setup io_vector */
io_vector[0].data = &io_buffer[0];
io_vector[0].len = sizeof(u32);
io_vector[1].data = &io_buffer[1];
io_vector[1].len = sizeof(u32);
io_vector[2].data = buffer;
io_vector[2].len = (sectorSz * numSectors);
/* Flush cache */
for (cnt = 0; cnt < 3; cnt++)
os_sync_after_write(io_vector[cnt].data, io_vector[cnt].len);
os_sync_after_write(io_vector, sizeof(ioctlv) * 3);
/* Read data */
ret = os_ioctlv(fd, IOCTL_SDHC_READ, 2, 1, io_vector);
if (ret < 0)
return false;
/* Invalidate cache */
for (cnt = 0; cnt < 3; cnt++)
os_sync_before_read(io_vector[cnt].data, io_vector[cnt].len);
return true;
}
bool sdhc_Shutdown(void)
{
if (fd >= 0) {
/* Close USB device */
os_close(fd);
/* Remove descriptor */
fd = -1;
}
return true;
}