windows-xp/Source/XPSP1/NT/drivers/wdm/dvd/mini/toshiba/vdec.cpp

#include "common.h"
#include "regs.h"
#include "vdec.h"

void VDecoder::init( const PDEVICE_INIT_INFO pDevInit )
{
	ioBase = pDevInit->ioBase;
}

void VDecoder::VIDEO_RESET( void )
{
	UCHAR val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_RESET );
	for ( ; ; )
	{
		val = READ_PORT_UCHAR( ioBase + TC812_STT1 );
		if ( ( val & 0x01 ) != 0x01 )
			break;
		// wait !!
	}
	for ( ; ; )
	{
		val = READ_PORT_UCHAR( ioBase + TC812_STT1 );
		if ( ( val & 0x10 ) != 0x10 )
			break;
		// wait !!
	}

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x05 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x13 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x14 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x05 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x13 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x34 );

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_RESET );
	for ( ; ; )
	{
		val = READ_PORT_UCHAR( ioBase + TC812_STT1 );
		if ( ( val & 0x01 ) != 0x01 )
			break;
		// wait !!
	}
	for ( ; ; )
	{
		val = READ_PORT_UCHAR( ioBase + TC812_STT1 );
		if ( ( val & 0x10 ) != 0x10 )
			break;
		// wait !!
	}
}

void VDecoder::VIDEO_MODE_DVD( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DEC_MODE );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xe0 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_INT_ID );

	VIDEO_PRSO_PS1();
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xbf );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_USER_ID );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DMODE );

	WRITE_PORT_UCHAR( ioBase + TC812_DSPL, 0x1f );

	VIDEO_VIDEOCD_OFF();
}

void VDecoder::VDVD_VIDEO_MODE_PS( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xbd );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_PRSO_ID );
}

void VDecoder::VIDEO_PRSO_PS1( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xbd );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_PRSO_ID );
}

void VDecoder::VIDEO_PRSO_NON( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_PRSO_ID );
}

void VDecoder::VIDEO_OUT_NTSC( void )
{
	UCHAR val;

	// set video frame size mode to NTSC
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_VFMODE );

	// set STD buffer size
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x40 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x11 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_STD_SIZE );

	// set USER1/2 area size
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xf7 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_USER_SIZE );

	// set ext. memory mapping
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_MEM_MAP );
	for ( ; ; )
	{
		val = READ_PORT_UCHAR( ioBase + TC812_STT1 );
		if ( ( val & 0x10 ) != 0x10 )
			break;
		// wait !!! & timeout !!!
	}

	// set underflow/overflow size
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x10 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, 0x10 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_UOF_SIZE );

	// default RHOS
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_HOFFSET );

	// default RVOS
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_VOFFSET );
}

void VDecoder::VIDEO_ALL_INT_OFF( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DEM, 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_WEM, 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_ERM, 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_UOM, 0xff );
}

void VDecoder::VIDEO_SCR_INT_ON( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val &= 0xfd;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}

void VDecoder::VIDEO_SCR_INT_OFF( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val |= 0x02;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}

void VDecoder::VIDEO_VERR_INT_ON( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val &= 0xef;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );

	WRITE_PORT_UCHAR( ioBase + TC812_ERM, 0x00 );
}

void VDecoder::VIDEO_VERR_INT_OFF( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val |= 0x10;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );

	WRITE_PORT_UCHAR( ioBase + TC812_ERM, 0x7f );
}

void VDecoder::VIDEO_UFLOW_INT_ON( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_UOM );
	val &= 0xfe;
	WRITE_PORT_UCHAR( ioBase + TC812_UOM, val );

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val &= 0xbf;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}

void VDecoder::VIDEO_UFLOW_INT_OFF( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val |= 0x40;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );

	val = READ_PORT_UCHAR( ioBase + TC812_UOM );
	val |= 0x01;
	WRITE_PORT_UCHAR( ioBase + TC812_UOM, val );
}

void VDecoder::VIDEO_DECODE_INT_ON( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_DEM );
	val &= 0xfb;
	WRITE_PORT_UCHAR( ioBase + TC812_DEM, val );

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val &= 0xfb;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}

void VDecoder::VIDEO_DECODE_INT_OFF( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val |= 0x04;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );

	val = READ_PORT_UCHAR( ioBase + TC812_DEM );
	val |= 0x04;
	WRITE_PORT_UCHAR( ioBase + TC812_DEM, val );
}

