#include "system.h"
#include "test.h"
#include "adv7171.h"
#include "video.h"





void ADV7171_InReset(void)
{
	*pCtrlClrReg1 = CTRL_ADV7171_RESET; // ADV7171 in Reset
	Delay(100);
}

void ADV7171_ExitReset(void)
{
	*pCtrlSetReg1 = CTRL_ADV7171_RESET; // ADV7171 exit Reset
	Delay(100);
}

void Init_ADV7171_PPI(void)
{
	*pPPI_CONTROL = PACK_EN | /*DMA32 | */PORT_DIR;
}

void Init_ADV7171_DMA(BOOL IsPAL)
{
	*pDMA0_PERIPHERAL_MAP = 0x0000;
	*pDMA0_START_ADDR = (volatile void *)VIDEO_FRAME_BUFFER_BASE;
	//*pDMA0_CONFIG = 0x0094;
	*pDMA0_CONFIG = 0x1014;

	if (IsPAL) // PAL
	{
		*pDMA0_X_COUNT = HORIZONTAL_TOTAL_PAL >> 1;
		*pDMA0_Y_COUNT = NUM_LINES_PAL;
	}
	else // NTSC
	{
		*pDMA0_X_COUNT = HORIZONTAL_TOTAL_NTSC >> 1;
		*pDMA0_Y_COUNT = NUM_LINES_NTSC;
	}

	*pDMA0_X_MODIFY = 0x0002;
	*pDMA0_Y_MODIFY = 0x0002;
}

BOOL Init_ADV7171(BOOL IsPAL)
{
	// Initialize I2C for ADV7171
	if (!I2C_Init(ADV7171_IDENT_W))
		return FALSE;

	if (IsPAL)
	{
		// PAL-D
		if (!I2C_Write(0x05, 0x00)) return FALSE; // Mode Register 0
		if (!I2C_Write(0x00, 0x01)) return FALSE; // Mode Register 1
		if (!I2C_Write(0x00, 0x02)) return FALSE; // Mode Register 2
		if (!I2C_Write(0x08, 0x03)) return FALSE; // Mode Register 3
		if (!I2C_Write(0x00, 0x04)) return FALSE; // Mode Register 4
		if (!I2C_Write(0x00, 0x07)) return FALSE; // Timing Register 0
		if (!I2C_Write(0x00, 0x08)) return FALSE; // Timing Register 1
		if (!I2C_Write(0xCB, 0x09)) return FALSE; // Subcarrier Frequency Register 0
		if (!I2C_Write(0x8A, 0x0A)) return FALSE; // Subcarrier Frequency Register 1
		if (!I2C_Write(0x09, 0x0B)) return FALSE; // Subcarrier Frequency Register 2
		if (!I2C_Write(0x2A, 0x0C)) return FALSE; // Subcarrier Frequency Register 3
		if (!I2C_Write(0x00, 0x0D)) return FALSE; // Subcarrier Phase Register
		if (!I2C_Write(0x00, 0x0E)) return FALSE; // Closed Captioning Ext Register 0
		if (!I2C_Write(0x00, 0x0F)) return FALSE; // Closed Captioning Ext Register 1
		if (!I2C_Write(0x00, 0x10)) return FALSE; // Closed Captioning Register 0
		if (!I2C_Write(0x00, 0x11)) return FALSE; // Closed Captioning Register 1
		if (!I2C_Write(0x00, 0x12)) return FALSE; // Pedestal Control Register 0
		if (!I2C_Write(0x00, 0x13)) return FALSE; // Pedestal Control Register 1
		if (!I2C_Write(0x00, 0x14)) return FALSE; // Pedestal Control Register 2
		if (!I2C_Write(0x00, 0x15)) return FALSE; // Pedestal Control Register 3
		if (!I2C_Write(0x00, 0x16)) return FALSE; // CGMS_WSS Reg 0
		if (!I2C_Write(0x00, 0x17)) return FALSE; // CGMS_WSS Reg 1
		if (!I2C_Write(0x00, 0x18)) return FALSE; // CGMS_WSS Reg 2
		if (!I2C_Write(0x00, 0x19)) return FALSE; // Teletext Request Control Register
	}
	else
	{
		// NTSC
		if (!I2C_Write(0x00, 0x00)) return FALSE; // Mode Register 0
		if (!I2C_Write(0x58, 0x01)) return FALSE; // Mode Register 1
		if (!I2C_Write(0x00, 0x02)) return FALSE; // Mode Register 2
		if (!I2C_Write(0x00, 0x03)) return FALSE; // Mode Register 3
		if (!I2C_Write(0x10, 0x04)) return FALSE; // Mode Register 4
		if (!I2C_Write(0x00, 0x07)) return FALSE; // Timing Register 0
		if (!I2C_Write(0x00, 0x08)) return FALSE; // Timing Register 1
		if (!I2C_Write(0x16, 0x09)) return FALSE; // Subcarrier Frequency Register 0
		if (!I2C_Write(0x7C, 0x0A)) return FALSE; // Subcarrier Frequency Register 1
		if (!I2C_Write(0xF0, 0x0B)) return FALSE; // Subcarrier Frequency Register 2
		if (!I2C_Write(0x21, 0x0C)) return FALSE; // Subcarrier Frequency Register 3
		if (!I2C_Write(0x00, 0x0D)) return FALSE; // Subcarrier Phase Register
		if (!I2C_Write(0x00, 0x0E)) return FALSE; // Closed Captioning Ext Register 0
		if (!I2C_Write(0x00, 0x0F)) return FALSE; // Closed Captioning Ext Register 1
		if (!I2C_Write(0x00, 0x10)) return FALSE; // Closed Captioning Register 0
		if (!I2C_Write(0x00, 0x11)) return FALSE; // Closed Captioning Register 1
		if (!I2C_Write(0x00, 0x12)) return FALSE; // Pedestal Control Register 0
		if (!I2C_Write(0x00, 0x13)) return FALSE; // Pedestal Control Register 1
		if (!I2C_Write(0x00, 0x14)) return FALSE; // Pedestal Control Register 2
		if (!I2C_Write(0x00, 0x15)) return FALSE; // Pedestal Control Register 3
		if (!I2C_Write(0x00, 0x16)) return FALSE; // CGMS_WSS Reg 0
		if (!I2C_Write(0x00, 0x17)) return FALSE; // CGMS_WSS Reg 1
		if (!I2C_Write(0x00, 0x18)) return FALSE; // CGMS_WSS Reg 2
		if (!I2C_Write(0x00, 0x19)) return FALSE; // Teletext Request Control Register
	}

	return TRUE;
}