mirror of
https://github.com/wiidev/usbloadergx.git
synced 2024-09-09 17:13:20 +02:00
![dimok321](/assets/img/avatar_default.png)
*Changed USB Loader GX WBFS formatter to choose 2048 as virtual sector size if a drive with a size > 500GB is formatted. NOTE: Don't use this feature with IOS58 mode. It might damage the partition. I did not build in a safety check for IOS58 mode because it will be removed soon anyway.
176 lines
4.3 KiB
C
176 lines
4.3 KiB
C
#include <ogcsys.h>
|
|
#include <malloc.h>
|
|
#include <string.h>
|
|
|
|
#include "usbloader/sdhc.h"
|
|
#include "usbloader/usbstorage2.h"
|
|
#include "usbloader/wdvd.h"
|
|
#include "wbfs_rw.h"
|
|
|
|
/* Constants */
|
|
#define MAX_NB_SECTORS 32
|
|
|
|
rw_sector_callback_t readCallback = NULL;
|
|
rw_sector_callback_t writeCallback = NULL;
|
|
const DISC_INTERFACE * currentHandle = NULL;
|
|
|
|
s32 __ReadDVD(void *fp, u32 lba, u32 len, void *iobuf)
|
|
{
|
|
void *buffer = NULL;
|
|
|
|
u64 offset;
|
|
u32 mod, size;
|
|
s32 ret;
|
|
|
|
/* Calculate offset */
|
|
offset = ((u64) lba) << 2;
|
|
|
|
/* Calcualte sizes */
|
|
mod = len % 32;
|
|
size = len - mod;
|
|
|
|
/* Read aligned data */
|
|
if (size)
|
|
{
|
|
ret = WDVD_UnencryptedRead(iobuf, size, offset);
|
|
if (ret < 0) goto out;
|
|
}
|
|
|
|
/* Read non-aligned data */
|
|
if (mod)
|
|
{
|
|
/* Allocate memory */
|
|
buffer = memalign(32, 0x20);
|
|
if (!buffer) return -1;
|
|
|
|
/* Read data */
|
|
ret = WDVD_UnencryptedRead(buffer, 0x20, offset + size);
|
|
if (ret < 0) goto out;
|
|
|
|
/* Copy data */
|
|
void *ptr = ((u8 *) iobuf) + size;
|
|
memcpy(ptr, buffer, mod);
|
|
}
|
|
|
|
/* Success */
|
|
ret = 0;
|
|
|
|
out:
|
|
/* Free memory */
|
|
if (buffer) free(buffer);
|
|
|
|
return ret;
|
|
}
|
|
|
|
s32 __ReadUSB(void *fp, u32 lba, u32 count, void *iobuf)
|
|
{
|
|
WBFS_PartInfo * info = (WBFS_PartInfo *) fp;
|
|
u32 cnt = 0;
|
|
s32 ret;
|
|
u32 partition_offset = info->partition_lba + (lba-info->partition_lba)*(info->wbfs_sector_size/info->hdd_sector_size);
|
|
count *= (info->wbfs_sector_size/info->hdd_sector_size);
|
|
|
|
/* Do reads */
|
|
while (cnt < count)
|
|
{
|
|
u8 *ptr = ((u8 *) iobuf) + (cnt * info->hdd_sector_size);
|
|
u32 sectors = (count - cnt);
|
|
|
|
/* Read sectors is too big */
|
|
if (sectors > MAX_NB_SECTORS) sectors = MAX_NB_SECTORS;
|
|
|
|
/* USB read */
|
|
ret = currentHandle->readSectors(partition_offset + cnt, sectors, ptr);
|
|
if (!ret) return -1;
|
|
|
|
/* Increment counter */
|
|
cnt += sectors;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
s32 __WriteUSB(void *fp, u32 lba, u32 count, void *iobuf)
|
|
{
|
|
WBFS_PartInfo * info = (WBFS_PartInfo *) fp;
|
|
u32 cnt = 0;
|
|
s32 ret;
|
|
u32 partition_offset = info->partition_lba + (lba-info->partition_lba)*(info->wbfs_sector_size/info->hdd_sector_size);
|
|
count *= (info->wbfs_sector_size/info->hdd_sector_size);
|
|
|
|
/* Do writes */
|
|
while (cnt < count)
|
|
{
|
|
u8 *ptr = ((u8 *) iobuf) + (cnt * info->hdd_sector_size);
|
|
u32 sectors = (count - cnt);
|
|
|
|
/* Write sectors is too big */
|
|
if (sectors > MAX_NB_SECTORS) sectors = MAX_NB_SECTORS;
|
|
|
|
/* USB write */
|
|
ret = currentHandle->writeSectors(partition_offset + cnt, sectors, ptr);
|
|
if (!ret) return -1;
|
|
|
|
/* Increment counter */
|
|
cnt += sectors;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
s32 __ReadSDHC(void *fp, u32 lba, u32 count, void *iobuf)
|
|
{
|
|
WBFS_PartInfo * info = (WBFS_PartInfo *) fp;
|
|
u32 cnt = 0;
|
|
s32 ret;
|
|
u32 partition_offset = info->partition_lba + (lba-info->partition_lba)*(info->wbfs_sector_size/info->hdd_sector_size);
|
|
count *= info->wbfs_sector_size/info->hdd_sector_size;
|
|
|
|
/* Do reads */
|
|
while (cnt < count)
|
|
{
|
|
void *ptr = ((u8 *) iobuf) + (cnt * info->wbfs_sector_size);
|
|
u32 sectors = (count - cnt);
|
|
|
|
/* Read sectors is too big */
|
|
if (sectors > MAX_NB_SECTORS) sectors = MAX_NB_SECTORS;
|
|
|
|
/* SDHC read */
|
|
ret = SDHC_ReadSectors(partition_offset + cnt, sectors, ptr);
|
|
if (!ret) return -1;
|
|
|
|
/* Increment counter */
|
|
cnt += sectors;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
s32 __WriteSDHC(void *fp, u32 lba, u32 count, void *iobuf)
|
|
{
|
|
WBFS_PartInfo * info = (WBFS_PartInfo *) fp;
|
|
u32 cnt = 0;
|
|
s32 ret;
|
|
u32 partition_offset = info->partition_lba + (lba-info->partition_lba)*(info->wbfs_sector_size/info->hdd_sector_size);
|
|
count *= info->wbfs_sector_size/info->hdd_sector_size;
|
|
|
|
/* Do writes */
|
|
while (cnt < count)
|
|
{
|
|
void *ptr = ((u8 *) iobuf) + (cnt * info->wbfs_sector_size);
|
|
u32 sectors = (count - cnt);
|
|
|
|
/* Write sectors is too big */
|
|
if (sectors > MAX_NB_SECTORS) sectors = MAX_NB_SECTORS;
|
|
|
|
/* SDHC write */
|
|
ret = SDHC_WriteSectors(partition_offset + cnt, sectors, ptr);
|
|
if (!ret) return -1;
|
|
|
|
/* Increment counter */
|
|
cnt += sectors;
|
|
}
|
|
|
|
return 0;
|
|
}
|