//***************************************************************************
//
//	DVDCPGD.CPP
//		Analog Copy protection Processor Routine
//
//	Author:	
//		TOSHIBA [PCS](PSY) Satoshi Watanabe
//		Copyright (c) 1997 TOSHIBA CORPORATION
//
//	Description:
//		03/05/97	converted from VxD source
//		03/09/97	converted C++ class
//
//***************************************************************************

#include "common.h"
#include "regs.h"
#include "dvdcpgd.h"

//--- 97.09.15 K.Chujo

//=================================================//
//  Burst Inverse line data( Color stripe off )    //
//=================================================//
ULONG CPGD_BSTLNOFF_SIZE = 0x1A;

WORD CPGD_BSTLNOFF_DATA[] = {
	0x0000, 0x0000, 0x0000, 0x0000,
	0x0000, 0x0000, 0x0000, 0x0000,
	0x0000, 0x0000, 0x0000, 0x0000,
	0x0000, 0x0000, 0x0000, 0x0000,
	0x0000, 0x0000, 0x0000, 0x0000,
	0x0000, 0x0000, 0x0000, 0x0000,
	0x0000, 0x0000
};

//=================================================//
//  Burst Inverse line data( Color stripe 2 line)  //
//=================================================//
ULONG CPGD_BSTLN2_SIZE = 0x1A;

WORD CPGD_BSTLN2_DATA[] = {
	0x001D, 0x002E, 0x003F, 0x0050,
    0x0061, 0x0072, 0x0083, 0x0094,
    0x00A5, 0x00B6, 0x00C7, 0x00D8,
    0x00E9, 0x012C, 0x013D, 0x014E,
    0x015F, 0x0170, 0x0181, 0x0192,
    0x01A3, 0x01B4, 0x01C5, 0x01D6,
    0x01E7, 0x01F8
};

//=================================================//
//  Burst Inverse line data( Color stripe 4 line)  //
//=================================================//
ULONG CPGD_BSTLN4_SIZE = 0x1A;

WORD CPGD_BSTLN4_DATA[] = {
	0x0017, 0x002C, 0x0041, 0x0056,
    0x006B, 0x0080, 0x0095, 0x00AA,
    0x00BF, 0x00D4, 0x00E9, 0x0000,
    0x0000, 0x0128, 0x013D, 0x0152,
    0x0167, 0x017C, 0x0191, 0x01A6,
    0x01BB, 0x01D0, 0x01E5, 0x01FA,
    0x0000, 0x0000
};

//=================================================//
//  AGC data (for Y of S input)                    //
//=================================================//
WORD CPGD_AGC_Y_TBL[] = {
	0x03E7, 0x03E2, 0x03DE, 0x03D9, 0x03D5, 0x03D0, 0x03CC, 0x03C7,
	0x03C3, 0x03BE, 0x03BA, 0x03B5, 0x03B1, 0x03AC, 0x03A8, 0x03A3,
	0x039E, 0x039A, 0x0395, 0x0391, 0x038C, 0x0388, 0x0383, 0x037F,
	0x037A, 0x0376, 0x0371, 0x036D, 0x0368, 0x0363, 0x035F, 0x035A,
	0x0356, 0x0351, 0x034D, 0x0348, 0x0344, 0x033F, 0x033B, 0x0336,
	0x0332, 0x032D, 0x0329, 0x0324, 0x031F, 0x031B, 0x0316, 0x0312,
	0x030D, 0x0309, 0x0304, 0x0300, 0x02FB, 0x02F7, 0x02F2, 0x02EE,
	0x02E9, 0x02E4, 0x02E0, 0x02DB, 0x02D7, 0x02D2, 0x02CE, 0x02C9,
	0x02C5, 0x02C0, 0x02BC, 0x02B7, 0x02B3, 0x02AE, 0x02AA, 0x02A5,
	0x02A0, 0x029C, 0x0297, 0x0293, 0x028E, 0x028A, 0x0285, 0x0281,
	0x027C, 0x0278, 0x0273, 0x026F, 0x026A, 0x0265, 0x0261, 0x025C,
	0x0258, 0x0253, 0x024F, 0x024A, 0x0246, 0x0241, 0x023D, 0x0238,
	0x0234, 0x022F, 0x022B, 0x0226, 0x0221, 0x021D, 0x0218, 0x0214,
	0x020F, 0x020B, 0x0206, 0x0202, 0x01FD, 0x01F9, 0x01F4, 0x01F0,
	0x01EB, 0x01E6, 0x01E2, 0x01DD, 0x01D9, 0x01D4, 0x01D0, 0x01CB,
	0x01C7, 0x01C2, 0x01BE, 0x01B9, 0x01B5, 0x01B0, 0x01AC, 0x01A7,
	0x01A2, 0x019E, 0x0199, 0x0195, 0x0190, 0x018C, 0x0187, 0x0183,
	0x017E, 0x017A, 0x0175, 0x0171, 0x016C, 0x0167, 0x0163, 0x015E,
	0x015A, 0x0155, 0x0151, 0x014C, 0x0148, 0x0143, 0x013F, 0x013A,
	0x0136, 0x0131, 0x012D, 0x0128
};

