sn9cxxx.h

通用的摄像头驱动源代码

	 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14,
	 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14,
	 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14, 0x14 
};
#endif

static int sn9c102p_i2cwrite (struct usb_spca50x *spca50x,__u8 *buffer,__u16 length)
{
	 struct usb_device *dev = spca50x->dev;
	__u8 mode[] = {0x81,0x11,0,0,0,0,0,0x10};
	/* is i2c ready */
	__u8 i2cbase = spca50x->i2c_base;
	__u8 i2cCtrl = spca50x->i2c_ctrl_reg;
	mode[0] =i2cCtrl;
	mode[1] = i2cbase;
	if (length > 5 || !buffer) return -1;
	mode[0] = mode[0] |length << 4 ;
	memcpy(&mode[2],buffer,length);
	sonixRegWrite(dev,0x08,0x08,0x0000,mode,8);	
	return 0;
}
static void sn9c102p_i2cwritebuf (struct usb_device *dev,__u8 *buffer )
{
	sonixRegWrite(dev,0x08,0x08,0x0000,buffer,8);	
}
 static int sn9c102p_i2cread (struct usb_spca50x *spca50x,__u8 reg,__u8 *buffer,__u16 length)
{
	 struct usb_device *dev = spca50x->dev;
	 __u8 i2cbase = spca50x->i2c_base;
	 __u8 i2cCtrl = spca50x->i2c_ctrl_reg;
	__u8 mode[] = {0x91,0x11,0,0,0,0,0,0x10};
	__u8 result[] = {0,0,0,0,0};
	mode[0] =i2cCtrl | 0x10;
	mode[1] = i2cbase;
	if (length > 5 || !buffer) return -1;
	mode[2] = reg;
	sonixRegWrite(dev,0x08,0x08,0x0000,mode,8);
	wait_ms(1);
	mode[2] = 0;
	mode[0] = i2cCtrl | length << 4 | 0x02;
	sonixRegWrite(dev,0x08,0x08,0x0000,mode,8);
	wait_ms(1);
	sonixRegRead(dev,0x00,0x0a,0x0000,result,5);
	memcpy(buffer,result,length);
	return 0;
}


static int sn9cxxx_probesensor(struct usb_spca50x *spca50x)
{       struct usb_device *dev = spca50x->dev;
	int err = 0;
	__u8 reg02 = 0x66;
	/* reg val1 val2 val3 val4 */
	__u8 datasend[] = {0,0,0,0,0};
	__u8 datarecd[] = {0,0,0,0,0};
	datasend[0] = 2; //sensor wakeup
	err = sn9c102p_i2cwrite (spca50x, datasend ,2);
	//should write 0xa1 0x11 0x02 0x00 0x00 0x00 0x00 the 0x10 is add by i2cw
	wait_ms(10);
	sonixRegWrite(dev,0x08,0x02,0x0000,&reg02,1); //Gpio on
	wait_ms(10);
	err += sn9c102p_i2cread (spca50x,0, datarecd ,5); //read sensor id
	if (err) goto errors;
	if(datarecd[0] == 0x02 && datarecd[1] == 0x09 && datarecd[2] == 0x01 
		&& datarecd[3] == 0x00 && datarecd[4] == 0x00){
		PDEBUG(0,"Find Sensor sn9c102P HV7131R");
		spca50x->sensor = SENSOR_HV7131R;
		return SENSOR_HV7131R;
		}
	PDEBUG(0,"Find Sensor %d %d %d",datarecd[0],datarecd[1],datarecd[2]);
	PDEBUG(0,"Sensor sn9c102P Not found Contact [e-mail] ");	
	return -ENODEV;	
errors:	PDEBUG(0,"Sensor sn9c102P too many errors Contact [e-mail] ");
return -ENODEV;	
}