void VDecoder::VIDEO_USER_INT_ON( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_WEM );
	val &= 0xfe;
	WRITE_PORT_UCHAR( ioBase + TC812_WEM, val );

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val &= 0xf7;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}

void VDecoder::VIDEO_USER_INT_OFF( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val |= 0x08;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );

	val = READ_PORT_UCHAR( ioBase + TC812_WEM );
	val |= 0x01;
	WRITE_PORT_UCHAR( ioBase + TC812_WEM, val );
}

//--- 97.09.23 K.Chujo
void VDecoder::VIDEO_UDSC_INT_ON( void )
{
	// user data start code interrupt on
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val &= 0xFE;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}

void VDecoder::VIDEO_UDSC_INT_OFF( void )
{
	// user data start code interrput off
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_IRM );
	val |= 0x01;
	WRITE_PORT_UCHAR( ioBase + TC812_IRM, val );
}
//--- End.

void VDecoder::VIDEO_ALL_IFLAG_CLEAR( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_UOF );
	val = READ_PORT_UCHAR( ioBase + TC812_ERF );
	val = READ_PORT_UCHAR( ioBase + TC812_WEF );
	val = READ_PORT_UCHAR( ioBase + TC812_DEF );
	val = READ_PORT_UCHAR( ioBase + TC812_IRF );
}

void VDecoder::VIDEO_SET_STCA( ULONG stca )
{
	UCHAR val;

	val = (UCHAR)( stca & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, val );
	val = (UCHAR)( ( stca >> 8 ) & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, val );
	val = (UCHAR)( ( stca >> 16 ) & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA5, val );
	val = (UCHAR)( ( stca >> 24 ) & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA6, val );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA7, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_STCA );
}

void VDecoder::VIDEO_SET_STCS( ULONG stcs )
{
	UCHAR val;

	val = (UCHAR)( stcs & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, val );
	val = (UCHAR)( ( stcs >> 8 ) & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, val );
	val = (UCHAR)( ( stcs >> 16 ) & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA5, val );
	val = (UCHAR)( ( stcs >> 24 ) & 0xff );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA6, val );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA7, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_STCS );
}

ULONG VDecoder::VIDEO_GET_STCA( void )
{
	ULONG rval = 0, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_STCA );

	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA5 );
	val <<= 16;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA6 );
	val <<= 24;
	rval += val;

	return rval;
}

ULONG VDecoder::VIDEO_GET_STCS( void )
{
	ULONG rval = 0, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_STCS );

	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA5 );
	val <<= 16;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA6 );
	val <<= 24;
	rval += val;

	return rval;
}

void VDecoder::VIDEO_SYSTEM_START( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x07 );	// video buffer flow control
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_SYS );
}

void VDecoder::VIDEO_SYSTEM_STOP( void )
{
	UCHAR val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_SYS );
	val = READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	val &= 0xfe;
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, val );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_SYS );
}

ULONG VDecoder::VIDEO_GET_STD_CODE( void )
{
	ULONG rval, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_STD_CODE );
	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA2 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val <<= 16;
	rval += val;

	rval <<= 2;
	return rval;
}

BOOL VDecoder::VIDEO_GET_DECODE_STATE( void )
{
	UCHAR val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_DECODE );
	val = READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	if ( ( val & 0x01 ) == 0x01 )
		return TRUE;	// Decode
	else
		return FALSE;	// Non Decode
}

void VDecoder::VIDEO_DECODE_START( void )
{
	UCHAR val;

	for ( ; ; )
	{
		val = READ_PORT_UCHAR( ioBase + TC812_STT2 );
		if ( ( val & 0x01 ) != 0x01 )
			break;
	}
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x05 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DECODE );
}

NTSTATUS VDecoder::VIDEO_DECODE_STOP( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_STT2 );
	if ( ( val & 0x01 ) == 0x01 )
		return (NTSTATUS)-1;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_DECODE );
	val = READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	val &= 0x0e;
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, val );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DECODE );

	return 0;
}

void VDecoder::VIDEO_STD_CLEAR( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_STD_CLEAR );
}

void VDecoder::VIDEO_USER_CLEAR( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_USER1_CLEAR );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_USER2_CLEAR );
}

void VDecoder::VIDEO_PVSIN_ON( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_PVSIN );
}

void VDecoder::VIDEO_PVSIN_OFF( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_PVSIN );
}

