#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 ID0 = 0,ID1 = 0;






		ID  = SCCB_Read(0x300b);       //0x40
		ID |= SCCB_Read(0x300a) << 8;  //0x56


		if(ID == 0x5640){//ȡȷIDOV5640
			Camera_Init();
		}
		else{
			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

		}
		usleep(5000000);
	}

    return 0;
}
