mirror of
https://github.com/wiidev/usbloadergx.git
synced 2024-08-03 07:18:16 +02:00
a4f3d16a56
*Added support for older Hermes IOS too (rev 2 and rev 3) *Changed Alternative Dol Browser to get the filelist (fst) with functions from libwbfs (like banner sounds) instead of from an emulated disk. This should fix all the weird crashes with it.
437 lines
7.9 KiB
C
437 lines
7.9 KiB
C
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <malloc.h>
|
|
#include <ogcsys.h>
|
|
#include "gecko.h"
|
|
#include "wbfs.h"
|
|
|
|
/* Constants */
|
|
#define IOCTL_DI_READID 0x70
|
|
#define IOCTL_DI_READ 0x71
|
|
#define IOCTL_DI_WAITCVRCLOSE 0x79
|
|
#define IOCTL_DI_GETCOVER 0x88
|
|
#define IOCTL_DI_RESET 0x8A
|
|
#define IOCTL_DI_OPENPART 0x8B
|
|
#define IOCTL_DI_CLOSEPART 0x8C
|
|
#define IOCTL_DI_UNENCREAD 0x8D
|
|
#define IOCTL_DI_SEEK 0xAB
|
|
#define IOCTL_DI_STOPLASER 0xD2
|
|
#define IOCTL_DI_OFFSET 0xD9
|
|
#define IOCTL_DI_DISC_BCA 0xDA
|
|
#define IOCTL_DI_STOPMOTOR 0xE3
|
|
#define IOCTL_DI_SETWBFSMODE 0xF4
|
|
#define IOCTL_DI_GETWBFSMODE 0xF5 // odip
|
|
#define IOCTL_DI_DISABLERESET 0xF6 // odip
|
|
|
|
/** Hermes IOS222 **/
|
|
#define DI_SETWBFSMODE 0xfe
|
|
|
|
#define IOCTL_DI_SETFRAG 0xF9
|
|
#define IOCTL_DI_GETMODE 0xFA
|
|
|
|
/* Variables */
|
|
static u32 inbuf[8] ATTRIBUTE_ALIGN(32);
|
|
static u32 outbuf[8] ATTRIBUTE_ALIGN(32);
|
|
|
|
static const char di_fs[] ATTRIBUTE_ALIGN(32) = "/dev/di";
|
|
static s32 di_fd = -1;
|
|
|
|
|
|
s32 WDVD_Init(void)
|
|
{
|
|
/* Open "/dev/di" */
|
|
if (di_fd < 0) {
|
|
di_fd = IOS_Open(di_fs, 0);
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
s32 WDVD_Close(void)
|
|
{
|
|
/* Close "/dev/di" */
|
|
if (di_fd >= 0) {
|
|
IOS_Close(di_fd);
|
|
di_fd = -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
s32 WDVD_GetHandle(void)
|
|
{
|
|
/* Return di handle */
|
|
return di_fd;
|
|
}
|
|
|
|
s32 WDVD_Reset(void)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Reset drive */
|
|
inbuf[0] = IOCTL_DI_RESET << 24;
|
|
inbuf[1] = 1;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_RESET, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_ReadDiskId(void *id)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Read disc ID */
|
|
inbuf[0] = IOCTL_DI_READID << 24;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_READID, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (ret == 1) {
|
|
memcpy(id, outbuf, sizeof(dvddiskid));
|
|
return 0;
|
|
}
|
|
|
|
return -ret;
|
|
}
|
|
|
|
s32 WDVD_Seek(u64 offset)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Drive seek */
|
|
inbuf[0] = IOCTL_DI_SEEK << 24;
|
|
inbuf[1] = (u32)(offset >> 2);
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_SEEK, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
|
|
}
|
|
|
|
s32 WDVD_Offset(u64 offset)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
//u32 *off = (u32 *)((void *)&offset);
|
|
union { u64 off64; u32 off32[2]; } off;off.off64 = offset;
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Set offset */
|
|
inbuf[0] = IOCTL_DI_OFFSET << 24;
|
|
inbuf[1] = (off.off32[0]) ? 1: 0;
|
|
inbuf[2] = (off.off32[1] >> 2);
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_OFFSET, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_StopLaser(void)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Stop laser */
|
|
inbuf[0] = IOCTL_DI_STOPLASER << 24;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_STOPLASER, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_StopMotor(void)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Stop motor */
|
|
inbuf[0] = IOCTL_DI_STOPMOTOR << 24;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_STOPMOTOR, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_OpenPartition(u64 offset)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
static u8 Tmd_Buffer[0x4A00] ATTRIBUTE_ALIGN(32);
|
|
static ioctlv Vectors[5] ATTRIBUTE_ALIGN(32);
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof inbuf);
|
|
memset(outbuf, 0, sizeof outbuf);
|
|
|
|
inbuf[0] = IOCTL_DI_OPENPART << 24;
|
|
inbuf[1] = offset >> 2;
|
|
|
|
Vectors[0].data = inbuf;
|
|
Vectors[0].len = 0x20;
|
|
Vectors[1].data = 0;
|
|
Vectors[1].len = 0;
|
|
Vectors[2].data = 0;
|
|
Vectors[2].len = 0;
|
|
Vectors[3].data = Tmd_Buffer;
|
|
Vectors[3].len = 0x49e4;
|
|
Vectors[4].data = outbuf;
|
|
Vectors[4].len = 0x20;
|
|
|
|
ret = IOS_Ioctlv(di_fd, IOCTL_DI_OPENPART, 3, 2, (ioctlv *)Vectors);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_ClosePartition(void)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Close partition */
|
|
inbuf[0] = IOCTL_DI_CLOSEPART << 24;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_CLOSEPART, inbuf, sizeof(inbuf), NULL, 0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_UnencryptedRead(void *buf, u32 len, u64 offset)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Unencrypted read */
|
|
inbuf[0] = IOCTL_DI_UNENCREAD << 24;
|
|
inbuf[1] = len;
|
|
inbuf[2] = (u32)(offset >> 2);
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_UNENCREAD, inbuf, sizeof(inbuf), buf, len);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_Read(void *buf, u32 len, u64 offset)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Disc read */
|
|
inbuf[0] = IOCTL_DI_READ << 24;
|
|
inbuf[1] = len;
|
|
inbuf[2] = (u32)(offset >> 2);
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_READ, inbuf, sizeof(inbuf), buf, len);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_WaitForDisc(void)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Wait for disc */
|
|
inbuf[0] = IOCTL_DI_WAITCVRCLOSE << 24;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_WAITCVRCLOSE, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_GetCoverStatus(u32 *status)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Get cover status */
|
|
inbuf[0] = IOCTL_DI_GETCOVER << 24;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_GETCOVER, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (ret == 1) {
|
|
/* Copy cover status */
|
|
memcpy(status, outbuf, sizeof(u32));
|
|
|
|
return 0;
|
|
}
|
|
|
|
return -ret;
|
|
}
|
|
|
|
s32 WDVD_SetUSBMode(const u8 *id, s32 partition)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Set USB mode */
|
|
inbuf[0] = IOCTL_DI_SETWBFSMODE << 24;
|
|
inbuf[1] = (id) ? WBFS_DEVICE_USB : 0;
|
|
|
|
/* Copy ID */
|
|
if (id) {
|
|
memcpy(&inbuf[2], id, 6);
|
|
if(partition >= 0) {
|
|
inbuf[5] = partition;
|
|
}
|
|
}
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_SETWBFSMODE, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret!=1) {
|
|
// Try old cIOS 222
|
|
/* Set USB mode */
|
|
inbuf[0] = DI_SETWBFSMODE << 24;
|
|
ret = IOS_Ioctl(di_fd, DI_SETWBFSMODE, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
}
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_Read_Disc_BCA(void *buf)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Disc read */
|
|
inbuf[0] = IOCTL_DI_DISC_BCA << 24;
|
|
//inbuf[1] = 64;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_DISC_BCA, inbuf, sizeof(inbuf), buf, 64);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
// frag
|
|
|
|
s32 WDVD_SetFragList(int device, void *fraglist, int size)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
memset(outbuf, 0, sizeof(outbuf));
|
|
|
|
/* Set FRAG mode */
|
|
inbuf[0] = IOCTL_DI_SETFRAG << 24;
|
|
inbuf[1] = device;
|
|
inbuf[2] = (u32)fraglist;
|
|
inbuf[3] = size;
|
|
|
|
DCFlushRange(fraglist, size);
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_SETFRAG, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|
|
|
|
s32 WDVD_Eject(void)
|
|
{
|
|
if (di_fd < 0)
|
|
return di_fd;
|
|
|
|
s32 ret;
|
|
|
|
memset(inbuf, 0, sizeof(inbuf));
|
|
|
|
/* Stop motor */
|
|
inbuf[0] = IOCTL_DI_STOPMOTOR << 24;
|
|
/* Eject DVD */
|
|
inbuf[1] = 1;
|
|
|
|
ret = IOS_Ioctl(di_fd, IOCTL_DI_STOPMOTOR, inbuf, sizeof(inbuf), outbuf, sizeof(outbuf));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return (ret == 1) ? 0 : -ret;
|
|
}
|