#include "ICETEK-C6713-A.h"
//////////////////////////////////////////////
// 1.在程序中"break point"注釋行語句上加軟件斷點
// 2.看大圖：菜單view->graph->Image:
//     color space                  = RGB
//     Start Address -R Source      = y
//     Start Address -G Source      = y
//     Start Address -B Source      = y
//     Lines Per Display            = 288
//     Pixels Per Line              = 720
//     Byte Packing to Fill 32 Bits = No
//     Image Origin                 = Top Left
// 3.看小圖：菜單view->graph->Image:
//     color space                  = RGB
//     Start Address -R Source      = buffer
//     Start Address -G Source      = buffer
//     Start Address -B Source      = buffer
//     Lines Per Display            = 96
//     Pixels Per Line              = 120
//     Byte Packing to Fill 32 Bits = No
//     Image Origin                 = Top Left
// 4.按F5運(yùn)行到斷點可顯示采集圖像
// 5.轉(zhuǎn)動攝像頭后再按F5可再次采集
///////////////////////////////////////

#define IDKCCMDRESET 2
#define IDKCCMDCAPTURE 4
#define IDKCCMDRESETRP 8
#define IDKCCMDRESETWP 0x10
#define IDKCCMDCOLOR 0x20
#define IDKIMGREADY 2

#define PLL_BASE_ADDR   0x01b7c000
#define PLL_PID         ( PLL_BASE_ADDR + 0x000 )
#define PLL_CSR         ( PLL_BASE_ADDR + 0x100 )
#define PLL_MULT        ( PLL_BASE_ADDR + 0x110 )
#define PLL_DIV0        ( PLL_BASE_ADDR + 0x114 )
#define PLL_DIV1        ( PLL_BASE_ADDR + 0x118 )
#define PLL_DIV2        ( PLL_BASE_ADDR + 0x11C )
#define PLL_DIV3        ( PLL_BASE_ADDR + 0x120 )
#define PLL_OSCDIV1     ( PLL_BASE_ADDR + 0x124 )
#define CSR_PLLEN          0x00000001
#define CSR_PLLPWRDN       0x00000002
#define CSR_PLLRST         0x00000008 
#define CSR_PLLSTABLE      0x00000040
#define DIV_ENABLE         0x00008000

void Delay(unsigned int nTime);	// 延時
void StartIIC(void);		// 啟動I2C總線傳輸
void StopIIC(void);		// 停止I2C總線傳輸
void AckIIC(void);		
void WriteIIC(unsigned char data);	// 寫字節(jié)數(shù)據(jù)到I2C總線
void Init5150(void);			// 初始化ICETEK-TVP5150-E
void DelayMSEC(unsigned int nDelay);	// 延時
void Close5150(void);			// 關(guān)閉ICETEK-TVP5150-E
void  init_pll( void );			// 設(shè)置DSP主頻

unsigned char buffer[120*96],y[720*288];	// Y存放圖象

main()
{
	int i,j,x,c1,c2,c3,xx,yy,uu,vv,xxx;
	float rr,gg,bb;
	unsigned int www=722,bGoodFrame,dbScanCode;
	int a,b,c,d,e,f,g,h;
	unsigned char uWork;

	init_emif();	// 初始化emif
    	InitCTR();		// 初始化ICETEK-CTR
	xx=1;
	for ( j=0;j<72;j++ )
		for ( i=0;i<90;i++ )
			y[j*90+i]=0;
	a=288;
	b=722;
	c=0;
	d=8;
	e=4;
	f=1;
	g=576;
	h=0;
	Init5150();	// 初始化ICETEK-TVP5150-E
	init_pll();
	
	while ( 1 )
	{
		if ( xx )
		{
			IDKCGR=IDKCCMDRESET; IDKCGR=0;	// 復(fù)位FIFO
			Delay(16);
			IDKCGR=IDKCCMDRESETWP;		// 復(fù)位FIFO寫指針
			IDKCGR=IDKCCMDCAPTURE;		// 啟動采集
			Delay(2560);
			IDKCGR=0;
			Delay(2560);
		}
		x=0;
		IDKCGR=IDKCCMDRESETRP;		// 復(fù)位FIFO讀指針
		Delay(16);		
		IDKCGR=0;	
		Delay(16);		
		uWork=IDKCDATA;			// 讀取首個數(shù)據(jù)并放棄
		Delay(16);		
		for ( i=0;i<724;i++ )	buffer[i]=0;
		for ( i=0;i<c;i++ )	buffer[i]=IDKCDATA;
		for ( j=0;j<a;j++ )		// 讀取整幅圖象722x288
		{
			for ( i=0;i<b;i++ )
			{
				y[j*720+i]=buffer[i]=IDKCDATA;
			}
		}
		// 將圖象縮小后觀察
		for ( j=0;j<288;j+=3 )
			for ( i=0;i<720;i+=6 )
				buffer[j/3*120+i/6]=y[j*720+i];
		xxx=IDKCSTATUS;
		x=0;	// BREAK POINT 在此設(shè)置軟件斷點
		x=0;
		x=0;
	}
	exit(0);
}               