//=================================================//
//  AGC data (for Composit input)                  //
//=================================================//
WORD CPGD_AGC_C_TBL[] = {
	0x0382, 0x037E, 0x037A, 0x0375, 0x0371, 0x036D, 0x0369, 0x0364,
	0x0360, 0x035C, 0x0358, 0x0353, 0x034F, 0x034B, 0x0347, 0x0342,
	0x033E, 0x033A, 0x0336, 0x0331, 0x032D, 0x0329, 0x0325, 0x0320,
	0x031C, 0x0318, 0x0314, 0x030F, 0x030B, 0x0307, 0x0303, 0x02FE,
	0x02FA, 0x02F6, 0x02F2, 0x02ED, 0x02E9, 0x02E5, 0x02E1, 0x02DC,
	0x02D8, 0x02D4, 0x02D0, 0x02CB, 0x02C7, 0x02C3, 0x02BF, 0x02BA,
	0x02B6, 0x02B2, 0x02AE, 0x02A9, 0x02A5, 0x02A1, 0x029D, 0x0299,
	0x0294, 0x0290, 0x028C, 0x0288, 0x0283, 0x027F, 0x027B, 0x0277,
	0x0272, 0x026E, 0x026A, 0x0266, 0x0261, 0x025D, 0x0259, 0x0255,
	0x0250, 0x024C, 0x0248, 0x0244, 0x023F, 0x023B, 0x0237, 0x0233,
	0x022E, 0x022A, 0x0226, 0x0222, 0x021D, 0x0219, 0x0215, 0x0211,
	0x020C, 0x0208, 0x0204, 0x0200, 0x01FB, 0x01F7, 0x01F3, 0x01EF,
	0x01EA, 0x01E6, 0x01E2, 0x01DE, 0x01D9, 0x01D5, 0x01D1, 0x01CD,
	0x01C9, 0x01C4, 0x01C0, 0x01BC, 0x01B8, 0x01B3, 0x01AF, 0x01AB,
	0x01A7, 0x01A2, 0x019E, 0x019A, 0x0196, 0x0191, 0x018D, 0x0189,
	0x0185, 0x0180, 0x017C, 0x0178, 0x0174, 0x016F, 0x016B, 0x0167,
	0x0163, 0x015E, 0x015A, 0x0156, 0x0152, 0x014E, 0x0149, 0x0145,
	0x0141, 0x013C, 0x0138, 0x0134, 0x0130, 0x012B, 0x0127, 0x0123,
	0x011F, 0x011A, 0x0116, 0x0112, 0x010E, 0x0109, 0x0105, 0x0101,
	0x00FD, 0x00F8, 0x00F4, 0x00F0
};

//--- End.

void CGuard::init( const PDEVICE_INIT_INFO pDevInit )
{
	ioBase = pDevInit->ioBase;
//--- 97.09.15 K.Chujo
	ACGchip = NO_ACG;
//--- End.
}

