DRESULT disk_write(BYTE drv, const BYTE *buff, DWORD sector, BYTE count)
{
void *buffer;
u32 len;
s32 ret = 0;
/* Buffer length */
len = (count * SECTOR_SZ);
/* Allocate buffer */
buffer = Mem_Alloc(count * 512);
if (!buffer)
return RES_ERROR;
/* Copy buffer */
memcpy(buffer, buff, len);
/* Write sectors */
switch (drv) {
case DRIVE_SDHC:
/* Write SD sectors */
ret = sdio_WriteSectors(sector, count, buffer);
break;
case DRIVE_EHCI:
/* Write USB sectors */
ret = ehci_WriteSectors(sector, count, buffer);
break;
}
/* Free buffer */
Mem_Free(buffer);
return (ret) ? RES_OK : RES_ERROR;
}
s32 __SDHC_Ioctlv(u32 cmd, ioctlv *vector, u32 inlen, u32 iolen)
{
s32 ret = IPC_EINVAL;
/* Invalidate cache */
InvalidateVector(vector, inlen, iolen);
/* Parse IOCTLV command */
switch (cmd) {
/** Initialize SDHC **/
case IOCTL_SDHC_INIT: {
/* Initialize SDIO */
ret = !sdio_Startup();
break;
}
/** Read sectors **/
case IOCTL_SDHC_READ: {
u32 sector = *(u32 *)(vector[0].data);
u32 numSectors = *(u32 *)(vector[1].data);
void *buffer = vector[2].data;
/* Read sectors */
ret = !sdio_ReadSectors(sector, numSectors, buffer);
break;
}
/** Write sectors **/
case IOCTL_SDHC_WRITE: {
u32 sector = *(u32 *)(vector[0].data);
u32 numSectors = *(u32 *)(vector[1].data);
void *buffer = vector[2].data;
/* Write sectors */
ret = !sdio_WriteSectors(sector, numSectors, buffer);
break;
}
/** Check for SD card **/
case IOCTL_SDHC_ISINSERTED: {
/* Check if SD card is inserted */
ret = !sdio_IsInserted();
break;
}
/** Open WBFS disc **/
case IOCTL_WBFS_OPEN_DISC: {
u8 *discid = (u8 *)(vector[0].data);
/* Open WBFS disc */
ret = WBFS_OpenDisc(discid);
break;
}
/** Read WBFS disc **/
case IOCTL_WBFS_READ_DISC: {
u32 offset = *(u32 *)(vector[0].data);
u32 len = *(u32 *)(vector[1].data);
void *buffer = vector[2].data;
/* Read WBFS disc */
ret = WBFS_Read(buffer, len, offset);
if (ret)
ret = 0x8000;
break;
}
default:
break;
}
/* Flush cache */
FlushVector(vector, inlen, iolen);
return ret;
}
