hv7131.c

ssd192X_LPC2210_V2.0 LPC2210的16位数据口控制SSD1926

#include "ssd192X.h"
#include "i2c.h"
#include "hv7131.h"

int CAM_WIDTH=320;
int CAM_HEIGHT=240;
int CAM_FRAME_RATE=70;

void cam_hw_init(void)
{
	unsigned char revisionNum;
	I2C i2c;

	debug("Initialize HV7131\n");

	SSD_REGWB(REG_VCLK_CONFIG_0,0x06);
	SSD_REGWB(REG_VCLK_CONFIG_1,0x17);

	// Reset HV7131
	
	SSD_REGWB(REG_DV_ENB,0x03);	// ENB_DV = 1)= RESET_DV = 1
	SSD_REGWB(REG_DV_ENB,0x02);	// ENB_DV = 1)= RESET_DV = 0
	SSD_REGWB(REG_DV_ENB,0x03);	// ENB_DV = 1)= RESET_DV = 1

	i2c.deviceID=I2C_DEVICE_ID;
	i2c.bitRate=1;
  	ssd192X_i2c_init(&i2c);

	//check revision
	revisionNum=ssd192X_i2c_readb_without_ACK(&i2c, 0x00);
	debug("HV7131 Sensor Array Resolution (%d) revision (%d)\n",(revisionNum>>4)&0xF,revisionNum&0xF);

	//turn off x-flip
	ssd192X_i2c_writeb(&i2c, 0x01, 0x03);
	ssd192X_i2c_writeb(&i2c, 0x02, 0x00);
	
	//turn off black level compensation
	ssd192X_i2c_writeb(&i2c, 0x03, 0x00);

	//turn off Auto White Balance gain mode
	ssd192X_i2c_writeb(&i2c, 0x71, 0x00);

	//set rgb gain, preamp gain, in other words analog block settings
	ssd192X_i2c_writeb(&i2c, 0x14, 0x26);
	ssd192X_i2c_writeb(&i2c, 0x15, 0x18);
	ssd192X_i2c_writeb(&i2c, 0x16, 0x23);

	ssd192X_i2c_writeb(&i2c, 0x17, 0x1c);
	ssd192X_i2c_writeb(&i2c, 0x18, 0x0a);
	ssd192X_i2c_writeb(&i2c, 0x19, 0x38);
	ssd192X_i2c_writeb(&i2c, 0x1a, 0x12);
	ssd192X_i2c_writeb(&i2c, 0x1b, 0x37);
	
	//rgb black offset values
	ssd192X_i2c_writeb(&i2c, 0x21, 0x90);
	ssd192X_i2c_writeb(&i2c, 0x22, 0x90);
	ssd192X_i2c_writeb(&i2c, 0x23, 0x90);
	
	//set output format to crycby 4:2:2 format
	ssd192X_i2c_writeb(&i2c, 0x31, 0x29);
	ssd192X_i2c_writeb(&i2c, 0x32, 0x04);

	//set color conversion matrix
	ssd192X_i2c_writeb(&i2c, 0x34, 0x41);
	ssd192X_i2c_writeb(&i2c, 0x35, 0xc9);
	ssd192X_i2c_writeb(&i2c, 0x36, 0xf6); 
	ssd192X_i2c_writeb(&i2c, 0x37, 0x0c);
	ssd192X_i2c_writeb(&i2c, 0x38, 0x31);
	ssd192X_i2c_writeb(&i2c, 0x39, 0x04);
	ssd192X_i2c_writeb(&i2c, 0x3a, 0xf9);
	ssd192X_i2c_writeb(&i2c, 0x3b, 0xba);
	ssd192X_i2c_writeb(&i2c, 0x3c, 0x4d);
	
	//set gamma curve starting point
	ssd192X_i2c_writeb(&i2c, 0x40, 0x00);	
	ssd192X_i2c_writeb(&i2c, 0x41, 0x04);	
	ssd192X_i2c_writeb(&i2c, 0x42, 0x12);	
	ssd192X_i2c_writeb(&i2c, 0x43, 0x21);	
	ssd192X_i2c_writeb(&i2c, 0x44, 0x37);	
	ssd192X_i2c_writeb(&i2c, 0x45, 0x55);	
	ssd192X_i2c_writeb(&i2c, 0x46, 0x6b);	
	ssd192X_i2c_writeb(&i2c, 0x47, 0x7d);	
	ssd192X_i2c_writeb(&i2c, 0x48, 0xb4);	
	ssd192X_i2c_writeb(&i2c, 0x49, 0xdd);	

#if 0	
	//set gamma slope
	ssd192X_i2c_writeb(&i2c, 0x50, 0x40);	
	ssd192X_i2c_writeb(&i2c, 0x51, 0x4b);	
	ssd192X_i2c_writeb(&i2c, 0x52, 0x3c);	
	ssd192X_i2c_writeb(&i2c, 0x53, 0x2c);	
	ssd192X_i2c_writeb(&i2c, 0x54, 0x1e);	
	ssd192X_i2c_writeb(&i2c, 0x55, 0x16);	
	ssd192X_i2c_writeb(&i2c, 0x56, 0x12);	
	ssd192X_i2c_writeb(&i2c, 0x57, 0x0e);	
	ssd192X_i2c_writeb(&i2c, 0x58, 0x0a);	
	ssd192X_i2c_writeb(&i2c, 0x59, 0x09);	

	//set auto exposure mode
	ssd192X_i2c_writeb(&i2c, 0x60, 0x00);	
	ssd192X_i2c_writeb(&i2c, 0x61, 0xba);	
	
	ssd192X_i2c_writeb(&i2c, 0x63, 0x0d);	
	ssd192X_i2c_writeb(&i2c, 0x64, 0xbb);	
	ssd192X_i2c_writeb(&i2c, 0x65, 0xa0);	
	ssd192X_i2c_writeb(&i2c, 0x66, 0x80);	
	ssd192X_i2c_writeb(&i2c, 0x67, 0xf6);	

	ssd192X_i2c_writeb(&i2c, 0x6a, 0x0d);	
	ssd192X_i2c_writeb(&i2c, 0x6b, 0xbb);	
	ssd192X_i2c_writeb(&i2c, 0x6c, 0xa0);	
	ssd192X_i2c_writeb(&i2c, 0x6d, 0x0a);	
	ssd192X_i2c_writeb(&i2c, 0x6e, 0xfc);	
	ssd192X_i2c_writeb(&i2c, 0x6f, 0x80);	
	
	ssd192X_i2c_writeb(&i2c, 0x60, 0xb9);	

	//set auto white balance fine tuning
	ssd192X_i2c_writeb(&i2c, 0x76, 0x20);	
	ssd192X_i2c_writeb(&i2c, 0x77, 0x75);	

	//anti banding settings
	ssd192X_i2c_writeb(&i2c, 0x80, 0x0a);	
	ssd192X_i2c_writeb(&i2c, 0x81, 0x24);	
	
	ssd192X_i2c_writeb(&i2c, 0x8a, 0xe9);	
	ssd192X_i2c_writeb(&i2c, 0x8b, 0x28);	
	ssd192X_i2c_writeb(&i2c, 0x8c, 0x02);	
	
	//dark pixel concealment
	ssd192X_i2c_writeb(&i2c, 0x90, 0x01);	
	ssd192X_i2c_writeb(&i2c, 0x91, 0x0a);	
	ssd192X_i2c_writeb(&i2c, 0x92, 0x4c);	
	ssd192X_i2c_writeb(&i2c, 0x93, 0xb8);
#endif	
}

void cam_hw_still(void)
{
	I2C i2c;
	
	i2c.deviceID=I2C_DEVICE_ID;
	i2c.bitRate=1;
	ssd192X_i2c_init(&i2c);

	ssd192X_i2c_writew(&i2c, 0x0e, CAM_WIDTH);
	ssd192X_i2c_writew(&i2c, 0x0c, CAM_HEIGHT);

	//set window start position and size
	ssd192X_i2c_writew(&i2c, 0x08, 240);
	ssd192X_i2c_writew(&i2c, 0x0a, 180);

	// bt656 / field stuff select
	SSD_REGWB(REG_DV_TV_0,0x12);
	SSD_REGWB(REG_DV_TV_1,0x00);
	SSD_REGWB(REG_DV_TV_2,0x00);
	
	SSD_REGWW(REG_DV_NFRAME_POS_0, 0x0002);
	SSD_REGWW(REG_DV_HORI_PERIOD_0, CAM_WIDTH);
	SSD_REGWB(REG_DV_FRAME_PULSE_WIDTH, 0x08);
}