void CGuard::CPGD_RESET_FUNC()
{
	WRITE_PORT_UCHAR( ioBase + CPGD_RESET, 0 );
	WRITE_PORT_UCHAR( ioBase + CPGD_RESET, 0x80 );

	VproRESET_REG = 0x80;
	VproVMODE_REG = 0;	// ? ? ?
	VproAVM_REG = 0;	// ? ? ?
//--- 97.09.15 K.Chujo
	CpgdVsyncCount = 0;
	CGMSnCPGDvalid = FALSE;
	AspectFlag = 0x0000;
	LetterFlag = 0x0000; 
	CgmsFlag = 0x0000;
	CpgdFlag = 0x0000;
//--- End.
}

void CGuard::CPGD_VIDEO_MUTE_ON()
{
// debug
//	if ( !(VproRESET_REG & 0x80) )
//		Error;
// debug

	VproRESET_REG |= 0x40;
	WRITE_PORT_UCHAR( ioBase + CPGD_RESET, VproRESET_REG );
}

void CGuard::CPGD_VIDEO_MUTE_OFF()
{
// debug
//	if ( !(VproRESET_REG & 0x80) )
//		Error;
// debug

	VproRESET_REG &= 0xbf;
	WRITE_PORT_UCHAR( ioBase + CPGD_RESET, VproRESET_REG );
}

void CGuard::CPGD_INIT_NTSC()
{
	VproVMODE_REG &= 0x7f;
	WRITE_PORT_UCHAR( ioBase + CPGD_VMODE, VproVMODE_REG );

	VproAVM_REG &= 0x5f;
	WRITE_PORT_UCHAR( ioBase + CPGD_AVM, VproAVM_REG );

	WRITE_PORT_UCHAR( ioBase + CPGD_DVEN, 0xc0 );
}

void CGuard::CPGD_INIT_PAL()
{
	VproVMODE_REG |= 0x80;
	WRITE_PORT_UCHAR( ioBase + CPGD_VMODE, VproVMODE_REG );

	VproAVM_REG &= 0x5f;
	WRITE_PORT_UCHAR( ioBase + CPGD_AVM, VproAVM_REG );

	WRITE_PORT_UCHAR( ioBase + CPGD_DVEN, 0x80 );
}

void CGuard::CPGD_CC_ON()
{
//	VproVMODE_REG &= 0xbf;
	VproVMODE_REG |= 0x40;
	WRITE_PORT_UCHAR( ioBase + CPGD_VMODE, VproVMODE_REG );
}

void CGuard::CPGD_CC_OFF()
{
//	VproVMODE_REG |= 0x40;
	VproVMODE_REG &= 0xbf;
	WRITE_PORT_UCHAR( ioBase + CPGD_VMODE, VproVMODE_REG );
}

void CGuard::CPGD_SUBP_PALETTE( PUCHAR pPalData )
{
	ULONG i;

	WRITE_PORT_UCHAR( ioBase + CPGD_CPSET, 0x80 );

	for( i = 0; i < 48; i++ )
		WRITE_PORT_UCHAR( ioBase + CPGD_CPSP, *pPalData++ );

	WRITE_PORT_UCHAR( ioBase + CPGD_CPSET, 0x40 );
	WRITE_PORT_UCHAR( ioBase + CPGD_CPSET, 0 );
}

void CGuard::CPGD_OSD_PALETTE( PUCHAR pPalData )
{
	int i;

	WRITE_PORT_UCHAR( ioBase + CPGD_CPSET, 0x20 );

	for( i = 0; i < 48; i++ )
		WRITE_PORT_UCHAR( ioBase + CPGD_CPSP, *pPalData++ );

	WRITE_PORT_UCHAR( ioBase + CPGD_CPSET, 0x10 );
	WRITE_PORT_UCHAR( ioBase + CPGD_CPSET, 0 );
}

void CGuard::CPGD_SET_AGC_CHIP( ULONG rev )
{
	if( rev==2 || rev==3 )
		ACGchip = TC6802;
	else if ( rev==4 )
		ACGchip = TC6814;
	else if ( rev==5 )
		ACGchip = TC6818;
	else
		ACGchip = NO_ACG;
}

void CGuard::CPGD_SET_ASPECT( ULONG aspect )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		CPGD_SET_CGMSnCPGD( aspect, LetterFlag, CgmsFlag, CpgdFlag );
	}
}

void CGuard::CPGD_SET_LETTER( ULONG letter )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		CPGD_SET_CGMSnCPGD( AspectFlag, letter, CgmsFlag, CpgdFlag );
	}
}

