usbloadergx/source/patches/dvd_broadway.c

/*
 *  Copyright (C) 2008 Nuke (wiinuke@gmail.com)
 *
 *  this file is part of GeckoOS for USB Gecko
 *  http://www.usbgecko.com
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <malloc.h>
#include <time.h>
#include <gcutil.h>
#include <ogc/lwp_queue.h>
#include <gccore.h>

#include "dvd_broadway.h"

#define DI_CMDCTX_CNT			   4

#define DVD_DISKIDSIZE			  0x20
#define DVD_DRVINFSIZE			  0x20

#define IOCTL_DI_INQUIRY			0x12
#define IOCTL_DI_READID			 0x70
#define IOCTL_DI_READ			   0x71
#define IOCTL_DI_WAITCVRCLOSE	   0x79
#define IOCTL_DI_COVER			  0x7A
#define IOCTL_DI_RESETNOTIFY		0x7E
#define IOCTL_DI_RESET			  0x8A
#define IOCTL_DI_OPENPART		   0x8B
#define IOCTL_DI_CLOSEPART		  0x8C
#define IOCTL_DI_UNENCREAD		  0x8D
#define IOCTL_DI_ENABLE_DVD		 0x8E
#define IOCTL_DI_SEEK			   0xAB
#define IOCTL_DI_READ_DVDVIDEO	  0xD0
#define IOCTL_DI_STOPLASER		  0xD2
#define IOCTL_DI_OFFSET			 0xD9
#define IOCTL_DI_REQERROR		   0xE0
#define IOCTL_DI_STOPMOTOR		  0xE3
#define IOCTL_DI_SETOFFBASE		 0xF0
#define IOCTL_DI_GETOFFBASE		 0xF1
#define IOCTL_DI_SETCRYPTMODE	   0xF2
#define IOCTL_DI_GETCRYPTMODE	   0xF3
#define IOCTL_DI_SETDVDROMMODE	  0xF4
#define IOCTL_DI_GETDVDROMMODE	  0xF5

#define _SHIFTL(v, s, w)	\
	((u32) (((u32)(v) & ((0x01 << (w)) - 1)) << (s)))
#define _SHIFTR(v, s, w)	\
	((u32)(((u32)(v) >> (s)) & ((0x01 << (w)) - 1)))

struct dicommand
{
	u32 diReg[8];
};

struct dicontext
{
	lwp_node node;
	dvdcallbacklow cb;
	struct dicommand *cmd;
};

static s32 __dvd_fd = -1;
static u32 __dvd_spinupval = 1;
static lwp_queue __di_contextq;
static u32 __dvd_readlength = 0;
static u32 __dvd_cbinprogress = 0;
static u32 __dvd_reqinprogress = 0;
static u32 __dvd_lowinitcalled = 0;
static struct dicommand *__di_commands = NULL;
static struct dicontext __di_contexts[DI_CMDCTX_CNT];
static u32 __di_regbuffer[0x08] ATTRIBUTE_ALIGN( 32 );
static u32 __di_regvalcache[0x08] ATTRIBUTE_ALIGN( 32 );
static u32 __di_lastticketerror[0x08] ATTRIBUTE_ALIGN( 32 );
static ioctlv __di_iovector[0x08] ATTRIBUTE_ALIGN( 32 );
static char __di_fs[] ATTRIBUTE_ALIGN( 32 ) = "/dev/di";

extern u32 __IPC_ClntInit();

static __inline__ lwp_node* __lwp_queue_head(lwp_queue *queue)
{
	return (lwp_node*) queue;
}

static __inline__ lwp_node* __lwp_queue_tail(lwp_queue *queue)
{
	return (lwp_node*) &queue->perm_null;
}

static __inline__ void __lwp_queue_init_empty(lwp_queue *queue)
{
	queue->first = __lwp_queue_tail(queue);
	queue->perm_null = NULL;
	queue->last = __lwp_queue_head(queue);
}

static struct dicontext* __dvd_getcontext(dvdcallbacklow cb)
{
	struct dicontext *ctx;

	ctx = (struct dicontext*) __lwp_queue_get(&__di_contextq);
	if (ctx != NULL) ctx->cb = cb;

	return ctx;
}

static s32 __dvd_iostransactionCB(s32 result, void *usrdata)
{
	struct dicontext *ctx = (struct dicontext*) usrdata;

	__dvd_reqinprogress = 0;

	if (ctx->cb != NULL)
	{
		__dvd_cbinprogress = 1;
		if (result != 0) __dvd_readlength = 0;
		ctx->cb(result);
		__dvd_cbinprogress = 0;
	}
	__lwp_queue_append(&__di_contextq, &ctx->node);

	return 0;
}

static s32 __dvd_ioscoverregisterCB(s32 result, void *usrdata)
{
	struct dicontext *ctx = (struct dicontext*) usrdata;

	__dvd_reqinprogress = 0;
	__di_regvalcache[1] = __di_regbuffer[0];

	if (ctx->cb != NULL)
	{
		__dvd_cbinprogress = 1;
		ctx->cb(result);
		__dvd_cbinprogress = 0;
	}
	__lwp_queue_append(&__di_contextq, &ctx->node);

	return 0;
}

static s32 __dvd_ioscovercloseCB(s32 result, void *usrdata)
{
	struct dicontext *ctx = (struct dicontext*) usrdata;

	__dvd_reqinprogress = 0;

	if (ctx->cb != NULL)
	{
		__dvd_cbinprogress = 1;
		ctx->cb(result);
		__dvd_cbinprogress = 0;
	}
	__lwp_queue_append(&__di_contextq, &ctx->node);

	return 0;
}

s32 bwDVD_LowInit()
{
	s32 i, ret = 0;
	u32 ipclo, ipchi;
	lwp_queue inactives;
	struct dicontext *ctx;

	if (__dvd_lowinitcalled == 0)
	{
		ret = __IPC_ClntInit();
		if (ret < 0) return ret;

		ipclo = (((u32) IPC_GetBufferLo() + 0x1f) & ~0x1f);
		ipchi = (u32) IPC_GetBufferHi();
		if (ipchi >= (ipclo + (sizeof(struct dicommand) * DI_CMDCTX_CNT)))
		{
			__di_commands = (struct dicommand*) ipclo;
			IPC_SetBufferLo((void*) (ipclo + (sizeof(struct dicommand) * DI_CMDCTX_CNT)));

			memset(__di_commands, 0, (sizeof(struct dicommand) * DI_CMDCTX_CNT));

			i = 0;
			__lwp_queue_init_empty(&__di_contextq);
			__lwp_queue_initialize(&inactives, __di_contexts, DI_CMDCTX_CNT, sizeof(struct dicontext));
			while ((ctx = (struct dicontext*) __lwp_queue_get(&inactives)) != NULL)
			{
				ctx->cmd = &__di_commands[i];
				ctx->cb = NULL;
				__lwp_queue_append(&__di_contextq, &ctx->node);

				i++;
			}
		}

		ret = IOS_Open(__di_fs, 0);
		if (ret < 0) return ret;

		__dvd_fd = ret;
		//	  __dvd_lowinitcalled = 1;

		//  printf("DVD_LowInit(%d)\n",ret);
	}
	return 0;
}

s32 bwDVD_LowInquiry(dvddrvinfo *info, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_INQUIRY << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_INQUIRY, cmd->diReg, sizeof(struct dicommand), info, DVD_DRVINFSIZE,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowReadID(dvddiskid *diskID, dvdcallbacklow cb)
{
	s32 ret = 0;
	struct dicontext *ctx;
	struct dicommand *cmd;

	//  printf("DVD_LowReadID()\n");

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_READID << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_READID, cmd->diReg, sizeof(struct dicommand), diskID, DVD_DISKIDSIZE,
			__dvd_iostransactionCB, ctx);

	//  printf("DVD_LowReadID(%d)\n",ret);
	return ret;
}

s32 bwDVD_LowRead(void *buf, u32 len, u32 offset, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	if (buf == NULL || ((u32) buf % 32) != 0) return -1;

	__dvd_reqinprogress = 1;
	__dvd_readlength = len;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_READ << 24);
	cmd->diReg[1] = len;
	cmd->diReg[2] = offset;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_READ, cmd->diReg, sizeof(struct dicommand), buf, len,
			__dvd_iostransactionCB, ctx);

	return ret;
}

// never got this function working, probably removed from wii
s32 bwDVD_LowReadVideo(void *buf, u32 len, u32 offset, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;
	__dvd_readlength = len;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_READ_DVDVIDEO << 24);
	cmd->diReg[1] = len;
	cmd->diReg[2] = offset;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_READ_DVDVIDEO, cmd->diReg, sizeof(struct dicommand), buf, len,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowStopLaser(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_STOPLASER << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_STOPLASER, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;
}

// never got this function working, probably removed from wii
s32 bwDVD_EnableVideo(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_ENABLE_DVD << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_ENABLE_DVD, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowSeek(u32 offset, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_SEEK << 24);
	cmd->diReg[1] = offset;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_SEEK, cmd->diReg, sizeof(struct dicommand), NULL, 0,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowOffset(u64 offset, dvdcallbacklow cb)
{
	s32 ret;
	//u32 *off = (u32*)(void*)(&offset);
	union
	{
		u64 off64;
		u32 off32[2];
	} off;
	off.off64 = offset;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_OFFSET << 24);
	cmd->diReg[1] = 0;
	if (off.off32[0]) cmd->diReg[1] = 1;
	cmd->diReg[2] = off.off32[1];
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_OFFSET, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowPrepareCoverRegister(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_COVER << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_COVER, cmd->diReg, sizeof(struct dicommand), __di_regbuffer, 0x20,
			__dvd_ioscoverregisterCB, ctx);

	return ret;
}

s32 bwDVD_LowOpenPartition(u32 offset, void *eticket, u32 certin_len, void *certificate_in, void *certificate_out,
		dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	if (eticket != NULL && ((u32) eticket % 32) != 0) return -1;
	if (certificate_in != NULL && ((u32) certificate_in % 32) != 0) return -1;
	if (certificate_out != NULL && ((u32) certificate_out % 32) != 0) return -1;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_OPENPART << 24);
	cmd->diReg[1] = offset;

	__di_iovector[0].data = cmd;
	__di_iovector[0].len = sizeof(struct dicommand);

	__di_iovector[1].data = eticket;
	if (eticket == NULL)
		__di_iovector[1].len = 0;
	else __di_iovector[1].len = 676;

	__di_iovector[2].data = certificate_in;
	if (certificate_in == NULL)
		__di_iovector[2].len = 0;
	else __di_iovector[2].len = certin_len;

	__di_iovector[3].data = certificate_out;
	__di_iovector[3].len = 18916;
	__di_iovector[4].data = __di_lastticketerror;
	__di_iovector[4].len = 0x20;
	ret = IOS_IoctlvAsync(__dvd_fd, IOCTL_DI_OPENPART, 3, 2, __di_iovector, __dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowClosePartition(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_CLOSEPART << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_CLOSEPART, cmd->diReg, sizeof(struct dicommand), NULL, 0,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowUnencryptedRead(void *buf, u32 len, u32 offset, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;
	__dvd_readlength = len;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_UNENCREAD << 24);
	cmd->diReg[1] = len;
	cmd->diReg[2] = offset;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_UNENCREAD, cmd->diReg, sizeof(struct dicommand), buf, len,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_LowWaitCoverClose(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_WAITCVRCLOSE << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_WAITCVRCLOSE, cmd->diReg, sizeof(struct dicommand), NULL, 0,
			__dvd_ioscovercloseCB, ctx);

	return ret;
}

s32 bwDVD_LowResetNotify()
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	if (__dvd_cbinprogress == 1) return -1;

	ctx = __dvd_getcontext(NULL);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_RESETNOTIFY << 24);
	ret = IOS_Ioctl(__dvd_fd, IOCTL_DI_RESETNOTIFY, cmd->diReg, sizeof(struct dicommand), NULL, 0);

	return ret;
}

s32 bwDVD_LowReset(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	//  printf("DVD_LowReset()\n");
	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_RESET << 24);
	cmd->diReg[1] = __dvd_spinupval;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_RESET, cmd->diReg, sizeof(struct dicommand), NULL, 0,
			__dvd_iostransactionCB, ctx);

	//  printf("DVD_LowReset(%d)\n",ret);
	return ret;
}

s32 bwDVD_LowStopMotor(u8 stop1, u8 stop2, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_STOPMOTOR << 24);
	cmd->diReg[1] = (stop1 << 24);
	cmd->diReg[2] = (stop2 << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_STOPMOTOR, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;

}

s32 bwDVD_LowRequestError(dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_REQERROR << 24);
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_REQERROR, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;
}

s32 bwDVD_SetDecryption(s32 mode, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_SETCRYPTMODE << 24);
	cmd->diReg[1] = mode;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_SETCRYPTMODE, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;

}

s32 bwDVD_SetOffset(u32 offset, dvdcallbacklow cb)
{
	s32 ret;
	struct dicontext *ctx;
	struct dicommand *cmd;

	__dvd_reqinprogress = 1;

	ctx = __dvd_getcontext(cb);
	if (ctx == NULL) return IPC_ENOMEM;

	cmd = ctx->cmd;
	cmd->diReg[0] = (IOCTL_DI_SETOFFBASE << 24);
	cmd->diReg[1] = offset;
	ret = IOS_IoctlAsync(__dvd_fd, IOCTL_DI_SETOFFBASE, cmd->diReg, sizeof(struct dicommand), __di_regvalcache, 0x20,
			__dvd_iostransactionCB, ctx);

	return ret;

}