mirror of
https://github.com/nitraiolo/CfgUSBLoader.git
synced 2024-10-22 14:15:05 +02:00
100 lines
1.8 KiB
C
100 lines
1.8 KiB
C
|
|
#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;
|
|
}
|
|
|
|
|