void CGuard::CPGD_SET_CGMS( ULONG cgms )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		CPGD_SET_CGMSnCPGD( AspectFlag, LetterFlag, cgms, CpgdFlag );
	}
}

void CGuard::CPGD_SET_CPGD( ULONG cpgd )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		CPGD_SET_CGMSnCPGD( AspectFlag, LetterFlag, CgmsFlag, cpgd );
	}
}

void CGuard::CPGD_SET_CGMSnCPGD( ULONG aspect, ULONG letter, ULONG cgms, ULONG cpgd )
{
	if( ACGchip == NO_ACG ) {
		return;
	}
	else {
		aspect &= 0x01;
		letter &= 0x01;
		cgms &= 0x03;
		cpgd &= 0x03;
		if( CGMSnCPGDvalid==FALSE || CpgdFlag!=cpgd) {
			AspectFlag = aspect;
			LetterFlag = letter;
			CgmsFlag = cgms;
			CpgdFlag = cpgd;
			CPGD_SET_CGMSparameter();
			CPGD_SET_CPGDparameter();
			CGMSnCPGDvalid = TRUE;
		}
		else if ( AspectFlag!=aspect || LetterFlag!=letter || CgmsFlag!=cgms ) {
			AspectFlag = aspect;
			LetterFlag = letter;
			CgmsFlag = cgms;
			CPGD_SET_CGMSparameter();
		}
	}
}

void CGuard::CPGD_UPDATE_AGC( void )
{
	WORD Cval, Yval;

	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		if( CpgdVsyncCount == 0 ) {
			Cval = CPGD_AGC_C_TBL[0];
			Yval = CPGD_AGC_Y_TBL[0];
			CPGD_SET_AGC( Cval, Yval );
//			DebugPrint( ( DebugLevelTrace, "TOSDVD:  AGC_C %x, AGC_Y %x\r\n", Cval, Yval ) );
		}
		else if( 720<=CpgdVsyncCount && CpgdVsyncCount<=875 ) {
			Cval = CPGD_AGC_C_TBL[CpgdVsyncCount- 720];
			Yval = CPGD_AGC_Y_TBL[CpgdVsyncCount- 720];
			CPGD_SET_AGC( Cval, Yval );
//			DebugPrint( ( DebugLevelTrace, "TOSDVD:  AGC_C %x, AGC_Y %x\r\n", Cval, Yval ) );
		}
		else if( 1044<=CpgdVsyncCount && CpgdVsyncCount<=1199 ) {
			Cval = CPGD_AGC_C_TBL[1199-CpgdVsyncCount];
			Yval = CPGD_AGC_Y_TBL[1199-CpgdVsyncCount];
			CPGD_SET_AGC( Cval, Yval );
//			DebugPrint( ( DebugLevelTrace, "TOSDVD:  AGC_C %x, AGC_Y %x\r\n", Cval, Yval ) );
		}
		CpgdVsyncCount++;
		if( CpgdVsyncCount>=1200 )
			CpgdVsyncCount = 0;
	}
}

void CGuard::CPGD_SET_CGMSparameter( void )
{
	ULONG tmp;
	ULONG crc;

	tmp = ( 0x8000 | (AspectFlag<<9) | (LetterFlag<<8) | (CgmsFlag<<6) | (CpgdFlag<<4) );
	crc = CPGD_CALC_CRC( tmp ) << 2;
	WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAL, (UCHAR)(tmp >> 8) );
//	DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSAL%x\r\n", (UCHAR)(tmp>>8) ) );
	WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAM, (UCHAR)(tmp & 0xFF) );
//	DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSAM%x\r\n", (UCHAR)(tmp&0xFF) ) );
	WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAH, (UCHAR)(crc & 0xFF) );
//	DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSAH%x\r\n", (crc & 0xFF) ) );
}

