usbloadergx/source/usbloader/sdhc.c

160 lines
2.7 KiB
C
Raw Normal View History

#include <stdio.h>
#include <string.h>
#include <ogcsys.h>
#include <sdcard/wiisd_io.h>
#include "sdhc.h"
/* IOCTL comamnds */
#define IOCTL_SDHC_INIT 0x01
#define IOCTL_SDHC_READ 0x02
#define IOCTL_SDHC_WRITE 0x03
#define IOCTL_SDHC_ISINSERTED 0x04
#define SDHC_HEAPSIZE 0x8000
/* Variables */
static char fs[] ATTRIBUTE_ALIGN(32) = "/dev/sdio/sdhc";
static s32 hid = -1, fd = -1;
static u32 sector_size = SDHC_SECTOR_SIZE;
bool SDHC_Init(void)
{
s32 ret;
/* Already open */
if (fd > 0)
return true;
/* Create heap */
if (hid < 0) {
hid = iosCreateHeap(SDHC_HEAPSIZE);
if (hid < 0)
goto err;
}
/* Open SDHC device */
fd = IOS_Open(fs, 0);
if (fd < 0)
goto err;
/* Initialize SDHC */
ret = IOS_IoctlvFormat(hid, fd, IOCTL_SDHC_INIT, ":");
if (ret)
goto err;
return true;
err:
/* Close SDHC device */
if (fd > 0) {
IOS_Close(fd);
fd = -1;
}
return false;
}
bool SDHC_Close(void)
{
/* Close SDHC device */
if (fd > 0) {
IOS_Close(fd);
fd = -1;
}
return true;
}
bool SDHC_IsInserted(void)
{
s32 ret;
/* Check if SD card is inserted */
ret = IOS_IoctlvFormat(hid, fd, IOCTL_SDHC_ISINSERTED, ":");
return (!ret) ? true : false;
}
bool SDHC_ReadSectors(u32 sector, u32 count, void *buffer)
{
void *buf = (void *)buffer;
u32 len = (sector_size * count);
s32 ret;
/* Device not opened */
if (fd < 0)
return false;
/* Buffer not aligned */
if ((u32)buffer & 0x1F) {
/* Allocate memory */
buf = iosAlloc(hid, len);
if (!buf)
return false;
}
/* Read data */
ret = IOS_IoctlvFormat(hid, fd, IOCTL_SDHC_READ, "ii:d", sector, count, buf, len);
/* Copy data */
if (buf != buffer) {
memcpy(buffer, buf, len);
iosFree(hid, buf);
}
return (!ret) ? true : false;
}
bool SDHC_WriteSectors(u32 sector, u32 count, void *buffer)
{
void *buf = (void *)buffer;
u32 len = (sector_size * count);
s32 ret;
/* Device not opened */
if (fd < 0)
return false;
/* Buffer not aligned */
if ((u32)buffer & 0x1F) {
/* Allocate memory */
buf = iosAlloc(hid, len);
if (!buf)
return false;
/* Copy data */
memcpy(buf, buffer, len);
}
/* Read data */
ret = IOS_IoctlvFormat(hid, fd, IOCTL_SDHC_WRITE, "ii:d", sector, count, buf, len);
/* Free memory */
if (buf != buffer)
iosFree(hid, buf);
return (!ret) ? true : false;
}
bool SDHC_ClearStatus(void)
{
return true;
}
const DISC_INTERFACE __io_sdhc = {
DEVICE_TYPE_WII_SD,
FEATURE_MEDIUM_CANREAD | FEATURE_MEDIUM_CANWRITE | FEATURE_WII_SD,
(FN_MEDIUM_STARTUP)&SDHC_Init,
(FN_MEDIUM_ISINSERTED)&SDHC_IsInserted,
(FN_MEDIUM_READSECTORS)&SDHC_ReadSectors,
(FN_MEDIUM_WRITESECTORS)&SDHC_WriteSectors,
(FN_MEDIUM_CLEARSTATUS)&SDHC_ClearStatus,
(FN_MEDIUM_SHUTDOWN)&SDHC_Close
};