windows-nt/Source/XPSP1/NT/drivers/wdm/dvd/mini/toshiba/vdec.cpp
2020-09-26 16:20:57 +08:00

911 lines
23 KiB
C++

#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;
//}