void CGuard::CPGD_SET_CPGDparameter( void )
{
	ULONG tmp;
	ULONG crc;

	switch( CpgdFlag ) {
		case 0x00 :
			CPGD_SET_CLR_STRIPE_OFF();
			CPGD_SET_CPGD_0();
			break;
		case 0x01 :
			CPGD_SET_CLR_STRIPE_OFF();
			CPGD_SET_CPGD_1();
			break;
		case 0x02 :
			CPGD_SET_CLR_STRIPE_2();
			CPGD_SET_CPGD_2();
			break;
		case 0x03 :
			CPGD_SET_CLR_STRIPE_4();
			CPGD_SET_CPGD_3();
			break;
		default   :
			TRAP;
			break;
	}
}

void CGuard::CPGD_SET_CGMS_A_0( ULONG aspect, ULONG letter )
{
	ULONG temp = 0x8000;
	ULONG crc;

	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		if( letter!=0 )
			temp |= 0x1000;
		if( aspect!=0 )
			temp |= 0x2000;
		temp |= 0xC0;
		crc = CPGD_CALC_CRC( temp ) << 2;
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAL, (UCHAR)(temp >> 8) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAM, (UCHAR)(temp & 0xFF) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAH, (UCHAR)(crc & 0xFF) );
	}
}

void CGuard::CPGD_SET_CGMS_A_1( ULONG aspect, ULONG letter )
{
	ULONG temp = 0x8000;
	ULONG crc;

	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		if( letter!=0 )
			temp |= 0x1000;
		if( aspect!=0 )
			temp |= 0x2000;
		temp |= 0xD0;
		crc = CPGD_CALC_CRC( temp ) << 2;
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAL, (UCHAR)(temp >> 8) );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSAL%x\r\n", (UCHAR)(temp>>8) ) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAM, (UCHAR)(temp & 0xFF) );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSAM%x\r\n", (UCHAR)(temp&0xFF) ) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAH, (UCHAR)(crc & 0xFF) );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSAH%x\r\n", (crc & 0xFF) ) );
	}
}

void CGuard::CPGD_SET_CGMS_A_2( ULONG aspect, ULONG letter )
{
	ULONG temp = 0x8000;
	ULONG crc;
	
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		if( letter!=0 )
			temp |= 0x1000;
		if( aspect!=0 )
			temp |= 0x2000;
		temp |= 0xE0;
		crc = CPGD_CALC_CRC( temp ) << 2;
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAL, (UCHAR)(temp >> 8) );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSA L = %x\r\n", temp>>8 ) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAM, (UCHAR)(temp & 0xFF) );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSA M = %x\r\n", temp & 0xFF ) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAH, (UCHAR)(crc & 0xFF) );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  CGMSA H = %x\r\n", crc & 0xFF ) );
	}
}

void CGuard::CPGD_SET_CGMS_A_3( ULONG aspect, ULONG letter )
{
	ULONG temp = 0x8000;
	ULONG crc;
	
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		if( letter!=0 )
			temp |= 0x1000;
		if( aspect!=0 )
			temp |= 0x2000;
		temp |= 0xF0;
		crc = CPGD_CALC_CRC( temp ) << 2;
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAL, (UCHAR)(temp >> 8) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAM, (UCHAR)(temp & 0xFF) );
		WRITE_PORT_UCHAR( ioBase + CPGD_CGMSAH, (UCHAR)(crc & 0xFF) );
	}
}

void CGuard::CPGD_SET_CLR_STRIPE_OFF( void )
{
	// notes:	*1 are unnecessary originally (if TC6802 is on board).
	//			But I have to use TC6802 parameters when TC6814/TC6818 is on board for beta 3
	//			because I can't get RevID ( I can't know which ACG chip is ).
	//			These codes make safe when TC6814/TC6818 is, of cource TC6802 is, NO PROBLEM.

	if( ACGchip==NO_ACG ) {
		return;
	}
	else if( ACGchip==TC6802 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );		// *1
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xFE );		// *1
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_OFF for TC6802\r\n" ) );
	}
	else if( ACGchip==TC6814 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xFE );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
		CPGD_SET_BURST( CPGD_BSTLNOFF_DATA, CPGD_BSTLNOFF_SIZE );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_OFF for TC6814\r\n" ) );
	}
	else if( ACGchip==TC6818 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0x04 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x80 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_OFF for TC6818\r\n" ) );
	}
}

