#include "COMMON.h"

int main(void)
{
	Camera_Init();	//ʼͷ

	//VDMA
	run_vdma_frame_buffer(&Vdma, VDMA_ID, RGB_LCD.width, RGB_LCD.height,
							FrameBuffer_Addr,0, 0,BOTH);
    //ʼDisplay controller
	DisplayInitialize(&DispCtrl, DISP_VTC_ID, DYNCLK_BASEADDR);

    //VideoMode
	DisplaySetMode(&DispCtrl, &RGB_LCD);
	DisplayStart(&DispCtrl);
	while(1){
		uint16_t ID = 0;






		ID = SCCB_Read(0x300b);       //0x40
		ID |= SCCB_Read(0x300a) << 8;  //0x56
		if(ID != 0x5640){//ȡȷIDOV5640
			SCCB_Write_REG8(0xff,0x01);//ѡDSP Address
			SCCB_Write_REG8(0x12,0x80);
			usleep(50000);
			//OV2640ͷID
			ID = SCCB_Read_REG8(0x1c);	//ȡID ߰λ
			ID << 8;
			ID |= SCCB_Read_REG8(0x1d);	//ȡID Ͱλ
			if(ID == 0x7fa2){//ȡȷIDOV2640
				Camera_Init();
			}
		}
		usleep(5000000);
	}

    return 0;
}