void VDecoder::VIDEO_SET_DTS( ULONG dts )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, (UCHAR)( dts & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, (UCHAR)( ( dts >> 8 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, (UCHAR)( ( dts >> 16 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, (UCHAR)( ( dts >> 24 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA5, 0 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DTS );
}

ULONG VDecoder::VIDEO_GET_DTS( void )
{
	ULONG rval, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_DTS );
	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA2 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val <<= 16;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	val <<= 24;
	rval += val;

	return rval;
}

void VDecoder::VIDEO_SET_PTS( ULONG pts )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, (UCHAR)( pts & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, (UCHAR)( ( pts >> 8 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, (UCHAR)( ( pts >> 16 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, (UCHAR)( ( pts >> 24 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA5, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_PTS );
}

ULONG VDecoder::VIDEO_GET_PTS( void )
{
	ULONG rval, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_PTS );
	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA2 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val <<= 16;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	val <<= 24;
	rval += val;

	return rval;
}

ULONG VDecoder::VIDEO_GET_SCR( void )
{
	ULONG rval, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_SCR );
	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA5 );
	val <<= 16;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA6 );
	val <<= 24;
	rval += val;
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_STCR_END );

	return rval;
}

ULONG VDecoder::VIDEO_GET_STCC( void )
{
	ULONG rval, val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_STCC );
	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	val <<= 8;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA5 );
	val <<= 16;
	rval += val;
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA6 );
	val <<= 24;
	rval += val;
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_STCR_END );

	return rval;
}

void VDecoder::VIDEO_SEEMLESS_ON( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_SEEMLES );
}

void VDecoder::VIDEO_SEEMLESS_OFF( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_SEEMLES );
}

void VDecoder::VIDEO_VIDEOCD_OFF( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_VCD );
}

NTSTATUS VDecoder::VIDEO_GET_UDATA( PUCHAR pudata )
{
	if ( ( READ_PORT_UCHAR( ioBase + TC812_STT1 ) & 0x80 ) != 0x80 )
		return (NTSTATUS)-1;	// no user data

	*pudata = READ_PORT_UCHAR( ioBase + TC812_UDAT );
	return 0;
}

void VDecoder::VIDEO_PLAY_NORMAL( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_TRICK_NORMAL );
}

void VDecoder::VIDEO_PLAY_FAST( ULONG flag )
{
	if ( flag == FAST_ONLYI )
		WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	else if ( flag == FAST_IANDP )
		WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x07 );
	else
		return;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_TRICK_FAST );
}

void VDecoder::VIDEO_PLAY_SLOW( ULONG speed )
{
	if ( speed == 0 || speed > 31 )
		return;

	speed <<= 2;
	speed |= 3;
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, (UCHAR)speed );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_TRICK_SLOW );
}

void VDecoder::VIDEO_PLAY_FREEZE( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_TRICK_FREEZE );
}

void VDecoder::VIDEO_PLAY_STILL( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_TRICK_STILL );
}

void VDecoder::VIDEO_LBOX_ON( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_DSPL );
	val &= 0xf7;
	val |= 0x10;
	WRITE_PORT_UCHAR( ioBase + TC812_DSPL, val );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x3e );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_VOFFSET );
}

void VDecoder::VIDEO_LBOX_OFF( void )
{
	UCHAR val;

	val = READ_PORT_UCHAR( ioBase + TC812_DSPL );
	val |= 0x18;
	WRITE_PORT_UCHAR( ioBase + TC812_DSPL, val );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x04 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_VOFFSET );
}

void VDecoder::VIDEO_PANSCAN_ON( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DMODE );
}

void VDecoder::VIDEO_PANSCAN_OFF( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x1b );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_DMODE );
}

void VDecoder::VIDEO_UFLOW_CURB_ON( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x10 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_UF_CURB );
}

void VDecoder::VIDEO_UFLOW_CURB_OFF( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_UF_CURB );
}

ULONG VDecoder::VIDEO_USER_DWORD( ULONG offset )
{
	ULONG rval, val;

	for ( ; ; )
	{
		val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_STT2 );
		if ( ( val & 0x01 ) != 0x01 )
			break;
	}

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, (UCHAR)( offset & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA3, (UCHAR)( ( offset >> 8 ) & 0xff ) );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA4, (UCHAR)( ( offset >> 16 ) & 0x07 ) );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_SET_WRITE_MEM );

	for ( ; ; )
	{
		val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_STT2 );
		if ( ( val & 0x01 ) != 0x01 )
			break;
	}

	rval = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
	rval <<= 8;
	rval += (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA3 );
	rval <<= 8;
	rval += (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA2 );
	rval <<= 8;
	rval += (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	rval <<= 8;

	return rval;
}