void CGuard::CPGD_SET_CLR_STRIPE_2( void )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else if( ACGchip==TC6802 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xFE );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0x84 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0xAA );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_2 for TC6802\r\n" ) );
	}
	else if( ACGchip==TC6814 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xFE );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0x84 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0xAE );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_2 for TC6814\r\n" ) );
	}
	else if( ACGchip==TC6818 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0x04 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x80 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0x84 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0xAE );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_2 for TC6818\r\n" ) );
	}
	CPGD_SET_BURST( CPGD_BSTLN2_DATA, CPGD_BSTLN2_SIZE );
}

void CGuard::CPGD_SET_CLR_STRIPE_4( void )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else if( ACGchip==TC6802 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xFE );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0x84 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0xAA );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CLR_STRIPE_4\r\n" ) );
	}
	else if( ACGchip==TC6814 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xFE );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0x84 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0xAE );
	}
	else if( ACGchip==TC6818 ) {
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0xB1 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTINT, 0x04 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x80 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0x84 );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTSE, 0xAE );
	}
	CPGD_SET_BURST( CPGD_BSTLN4_DATA, CPGD_BSTLN4_SIZE );
}

void CGuard::CPGD_SET_CPGD_0( void )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		WRITE_PORT_UCHAR( ioBase + CPGD_CPG, 0x00 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CPGD_0\r\n" ) );
	}
}

void CGuard::CPGD_SET_CPGD_1( void )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		WRITE_PORT_UCHAR( ioBase + CPGD_CPG, 0xE8 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CPGD_1\r\n" ) );
	}
}

void CGuard::CPGD_SET_CPGD_2( void )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		WRITE_PORT_UCHAR( ioBase + CPGD_CPG, 0xF8 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CPGD_2\r\n" ) );
	}
}

void CGuard::CPGD_SET_CPGD_3( void )
{
	if( ACGchip==NO_ACG ) {
		return;
	}
	else {
		WRITE_PORT_UCHAR( ioBase + CPGD_CPG, 0xF8 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  SET_CPGD_3\r\n" ) );
	}
}

void CGuard::CPGD_SET_BURST( PWORD data, ULONG size )
{
	ULONG i;
	WORD temp;

	for( i=0; i<size; i++ ) {
		temp = (*(data+i)) & 0x3FF;
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTLSL, temp & 0xFF );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  BURST L %x\r\n", temp & 0xFF ) );
		WRITE_PORT_UCHAR( ioBase + CPGD_BSTLSH, temp >> 8 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  BURST H %x\r\n", temp >> 8 ) );
	}
}

void CGuard::CPGD_SET_AGC( WORD Cval, WORD Yval )
{
	WORD	Lval;

	Lval = ((Yval & 0x03) << 4) + ((Cval & 0x03) << 6);
	Cval >>= 2;
	Yval >>= 2;
	WRITE_PORT_UCHAR( ioBase + CPGD_CAGC, (UCHAR)Cval );
	WRITE_PORT_UCHAR( ioBase + CPGD_YAGC, (UCHAR)Yval );
	WRITE_PORT_UCHAR( ioBase + CPGD_LAGC, (UCHAR)Lval );
}

ULONG CGuard::CPGD_CALC_CRC( ULONG val )
{
	ULONG crc = 0;
	ULONG i, j;

	crc = (val & 0x3FFF) << 6;

	i = 0x80000000;
	j = 0x86000000;					// 100001100....00(b)

	do {
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  i=%x, j=%x, crc=%x\r\n", i, j, crc ) );
		if( (crc & i)==0 ) {
			i >>= 1;
			j >>= 1;
			if( i<=0x20 )
				break;
		}
		else {
			crc ^= j;
		}
	} while( 1 );

	return( crc );
}

//void CGuard::CPGD_BURST_Y_OFF( void )
//{
//	// always turn off Burst Y.
//	if( AGCchip==NO_AGC ) {
//		return;
//	}
//	else if( AGCchip==TC6802 || AGCchip==TC6814 ) {
//		WRITE_PORT_UCHAR( ioBase + CPGD_BSTONY, 0x00 );
//		DebugPrint( ( DebugLevelTrace, "TOSDVD:  BURST_Y_OFF\r\n" ) );
//	}
//	else if( AGCchip==TC6818 ) {
//		// no operation, because this register is set by other functions.
//	}
//}