#include "sys.h"
#include "ov2640.h"
#include "ov2640cfg.h"
//#include "timer.h"	  
#include "delay.h"
#include "usart.h"			 
#include "sccb.h"	
#include "stdio.h"
  
//³õʼ»¯OV2640 
//ÅäÖÃÍêÒÔºó,ĬÈÏÊä³öÊÇ1600*1200³ß´çµÄͼƬ!! 
//·µ»ØÖµ:0,³É¹¦
//    ÆäËû,´íÎó´úÂë
void OV2640_PWDN(uint8_t signal)
{
	HAL_GPIO_WritePin(GPIOB, GPIO_PIN_15, (GPIO_PinState)signal);
}

void OV2640_RST(uint8_t signal)
{
	HAL_GPIO_WritePin(GPIOB, GPIO_PIN_13, (GPIO_PinState)signal);
}

uint8_t OV2640_Init(void)
{ 
	uint16_t i=0;
	uint16_t reg;
	//ÉèÖÃIO     	   
	GPIO_InitTypeDef  GPIO_InitStructure;
	__HAL_RCC_GPIOG_CLK_ENABLE();           //ʹÄÜGPIOBʱÖÓ
	HAL_GPIO_WritePin(GPIOB, GPIO_PIN_13|GPIO_PIN_15, GPIO_PIN_RESET);
  //GPIOF9,F10³õʼ»¯ÉèÖÃ
  GPIO_InitStructure.Pin = GPIO_PIN_13|GPIO_PIN_15;
  GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;  
  GPIO_InitStructure.Speed = GPIO_SPEED_FAST;
  GPIO_InitStructure.Pull = GPIO_PULLUP;//ÉÏÀ­
  HAL_GPIO_Init(GPIOB, &GPIO_InitStructure);//³õʼ»
	
 	OV2640_PWDN(0);	//POWER ON
	delay_ms(10);
	OV2640_RST(0);	//¸´Î»OV2640
	delay_ms(10);
	OV2640_RST(1);	//½áÊø¸´Î» 
  SCCB_Init();        		//³õʼ»¯SCCB µÄIO¿Ú	 
	SCCB_WR_Reg(OV2640_DSP_RA_DLMT, 0x01);	//²Ù×÷sensor¼Ä´æÆ÷
 	SCCB_WR_Reg(OV2640_SENSOR_COM7, 0x80);	//Èí¸´Î»OV2640
	delay_ms(50); 
	reg=SCCB_RD_Reg(OV2640_SENSOR_MIDH);	//¶ÁÈ¡³§¼ÒID ¸ß°Ëλ
	reg<<=8;
	reg|=SCCB_RD_Reg(OV2640_SENSOR_MIDL);	//¶ÁÈ¡³§¼ÒID µÍ°Ëλ
	printf("OV2640_MID = %#X\n" , reg);
	if(reg!=OV2640_MID)
	{
		printf("MID:%d\r\n",reg);
		return 1;
	}
	reg=SCCB_RD_Reg(OV2640_SENSOR_PIDH);	//¶ÁÈ¡³§¼ÒID ¸ß°Ëλ
	reg<<=8;
	reg|=SCCB_RD_Reg(OV2640_SENSOR_PIDL);	//¶ÁÈ¡³§¼ÒID µÍ°Ëλ
	if(reg!=OV2640_PID)
	{
		printf("HID:%d\r\n",reg);
		return 2;
	}   
	for(i=0;i<sizeof(ov2640_svga_init_reg_tbl)/2;i++)
	{
	   	SCCB_WR_Reg(ov2640_svga_init_reg_tbl[i][0],ov2640_svga_init_reg_tbl[i][1]);
 	} 
	printf("OV2640_init SUCCESS\n");
  return 0x00; 	//ok
} 
//OV2640Çл»ÎªJPEGģʽ
void OV2640_JPEG_Mode(void) 
{
	uint16_t i=0;
	//ÉèÖÃ:YUV422¸ñʽ
	for(i=0;i<(sizeof(ov2640_yuv422_reg_tbl)/2);i++)
	{
		SCCB_WR_Reg(ov2640_yuv422_reg_tbl[i][0],ov2640_yuv422_reg_tbl[i][1]); 
	} 
	
	//ÉèÖÃ:Êä³öJPEGÊý¾Ý
	for(i=0;i<(sizeof(ov2640_jpeg_reg_tbl)/2);i++)
	{
		SCCB_WR_Reg(ov2640_jpeg_reg_tbl[i][0],ov2640_jpeg_reg_tbl[i][1]);  
	}  
}
//OV2640Çл»ÎªRGB565ģʽ
void OV2640_RGB565_Mode(void) 
{
	uint16_t i=0;
	//ÉèÖÃ:RGB565Êä³ö
	for(i=0;i<(sizeof(ov2640_rgb565_reg_tbl)/2);i++)
	{
		SCCB_WR_Reg(ov2640_rgb565_reg_tbl[i][0],ov2640_rgb565_reg_tbl[i][1]); 
	}
	printf("OV2640_RGB565 SET!\n");
} 
//×Ô¶¯ÆعâÉèÖòÎÊý±í,Ö§³Ö5¸öµÈ¼¶
const static uint8_t OV2640_AUTOEXPOSURE_LEVEL[5][8]=
{
	{
		0xFF,0x01,
		0x24,0x20,
		0x25,0x18,
		0x26,0x60,
	},
	{
		0xFF,0x01,
		0x24,0x34,
		0x25,0x1c,
		0x26,0x00,
	},
	{
		0xFF,0x01,	
		0x24,0x3e,	
		0x25,0x38,
		0x26,0x81,
	},
	{
		0xFF,0x01,
		0x24,0x48,
		0x25,0x40,
		0x26,0x81,
	},
	{
		0xFF,0x01,	
		0x24,0x58,	
		0x25,0x50,	
		0x26,0x92,	
	},
}; 
//OV2640×Ô¶¯ÆعâµÈ¼¶ÉèÖÃ
//level:0~4
void OV2640_Auto_Exposure(uint8_t level)
{  
	uint8_t i;
	uint8_t *p=(uint8_t*)OV2640_AUTOEXPOSURE_LEVEL[level];
	for(i=0;i<4;i++)
	{ 
		SCCB_WR_Reg(p[i*2],p[i*2+1]); 
	} 
}  
//°×ƽºâÉèÖÃ
//0:×Ô¶¯
//1:Ì«Ñôsunny
//2,ÒõÌìcloudy
//3,°ì¹«ÊÒoffice
//4,¼ÒÀïhome
void OV2640_Light_Mode(uint8_t mode)
{
	uint8_t regccval=0X5E;//Sunny 
	uint8_t regcdval=0X41;
	uint8_t regceval=0X54;
	switch(mode)
	{ 
		case 0://auto 
			SCCB_WR_Reg(0XFF,0X00);	 
			SCCB_WR_Reg(0XC7,0X10);//AWB ON 
			return;  	
		case 2://cloudy
			regccval=0X65;
			regcdval=0X41;
			regceval=0X4F;
			break;	
		case 3://office
			regccval=0X52;
			regcdval=0X41;
			regceval=0X66;
			break;	
		case 4://home
			regccval=0X42;
			regcdval=0X3F;
			regceval=0X71;
			break;	
	}
	SCCB_WR_Reg(0XFF,0X00);	 
	SCCB_WR_Reg(0XC7,0X40);	//AWB OFF 
	SCCB_WR_Reg(0XCC,regccval); 
	SCCB_WR_Reg(0XCD,regcdval); 
	SCCB_WR_Reg(0XCE,regceval);  
}
//É«¶ÈÉèÖÃ
//0:-2
//1:-1
//2,0
//3,+1
//4,+2
void OV2640_Color_Saturation(uint8_t sat)
{ 
	uint8_t reg7dval=((sat+2)<<4)|0X08;
	SCCB_WR_Reg(0XFF,0X00);		
	SCCB_WR_Reg(0X7C,0X00);		
	SCCB_WR_Reg(0X7D,0X02);				
	SCCB_WR_Reg(0X7C,0X03);			
	SCCB_WR_Reg(0X7D,reg7dval);			
	SCCB_WR_Reg(0X7D,reg7dval); 		
}
//ÁÁ¶ÈÉèÖÃ
//0:(0X00)-2
//1:(0X10)-1
//2,(0X20) 0
//3,(0X30)+1
//4,(0X40)+2
void OV2640_Brightness(uint8_t bright)
{
  SCCB_WR_Reg(0xff, 0x00);
  SCCB_WR_Reg(0x7c, 0x00);
  SCCB_WR_Reg(0x7d, 0x04);
  SCCB_WR_Reg(0x7c, 0x09);
  SCCB_WR_Reg(0x7d, bright<<4); 
  SCCB_WR_Reg(0x7d, 0x00); 
}
//¶Ô±È¶ÈÉèÖÃ
//0:-2
//1:-1
//2,0
//3,+1
//4,+2
void OV2640_Contrast(uint8_t contrast)
{
	uint8_t reg7d0val=0X20;//ĬÈÏΪÆÕͨģʽ
	uint8_t reg7d1val=0X20;
  	switch(contrast)
	{
		case 0://-2
			reg7d0val=0X18;	 	 
			reg7d1val=0X34;	 	 
			break;	
		case 1://-1
			reg7d0val=0X1C;	 	 
			reg7d1val=0X2A;	 	 
			break;	
		case 3://1
			reg7d0val=0X24;	 	 
			reg7d1val=0X16;	 	 
			break;	
		case 4://2
			reg7d0val=0X28;	 	 
			reg7d1val=0X0C;	 	 
			break;	
	}
	SCCB_WR_Reg(0xff,0x00);
	SCCB_WR_Reg(0x7c,0x00);
	SCCB_WR_Reg(0x7d,0x04);
	SCCB_WR_Reg(0x7c,0x07);
	SCCB_WR_Reg(0x7d,0x20);
	SCCB_WR_Reg(0x7d,reg7d0val);
	SCCB_WR_Reg(0x7d,reg7d1val);
	SCCB_WR_Reg(0x7d,0x06);
}
//ÌØЧÉèÖÃ
//0:ÆÕͨģʽ    
//1,¸ºÆ¬
//2,ºÚ°×   
//3,Æ«ºìÉ«
//4,Æ«ÂÌÉ«
//5,Æ«À¶É«
//6,¸´¹Å	    
void OV2640_Special_Effects(uint8_t eft)
{
	uint8_t reg7d0val=0X00;//ĬÈÏΪÆÕͨģʽ
	uint8_t reg7d1val=0X80;
	uint8_t reg7d2val=0X80; 
	switch(eft)
	{
		case 1://¸ºÆ¬
			reg7d0val=0X40; 
			break;	
		case 2://ºÚ°×
			reg7d0val=0X18; 
			break;	 
		case 3://Æ«ºìÉ«
			reg7d0val=0X18; 
			reg7d1val=0X40;
			reg7d2val=0XC0; 
			break;	
		case 4://Æ«ÂÌÉ«
			reg7d0val=0X18; 
			reg7d1val=0X40;
			reg7d2val=0X40; 
			break;	
		case 5://Æ«À¶É«
			reg7d0val=0X18; 
			reg7d1val=0XA0;
			reg7d2val=0X40; 
			break;	
		case 6://¸´¹Å
			reg7d0val=0X18; 
			reg7d1val=0X40;
			reg7d2val=0XA6; 
			break;	 
	}
	SCCB_WR_Reg(0xff,0x00);
	SCCB_WR_Reg(0x7c,0x00);
	SCCB_WR_Reg(0x7d,reg7d0val);
	SCCB_WR_Reg(0x7c,0x05);
	SCCB_WR_Reg(0x7d,reg7d1val);
	SCCB_WR_Reg(0x7d,reg7d2val); 
}
//²ÊÌõ²âÊÔ
//sw:0,¹Ø±Õ²ÊÌõ
//   1,¿ªÆô²ÊÌõ(×¢ÒâOV2640µÄ²ÊÌõÊǵþ¼ÓÔÚͼÏñÉÏÃæµÄ)
void OV2640_Color_Bar(uint8_t sw)
{
	uint8_t reg;
	SCCB_WR_Reg(0XFF,0X01);
	reg=SCCB_RD_Reg(0X12);
	reg&=~(1<<1);
	if(sw)reg|=1<<1; 
	SCCB_WR_Reg(0X12,reg);
}
//ÉèÖÃͼÏñÊä³ö´°¿Ú 
//sx,sy,ÆðʼµØÖ·
//width,height:¿í¶È(¶ÔÓ¦:horizontal)ºÍ¸ß¶È(¶ÔÓ¦:vertical)
void OV2640_Window_Set(uint16_t sx,uint16_t sy,uint16_t width,uint16_t height)
{
	uint16_t endx;
	uint16_t endy;
	uint8_t temp; 
	endx=sx+width/2;	//V*2
 	endy=sy+height/2;
	
	SCCB_WR_Reg(0XFF,0X01);			
	temp=SCCB_RD_Reg(0X03);				//¶ÁÈ¡Vref֮ǰµÄÖµ
	temp&=0XF0;
	temp|=((endy&0X03)<<2)|(sy&0X03);
	SCCB_WR_Reg(0X03,temp);				//ÉèÖÃVrefµÄstartºÍendµÄ×îµÍ2λ
	SCCB_WR_Reg(0X19,sy>>2);			//ÉèÖÃVrefµÄstart¸ß8λ
	SCCB_WR_Reg(0X1A,endy>>2);			//ÉèÖÃVrefµÄendµÄ¸ß8λ
	
	temp=SCCB_RD_Reg(0X32);				//¶ÁÈ¡Href֮ǰµÄÖµ
	temp&=0XC0;
	temp|=((endx&0X07)<<3)|(sx&0X07);
	SCCB_WR_Reg(0X32,temp);				//ÉèÖÃHrefµÄstartºÍendµÄ×îµÍ3λ
	SCCB_WR_Reg(0X17,sx>>3);			//ÉèÖÃHrefµÄstart¸ß8λ
	SCCB_WR_Reg(0X18,endx>>3);			//ÉèÖÃHrefµÄendµÄ¸ß8λ
}
//ÉèÖÃͼÏñÊä³ö´óС
//OV2640Êä³öͼÏñµÄ´óС(·Ö±æÂÊ),ÍêÈ«Óɸĺ¯ÊýÈ·¶¨
//width,height:¿í¶È(¶ÔÓ¦:horizontal)ºÍ¸ß¶È(¶ÔÓ¦:vertical),widthºÍheight±ØÐëÊÇ4µÄ±¶Êý
//·µ»ØÖµ:0,ÉèÖóɹ¦
//    ÆäËû,ÉèÖÃʧ°Ü
uint8_t OV2640_OutSize_Set(uint16_t width,uint16_t height)
{
	uint16_t outh;
	uint16_t outw;
	uint8_t temp; 
	if(width%4)return 1;
	if(height%4)return 2;
	outw=width/4;
	outh=height/4; 
	SCCB_WR_Reg(0XFF,0X00);	
	SCCB_WR_Reg(0XE0,0X04);			
	SCCB_WR_Reg(0X5A,outw&0XFF);		//ÉèÖÃOUTWµÄµÍ°Ëλ
	SCCB_WR_Reg(0X5B,outh&0XFF);		//ÉèÖÃOUTHµÄµÍ°Ëλ
	temp=(outw>>8)&0X03;
	temp|=(outh>>6)&0X04;
	SCCB_WR_Reg(0X5C,temp);				//ÉèÖÃOUTH/OUTWµÄ¸ßλ 
	SCCB_WR_Reg(0XE0,0X00);	
	return 0;
}
//ÉèÖÃͼÏñ¿ª´°´óС
//ÓÉ:OV2640_ImageSize_SetÈ·¶¨´«¸ÐÆ÷Êä³ö·Ö±æÂÊ´Ó´óС.
//¸Ãº¯ÊýÔòÔÚÕâ¸ö·¶Î§ÉÏÃæ½øÐпª´°,ÓÃÓÚOV2640_OutSize_SetµÄÊä³ö
//×¢Òâ:±¾º¯ÊýµÄ¿í¶ÈºÍ¸ß¶È,±ØÐë´óÓÚµÈÓÚOV2640_OutSize_Setº¯ÊýµÄ¿í¶ÈºÍ¸ß¶È
//     OV2640_OutSize_SetÉèÖõĿí¶ÈºÍ¸ß¶È,¸ù¾Ý±¾º¯ÊýÉèÖõĿí¶ÈºÍ¸ß¶È,ÓÉDSP
//     ×Ô¶¯¼ÆËãËõ·Å±ÈÀý,Êä³ö¸øÍⲿÉ豸.
//width,height:¿í¶È(¶ÔÓ¦:horizontal)ºÍ¸ß¶È(¶ÔÓ¦:vertical),widthºÍheight±ØÐëÊÇ4µÄ±¶Êý
//·µ»ØÖµ:0,ÉèÖóɹ¦
//    ÆäËû,ÉèÖÃʧ°Ü
uint8_t OV2640_ImageWin_Set(uint16_t offx,uint16_t offy,uint16_t width,uint16_t height)
{
	uint16_t hsize;
	uint16_t vsize;
	uint8_t temp; 
	if(width%4)return 1;
	if(height%4)return 2;
	hsize=width/4;
	vsize=height/4;
	SCCB_WR_Reg(0XFF,0X00);	
	SCCB_WR_Reg(0XE0,0X04);					
	SCCB_WR_Reg(0X51,hsize&0XFF);		//ÉèÖÃH_SIZEµÄµÍ°Ëλ
	SCCB_WR_Reg(0X52,vsize&0XFF);		//ÉèÖÃV_SIZEµÄµÍ°Ëλ
	SCCB_WR_Reg(0X53,offx&0XFF);		//ÉèÖÃoffxµÄµÍ°Ëλ
	SCCB_WR_Reg(0X54,offy&0XFF);		//ÉèÖÃoffyµÄµÍ°Ëλ
	temp=(vsize>>1)&0X80;
	temp|=(offy>>4)&0X70;
	temp|=(hsize>>5)&0X08;
	temp|=(offx>>8)&0X07; 
	SCCB_WR_Reg(0X55,temp);				//ÉèÖÃH_SIZE/V_SIZE/OFFX,OFFYµÄ¸ßλ
	SCCB_WR_Reg(0X57,(hsize>>2)&0X80);	//ÉèÖÃH_SIZE/V_SIZE/OFFX,OFFYµÄ¸ßλ
	SCCB_WR_Reg(0XE0,0X00);	
	return 0;
} 
//¸Ãº¯ÊýÉèÖÃͼÏñ³ß´ç´óС,Ò²¾ÍÊÇËùÑ¡¸ñʽµÄÊä³ö·Ö±æÂÊ
//UXGA:1600*1200,SVGA:800*600,CIF:352*288
//width,height:ͼÏñ¿í¶ÈºÍͼÏñ¸ß¶È
//·µ»ØÖµ:0,ÉèÖóɹ¦
//    ÆäËû,ÉèÖÃʧ°Ü
uint8_t OV2640_ImageSize_Set(uint16_t width,uint16_t height)
{ 
	uint8_t temp; 
	SCCB_WR_Reg(0XFF,0X00);			
	SCCB_WR_Reg(0XE0,0X04);			
	SCCB_WR_Reg(0XC0,(width)>>3&0XFF);		//ÉèÖÃHSIZEµÄ10:3λ
	SCCB_WR_Reg(0XC1,(height)>>3&0XFF);		//ÉèÖÃVSIZEµÄ10:3λ
	temp=(width&0X07)<<3;
	temp|=height&0X07;
	temp|=(width>>4)&0X80; 
	SCCB_WR_Reg(0X8C,temp);	
	SCCB_WR_Reg(0XE0,0X00);				 
	return 0;
}