void StartIIC(void)
{
	I2C_REG = 0x05;		/*	"00100101":sda,scl = '1' */
	DelayMSEC(1);
	I2C_REG = 0x04;		/*	"00100100":sda= '0',scl = '1' */
	DelayMSEC(1);
}
void StopIIC(void)
{	
	I2C_REG = 0x024;		/*	"00100101":sda = '0',scl = '1' */
	DelayMSEC(1);
	I2C_REG = 0x025;		/*	"00100101":sda,scl = '1' */
	DelayMSEC(1);
}		
void AckIIC(void)
{
	I2C_REG = 0x020;		/*	"00100101":sda='z',scl = '0' */
	I2C_REG = 0x022;		/*	"00100101":sda='z',scl = '0' */
	DelayMSEC(1);
	I2C_REG = 0x026;		/*	"00100101":sda='z',scl = '1' */
	DelayMSEC(1);
	I2C_REG = 0x022;		/*	"00100101":sda='z',scl = '0' */
	DelayMSEC(1);
	I2C_REG = 0x021;		/*	"00100101":sda='1',scl = '0' */
	DelayMSEC(1);
}	
void WriteIIC(unsigned char data)
{
	unsigned char BitCounter = 8;
	unsigned char Temp;
	unsigned int reg_val;
	
	reg_val = 0x020;
	I2C_REG = 0x20;		/*SCL 置低 sda 置低*/
	DelayMSEC(1);						/*延時*/
	do{
		Temp = data;
		reg_val &= 0x0fffffffb;
		I2C_REG = reg_val;		/*SCL 置低*/
		DelayMSEC(1);						/*延時*/
		
		if((Temp&0x80)==0x80)
			reg_val |= 0x01;	/*如果最高位是1*/
		else
			reg_val &= 0x0fffffe;
		I2C_REG = reg_val;		/*設(shè)置SDA*/
		DelayMSEC(1);						/*延時*/

		reg_val |= 0x004;
		I2C_REG = reg_val;		/*SCL 置高*/
		DelayMSEC(1);						/*延時*/

		Temp = data<<1;
		data = Temp;
		BitCounter --;
	}while(BitCounter);

	reg_val &= 0x0fffffffb;
	I2C_REG = reg_val;		/*SCL 置低*/
	DelayMSEC(3);						/*延時*/
}	

void Init5150(void)
{
	StartIIC();		
	WriteIIC(0x0ba);			
	AckIIC();
	WriteIIC(0x03);		// TVP5150控制寄存器3，取值0x8F
	AckIIC();
	WriteIIC(0x08f);
	AckIIC();
	StopIIC();
	DelayMSEC(10);
}

void DelayMSEC(unsigned int nDelay)
{
	unsigned int i,k;
	
	for ( i=0;i<nDelay*64;i++ )
	{
//		for ( j=0;j<6144;j++ )
			k++;

	}
}

void  init_pll( void )
{
    *(int *)PLL_CSR  &= ~CSR_PLLEN;		// Enable PLL
    *(int *)PLL_CSR  |= CSR_PLLRST;		// Asserts RESET to PLL
    *(int *)PLL_DIV0    = DIV_ENABLE + 0;  // div0 enable
    *(int *)PLL_MULT    = 4;//8;			// 25MHz×8=200MHz               
    *(int *)PLL_OSCDIV1 = DIV_ENABLE + 4;
    *(int *)PLL_DIV3    = DIV_ENABLE + 3; 
    *(int *)PLL_DIV2    = DIV_ENABLE + 3; 
    *(int *)PLL_DIV1    = DIV_ENABLE + 1; 
    *(int *)PLL_CSR  &= ~CSR_PLLRST;
    *(int *)PLL_CSR |= CSR_PLLEN;

}

/* END OF FILE */