static void hv7131R_InitSensor(struct usb_spca50x *spca50x)
{
	int i = 0;
	struct usb_device *dev = spca50x->dev;
	__u8 CtrlA320[] = { 0xA1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10 }; //Mclk
	//__u8 CtrlA640[] = { 0xA1, 0x11, 0x01, 0x18, 0x00, 0x00, 0x00, 0x10 };//Mclk/2 BOUMM 
	__u8 CtrlA640[] = { 0xA1, 0x11, 0x01, 0x28, 0x00, 0x00, 0x00, 0x10 }; //Mckl/4
	while (hv7131r_sensor_init[i][0]){
	sn9c102p_i2cwritebuf (dev,hv7131r_sensor_init[i]);
	i++;
	}
	if(spca50x->mode)
	 sn9c102p_i2cwritebuf (dev,CtrlA320);
	else
	 sn9c102p_i2cwritebuf (dev,CtrlA640);	
}
static void mi0360_InitSensor(struct usb_spca50x *spca50x)
{
	int i = 0;
	struct usb_device *dev = spca50x->dev;
	
	while (mi0360_sensor_init[i][0]){
	sn9c102p_i2cwritebuf (dev,hv7131r_sensor_init[i]);
	i++;
	}	
}


 static int sn9cxxx_init(struct usb_spca50x *spca50x)
{	
	struct usb_device *dev = spca50x->dev;
	int err = 0;
	__u8 *sn9c1xx= NULL;
	__u8 regF1 = 0x01;
	__u8 regGpio[] = {0x29,0x74};
	__u8 data = 0x00;
	/* setup a selector by customid */
	switch(spca50x->sensor){
	case SENSOR_HV7131R:
	sn9c1xx= sn_hv7131;
	break;
	case SENSOR_MI0360:
	sn9c1xx=sn_mi0360;
	break;
	}
	if (sn9c1xx == NULL) return -ENODEV;
	sonixRegWrite(dev,0x08,0xf1,0x0000,&regF1,1);
	sonixRegRead(dev,0x00,0x00,0x0000,&regF1,1);
	sonixRegWrite(dev,0x08,0xf1,0x0000,&regF1,1);
	sonixRegRead(dev,0x00,0x00,0x0000,&regF1,1);
	switch (spca50x->customid) {
	case SN9C102P:
		if (regF1 != 0x11)
			return -ENODEV;
		sonixRegWrite(dev,0x08,0x02,0x0000,&regGpio[1],1);
	case SN9C105:
		if (regF1 != 0x11)
			return -ENODEV;
		sonixRegWrite(dev,0x08,0x02,0x0000,regGpio,2);
	break;
	case SN9C120:
		if (regF1 != 0x12)
			return -ENODEV;
			regGpio[1] = 0x70;
		sonixRegWrite(dev,0x08,0x02,0x0000,regGpio,2);	
	break;
	}
	
	
	
	regF1 = 0x01;
	sonixRegWrite(dev,0x08,0xf1,0x0000,&regF1,1);
	
	regF1 = 0x00;
	sonixRegWrite(dev,0x08,0xf1,0x0000,&regF1,1);
	
	sonixRegWrite(dev,0x08,0x01,0x0000,&sn9c1xx[1],1);
	
	// configure gpio 
	sonixRegWrite(dev,0x08,0x01,0x0000,&sn9c1xx[1],2);
	
	sonixRegWrite(dev,0x08,0x08,0x0000,&sn9c1xx[8],2);
	
	sonixRegWrite(dev,0x08,0x017,0x0000,&sn9c1xx[0x17],3);
	
	sonixRegWrite(dev,0x08,0x9a,0x0000,reg9a,6);
	
	data= 0x60;
	sonixRegWrite(dev,0x08,0xD4,0x0000,&data,1);
	
	sonixRegWrite(dev,0x08,0x03,0x0000,&sn9c1xx[3],0x0f);
	
	data= 0x43;
	sonixRegWrite(dev,0x08,0x01,0x0000,&data,1);
	
	data= 0x61;
	sonixRegWrite(dev,0x08,0x17,0x0000,&data,1);
	
	data= 0x42;
	sonixRegWrite(dev,0x08,0x01,0x0000,&data,1);
	switch(spca50x->sensor){
	case SENSOR_HV7131R:
	// probe sensor
	if((err = sn9cxxx_probesensor(spca50x)) < 0)
		return -ENODEV;			
		break;
	}
	
		
return 0;
}
static void sn9cxxx_stop(struct usb_spca50x *spca50x)
{ 
	struct usb_device *dev = spca50x->dev;
	__u8 stophv7131[] = { 0xA1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10 };
	__u8 stopmi0360[] = { 0xB1, 0x5D, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10 };
	__u8 regF1 = 0x01;
	__u8 data = 0x0b;
	__u8 *sn9c1xx=NULL;
	switch(spca50x->sensor){
	case SENSOR_HV7131R:
	sn9c1xx= sn_hv7131;
	data = 0x2b;
	sn9c102p_i2cwritebuf (dev,stophv7131);
	break;
	case SENSOR_MI0360:
	sn9c1xx=sn_mi0360;
	data = 0x29;
	sn9c102p_i2cwritebuf (dev,stopmi0360);
	break;
	}
	if (sn9c1xx == NULL) return;
	sonixRegWrite(dev,0x08,0x01,0x0000,&sn9c1xx[1],1);
	sonixRegWrite(dev,0x08,0x17,0x0000,&sn9c1xx[0x17],1);
	sonixRegWrite(dev,0x08,0x01,0x0000,&sn9c1xx[1],1);
	sonixRegWrite(dev,0x08,0x01,0x0000,&data,1);
	sonixRegWrite(dev,0x08,0xf1,0x0000,&regF1,1);
}
static void sn9cxxx_start(struct usb_spca50x *spca50x)
{	
	struct usb_device *dev = spca50x->dev;
	int i;
	__u8 DC29[]={0x6a, 0x50, 0x00, 0x00, 0x50, 0x3c};
	__u8 C0[]={0x2d, 0x2d, 0x3a, 0x05, 0x04, 0x3f};
	__u8 CA[]={0x28, 0xd8, 0x14, 0xec };
	//HV7131 __u8 CE[]={0x28, 0xec, 0x1e, 0xec };
	__u8 CE[]={0x32, 0xdd, 0x2d, 0xdd };//MI0360
	__u8 gain[] = { 0xB1,0x5D,0x35,0x00,0x67,0x00,0x00,0x10 }; //gain 
	__u8 doit[] = { 0xB1,0x5D,0x07,0x00,0x03,0x00,0x00,0x10 }; //update sensor
	__u8 sensorgo[] ={ 0xB1,0x5D,0x07,0x00,0x02,0x00,0x00,0x10 }; //sensor on
	//__u8 expo[]={ 0xB1,0x5D,0x09,0x06,0x35,0x00,0x00,0x10 };// exposure 0x0635 -> 4 fp/s
	__u8 data = 0;
	__u8 regF1 = 0x00;
	int err = 0;
	__u8 *sn9c1xx = NULL;
	switch(spca50x->sensor){
	case SENSOR_HV7131R:
	sn9c1xx= sn_hv7131;
	break;
	case SENSOR_MI0360:
	sn9c1xx=sn_mi0360;
	break;
	}
	if (sn9c1xx == NULL) return;
	sonixRegWrite(dev,0x08,0xf1,0x0000,&regF1,1);
	sonixRegWrite(dev,0x08,0x01,0x0000,&sn9c1xx[1],1);
	sonixRegWrite(dev,0x08,0x01,0x0000,&sn9c1xx[1],2);
	sonixRegWrite(dev,0x08,0x08,0x0000,&sn9c1xx[8],2);
	sonixRegWrite(dev,0x08,0x17,0x0000,&sn9c1xx[0x17],3);
	
	sonixRegWrite(dev,0x08,0x9a,0x0000,reg9a,6);
	data= 0x60;
	sonixRegWrite(dev,0x08,0xD4,0x0000,&data,1);
	
	sonixRegWrite(dev,0x08,0x03,0x0000,&sn9c1xx[3],0x0f);
	data= 0x43;
	sonixRegWrite(dev,0x08,0x01,0x0000,&data,1);
	data= 0x61;
	sonixRegWrite(dev,0x08,0x17,0x0000,&data,1);
	data= 0x42;
	sonixRegWrite(dev,0x08,0x01,0x0000,&data,1);
	
	switch(spca50x->sensor){
	case SENSOR_HV7131R:
		if((err = sn9cxxx_probesensor(spca50x)) < 0)
			return ;	
		break;
	}
		
	sonixRegWrite(dev,0x08,0x15,0x0000,&sn9c1xx[0x15],1);
	sonixRegWrite(dev,0x08,0x16,0x0000,&sn9c1xx[0x16],1);
	sonixRegWrite(dev,0x08,0x12,0x0000,&sn9c1xx[0x12],1);
	sonixRegWrite(dev,0x08,0x13,0x0000,&sn9c1xx[0x13],1);
	sonixRegWrite(dev,0x08,0x18,0x0000,&sn9c1xx[0x18],1);
	sonixRegWrite(dev,0x08,0xd2,0x0000,&DC29[0],1);
	sonixRegWrite(dev,0x08,0xd3,0x0000,&DC29[1],1);
	sonixRegWrite(dev,0x08,0xc6,0x0000,&DC29[2],1);
	sonixRegWrite(dev,0x08,0xc7,0x0000,&DC29[3],1);
	sonixRegWrite(dev,0x08,0xc8,0x0000,&DC29[4],1);
	sonixRegWrite(dev,0x08,0xc9,0x0000,&DC29[5],1);
	sonixRegWrite(dev,0x08,0x18,0x0000,&sn9c1xx[0x18],1);
	data = 0x60;
	sonixRegWrite(dev,0x08,0x17,0x0000,&data,1);
	sonixRegWrite(dev,0x08,0x05,0x0000,&sn9c1xx[5],1);
	sonixRegWrite(dev,0x08,0x07,0x0000,&sn9c1xx[7],1);
	sonixRegWrite(dev,0x08,0x06,0x0000,&sn9c1xx[6],1);
	sonixRegWrite(dev,0x08,0x14,0x0000,&sn9c1xx[0x14],1);
	sonixRegWrite(dev,0x08,0x20,0x0000,regsn20,0x11);
	for (i=0; i<8;i++)
		sonixRegWrite(dev,0x08,0x84,0x0000,reg84,0x15);
	data = 0x08;
	sonixRegWrite(dev,0x08,0x9a,0x0000,&data,1);
	data = 0x59;
	sonixRegWrite(dev,0x08,0x99,0x0000,&data,1);
	
	switch(spca50x->sensor){