void VDecoder::VIDEO_UDAT_CLEAR( void )
{
	UCHAR val;

	for ( ; ; )
	{
	val = READ_PORT_UCHAR( ioBase + TC812_STT1 );
	if ( ( val & 0x08 ) != 0x08 )
		break;
	val = READ_PORT_UCHAR( ioBase + TC812_UDAT );
	}
}

ULONG VDecoder::VIDEO_GET_TRICK_MODE( void )
{
	ULONG val;

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, V_GET_TRICK );
	val = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
	val &= 0x07;

	return val;
}

void VDecoder::VIDEO_BUG_PRE_SEARCH_01( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x25 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x52 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x11 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x10 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x02 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x5d );
}

void VDecoder::VIDEO_BUG_PRE_SEARCH_02( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x02 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x1b );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x8f );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x8f );

	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x42 );
}

void VDecoder::VIDEO_BUG_PRE_SEARCH_03( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xc1 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x52 );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xb8 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x52 );
}

void VDecoder::VIDEO_BUG_PRE_SEARCH_04( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x1b );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x8f );

	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x03 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x8f );
}

void VDecoder::VIDEO_BUG_PRE_SEARCH_05( void )
{
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x5d );
}


// NEEDED TO BE DEBUGGED !!!
void VDecoder::VIDEO_BUG_SLIDE_01( void )
{
	UCHAR val;
	ULONG ul;

	// check whether vdec hanged-up
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x7d );
	val = READ_PORT_UCHAR( ioBase + TC812_DATA2 );
//	if( UF_FLAG == TRUE ) {
//		DebugPrint(( DebugLevelTrace, "TOSDVD:  DECODER STATUS = %x\r\n", val ));
//	}
	if ( ( val & 0x30 ) == 0x00 )
	{
		WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x72 );
		ul = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA2 );
		ul <<= 8;
		ul += (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
//		if( UF_FLAG == TRUE ) {
//			DebugPrint(( DebugLevelTrace, "TOSDVD:  DECODER PC(1) = %x\r\n", ul ));
//		}
		if ( ul == 0x1a5 )
		{
			WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0xb8 );
			WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x01 );
			WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x52 );
			DebugPrint(( DebugLevelTrace, "TOSDVD:  <<RE-ORDER(1)>>\r\n" ));
			// uf
		} else {
			WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0xb0 );
			ul = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA4 );
			ul <<= 8;
			val = READ_PORT_UCHAR( ioBase + TC812_DATA3 );
			ul += (ULONG)val;
			ul <<= 8;
			val = READ_PORT_UCHAR( ioBase + TC812_DATA2 );
			ul += (ULONG)val;
			ul <<= 8;
			val = READ_PORT_UCHAR( ioBase + TC812_DATA1 );
			ul += (ULONG)val;

//			if( UF_FLAG == TRUE ) {
//				DebugPrint(( DebugLevelTrace, "TOSDVD:  DECODER DTS = %x\r\n", ul ));
//			}
			if ( ( VIDEO_GET_STCA() - 2 ) > ul )
			{
				ul = VIDEO_GET_STD_CODE();
//				if( UF_FLAG == TRUE ) {
//					DebugPrint(( DebugLevelTrace, "TOSDVD:  DECODER STD = %x\r\n", ul ));
//				}
				if ( ul >= 0x200 )
				{
					WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x72 );
					ul = (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA2 );
					ul <<= 8;
					ul += (ULONG)READ_PORT_UCHAR( ioBase + TC812_DATA1 );
//					if( UF_FLAG == TRUE ) {
//						DebugPrint(( DebugLevelTrace, "TOSDVD:  DECODER PC(2) = %x\r\n", ul ));
//					}
					if ( ul >= 0x404 && ul <= 0x409 )
					{
						WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x18 );
						WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x04 );
						WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x52 );
						DebugPrint(( DebugLevelTrace, "TOSDVD:  <<RE-ORDER(2)>>\r\n" ));
						// uf
					}
				}
			}
		}
	}
	WRITE_PORT_UCHAR( ioBase + TC812_DATA1, 0x00 );
	WRITE_PORT_UCHAR( ioBase + TC812_DATA2, 0x01 );
	WRITE_PORT_UCHAR( ioBase + TC812_CMDR1, 0x5d );
}
//
//void VDecoder::VIDEO_DEBUG_SET_UF( void )
//{
//	UF_FLAG = TRUE;
//}
//
//void VDecoder::VIDEO_DEBUG_CLR_UF( void )
//{
//	UF_FLAG = FALSE;
//}