vc032x.c

来自「trident tm5600的linux驱动」· C语言 代码 · 共 1,634 行 · 第 1/5 页

	{0, 0xc8, 0x7e, 0xaa},	{0, 0x79, 0x0a, 0xaa},
	{0, 0xc8, 0x80, 0xaa},	{0, 0x79, 0x0b, 0xaa},
	{0, 0xc8, 0x01, 0xaa},	{0, 0x79, 0x0c, 0xaa},
	{0, 0xc8, 0x0f, 0xaa},	{0, 0x79, 0x0d, 0xaa},
	{0, 0xc8, 0x20, 0xaa},	{0, 0x79, 0x09, 0xaa},
	{0, 0xc8, 0x80, 0xaa},	{0, 0x79, 0x02, 0xaa},
	{0, 0xc8, 0xc0, 0xaa},	{0, 0x79, 0x03, 0xaa},
	{0, 0xc8, 0x40, 0xaa},	{0, 0x79, 0x05, 0xaa},
	{0, 0xc8, 0x30, 0xaa},	{0, 0x79, 0x26, 0xaa},
	{0, 0x11, 0x40, 0xaa},	{0, 0x3a, 0x04, 0xaa},
	{0, 0x12, 0x00, 0xaa},	{0, 0x40, 0xc0, 0xaa},
	{0, 0x8c, 0x00, 0xaa},	{0, 0x17, 0x14, 0xaa},
	{0, 0x18, 0x02, 0xaa},	{0, 0x32, 0x92, 0xaa},
	{0, 0x19, 0x02, 0xaa},	{0, 0x1a, 0x7a, 0xaa},
	{0, 0x03, 0x0a, 0xaa},	{0, 0x0c, 0x00, 0xaa},
	{0, 0x3e, 0x00, 0xaa},	{0, 0x70, 0x3a, 0xaa},
	{0, 0x71, 0x35, 0xaa},	{0, 0x72, 0x11, 0xaa},
	{0, 0x73, 0xf0, 0xaa},	{0, 0xa2, 0x02, 0xaa},
	{0, 0xb1, 0x00, 0xaa},	{0, 0xb1, 0x0c, 0xaa},
	{0, 0x1e, 0x37, 0xaa},	{0, 0xaa, 0x14, 0xaa},
	{0, 0x24, 0x80, 0xaa},	{0, 0x25, 0x74, 0xaa},
	{0, 0x26, 0xd3, 0xaa},	{0, 0x0d, 0x00, 0xaa},
	{0, 0x14, 0x18, 0xaa},	{0, 0x9d, 0x99, 0xaa},
	{0, 0x9e, 0x7f, 0xaa},	{0, 0x64, 0x08, 0xaa},
	{0, 0x94, 0x07, 0xaa},	{0, 0x95, 0x06, 0xaa},
	{0, 0x66, 0x05, 0xaa},	{0, 0x41, 0x08, 0xaa},
	{0, 0x3f, 0x00, 0xaa},	{0, 0x75, 0x07, 0xaa},
	{0, 0x76, 0xe1, 0xaa},	{0, 0x4c, 0x00, 0xaa},
	{0, 0x77, 0x00, 0xaa},	{0, 0x3d, 0xc2, 0xaa},
	{0, 0x4b, 0x09, 0xaa},	{0, 0xc9, 0x60, 0xaa},
	{0, 0x41, 0x38, 0xaa},
	{0xb6, 0x00, 0x00, 0xcc},	{0xb6, 0x03, 0x01, 0xcc},
	{0xb6, 0x02, 0x40, 0xcc},
	{0xb6, 0x05, 0x00, 0xcc},	{0xb6, 0x04, 0xf0, 0xcc},
	{0xb6, 0x12, 0xf8, 0xcc},	{0xb6, 0x13, 0x21, 0xcc},
	{0xb6, 0x18, 0x00, 0xcc},	{0xb6, 0x17, 0x96, 0xcc},
	{0xb6, 0x16, 0x00, 0xcc},	{0xb6, 0x22, 0x12, 0xcc},
	{0xb6, 0x23, 0x0b, 0xcc},
	{0xbf, 0xc0, 0x39, 0xcc},/* set jpeg */
	{0xbf, 0xc1, 0x04, 0xcc},/* */
	{0xbf, 0xcc, 0x00, 0xcc},/* */
	{0xbc, 0x02, 0x18, 0xcc},	{0xbc, 0x03, 0x50, 0xcc},
	{0xbc, 0x04, 0x18, 0xcc},	{0xbc, 0x05, 0x00, 0xcc},
	{0xbc, 0x06, 0x00, 0xcc},	{0xbc, 0x08, 0x30, 0xcc},
	{0xbc, 0x09, 0x40, 0xcc},	{0xbc, 0x0a, 0x10, 0xcc},
	{0xbc, 0x0b, 0x00, 0xcc},	{0xbc, 0x0c, 0x00, 0xcc},
	{0xb3, 0x5c, 0x01, 0xcc},	{0xb3, 0x01, 0x45, 0xcc},
	{0, 0x77, 0x05, 0xaa},	{0xb6, 0x12, 0xf8, 0xcc},
	{0xb6, 0x13, 0x20, 0xcc},
	{0, 0x24, 0x6c, 0xaa},
	{0, 0x25, 0x5c, 0xaa},	{0, 0x56, 0x50, 0xaa},
	{0, 0x4f, 0xa8, 0xaa},	{0, 0x50, 0xa5, 0xaa},
	{0, 0x51, 0x02, 0xaa},	{0, 0x52, 0x22, 0xaa},
	{0, 0x53, 0x86, 0xaa},	{0, 0x54, 0xaa, 0xaa},
	{0, 0x7a, 0x19, 0xaa},	{0, 0x7b, 0x0c, 0xaa},
	{0, 0x7c, 0x18, 0xaa},	{0, 0x7d, 0x2f, 0xaa},
	{0, 0x7e, 0x54, 0xaa},	{0, 0x7f, 0x64, 0xaa},
	{0, 0x80, 0x71, 0xaa},	{0, 0x81, 0x7d, 0xaa},
	{0, 0x82, 0x88, 0xaa},	{0, 0x83, 0x91, 0xaa},
	{0, 0x84, 0x98, 0xaa},	{0, 0x85, 0xa7, 0xaa},
	{0, 0x86, 0xb4, 0xaa},	{0, 0x87, 0xcb, 0xaa},
	{0, 0x88, 0xde, 0xaa},	{0, 0x89, 0xed, 0xaa},
	{0, 0x75, 0x86, 0xaa},	{0, 0x92, 0x00, 0xaa},
	{0, 0x3b, 0, 0xbb},
	{0, 0x3b, 0x00, 0xaa},
	{0, 0x13, 0, 0xbb}, {0, 0x13, 0xe7, 0xaa},
	{0, 0x2d, 0x00, 0xaa},	{0, 0x2e, 0x00, 0xaa},
	{0, 0x04, 0x00, 0xaa},	{0, 0x10, 0x00, 0xaa},
	{0, 0x3b, 0, 0xbb},	{0, 0x3b, 0x80, 0xaa},
	{0, 0x13, 0, 0xbb},
	{0, 0x13, 0xe7, 0xaa},
	{0, 0x1e, 0x27, 0xaa},
	{0, 0x1e, 0x27, 0xaa},
	{0, 0x3b, 0xc8, 0xaa},
	{}
};
#endif

struct sensor_info {
	int sensorId;
	__u8 I2cAdd;
	__u8 IdAdd;
	__u16 VpId;
	__u8 m1;
	__u8 m2;
	__u8 op;
	};

static const struct sensor_info sensor_info_data[] = {
/*      sensorId,         I2cAdd,	IdAdd,  VpId,  m1,    m2,  op */
	{SENSOR_HV7131R,    0x80 | 0x11, 0x00, 0x0209, 0x24, 0x25, 0x01},
	{SENSOR_OV7660,     0x80 | 0x21, 0x0a, 0x7660, 0x26, 0x26, 0x05},
	{SENSOR_PO3130NC,   0x80 | 0x76, 0x00, 0x3130, 0x24, 0x25, 0x01},
	{SENSOR_MI1320,     0x80 | 0xc8, 0x00, 0x148c, 0x64, 0x65, 0x01},
	{SENSOR_OV7670,     0x80 | 0x21, 0x0a, 0x7673, 0x66, 0x67, 0x05},
	{SENSOR_MI1310_SOC, 0x80 | 0x5d, 0x00, 0x143a, 0x24, 0x25, 0x01},
};

/* read 'len' bytes in gspca_dev->usb_buf */
static void reg_r(struct gspca_dev *gspca_dev,
		  __u16 req,
		  __u16 index,
		  __u16 len)
{
	usb_control_msg(gspca_dev->dev,
			usb_rcvctrlpipe(gspca_dev->dev, 0),
			req,
			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			1,			/* value */
			index, gspca_dev->usb_buf, len,
			500);
}

static void reg_w(struct usb_device *dev,
			    __u16 req,
			    __u16 value,
			    __u16 index)
{
	usb_control_msg(dev,
			usb_sndctrlpipe(dev, 0),
			req,
			USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			value, index, NULL, 0,
			500);
}

static void read_sensor_register(struct gspca_dev *gspca_dev,
				__u16 address, __u16 *value)
{
	struct usb_device *dev = gspca_dev->dev;
	__u8 ldata, mdata, hdata;
	int retry = 50;

	*value = 0;

	reg_r(gspca_dev, 0xa1, 0xb33f, 1);
	/*PDEBUG(D_PROBE, " I2c Bus Busy Wait  0x%02X ", tmpvalue); */
	if (!(gspca_dev->usb_buf[0] & 0x02)) {
		PDEBUG(D_ERR, "I2c Bus Busy Wait %d",
			gspca_dev->usb_buf[0] & 0x02);
		return;
	}
	reg_w(dev, 0xa0, address, 0xb33a);
	reg_w(dev, 0xa0, 0x02, 0xb339);

	reg_r(gspca_dev, 0xa1, 0xb33b, 1);
	while (retry-- && gspca_dev->usb_buf[0]) {
		reg_r(gspca_dev, 0xa1, 0xb33b, 1);
/*		PDEBUG(D_PROBE, "Read again 0xb33b %d", tmpvalue); */
		msleep(1);
	}
	reg_r(gspca_dev, 0xa1, 0xb33e, 1);
	hdata = gspca_dev->usb_buf[0];
	reg_r(gspca_dev, 0xa1, 0xb33d, 1);
	mdata = gspca_dev->usb_buf[0];
	reg_r(gspca_dev, 0xa1, 0xb33c, 1);
	ldata = gspca_dev->usb_buf[0];
	PDEBUG(D_PROBE, "Read Sensor h (0x%02X) m (0x%02X) l (0x%02X)",
		hdata, mdata, ldata);
	reg_r(gspca_dev, 0xa1, 0xb334, 1);
	if (gspca_dev->usb_buf[0] == 0x02)
		*value = (ldata << 8) + mdata;
	else
		*value = ldata;
}

static int vc032x_probe_sensor(struct gspca_dev *gspca_dev)
{
	struct usb_device *dev = gspca_dev->dev;
	int i;
	__u16 value;
	const struct sensor_info *ptsensor_info;

	reg_r(gspca_dev, 0xa1, 0xbfcf, 1);
	PDEBUG(D_PROBE, "check sensor header %d", gspca_dev->usb_buf[0]);
	for (i = 0; i < ARRAY_SIZE(sensor_info_data); i++) {
		ptsensor_info = &sensor_info_data[i];
		reg_w(dev, 0xa0, 0x02, 0xb334);
		reg_w(dev, 0xa0, ptsensor_info->m1, 0xb300);
		reg_w(dev, 0xa0, ptsensor_info->m2, 0xb300);
		reg_w(dev, 0xa0, 0x01, 0xb308);
		reg_w(dev, 0xa0, 0x0c, 0xb309);
		reg_w(dev, 0xa0, ptsensor_info->I2cAdd, 0xb335);
/*		PDEBUG(D_PROBE,
			"check sensor VC032X -> %d Add -> ox%02X!",
			i, ptsensor_info->I2cAdd); */
		reg_w(dev, 0xa0, ptsensor_info->op, 0xb301);
		read_sensor_register(gspca_dev, ptsensor_info->IdAdd, &value);
		if (value == ptsensor_info->VpId) {
/*			PDEBUG(D_PROBE, "find sensor VC032X -> ox%04X!",
				ptsensor_info->VpId); */
			return ptsensor_info->sensorId;
		}
	}
	return -1;
}

static __u8 i2c_write(struct gspca_dev *gspca_dev,
			__u8 reg, const __u8 *val, __u8 size)
{
	struct usb_device *dev = gspca_dev->dev;

	if (size > 3 || size < 1)
		return -EINVAL;
	reg_r(gspca_dev, 0xa1, 0xb33f, 1);
	reg_w(dev, 0xa0, size, 0xb334);
	reg_w(dev, 0xa0, reg, 0xb33a);
	switch (size) {
	case 1:
		reg_w(dev, 0xa0, val[0], 0xb336);
		break;
	case 2:
		reg_w(dev, 0xa0, val[0], 0xb336);
		reg_w(dev, 0xa0, val[1], 0xb337);
		break;
	case 3:
		reg_w(dev, 0xa0, val[0], 0xb336);
		reg_w(dev, 0xa0, val[1], 0xb337);
		reg_w(dev, 0xa0, val[2], 0xb338);
		break;
	default:
		reg_w(dev, 0xa0, 0x01, 0xb334);
		return -EINVAL;
	}
	reg_w(dev, 0xa0, 0x01, 0xb339);
	reg_r(gspca_dev, 0xa1, 0xb33b, 1);
	return gspca_dev->usb_buf[0] == 0;
}

static void put_tab_to_reg(struct gspca_dev *gspca_dev,
			const __u8 *tab, __u8 tabsize, __u16 addr)
{
	int j;
	__u16 ad = addr;

	for (j = 0; j < tabsize; j++)
		reg_w(gspca_dev->dev, 0xa0, tab[j], ad++);
}

static void usb_exchange(struct gspca_dev *gspca_dev,
			const __u8 data[][4])
{
	struct usb_device *dev = gspca_dev->dev;
	int i = 0;

	for (;;) {
		switch (data[i][3]) {
		default:
			return;
		case 0xcc:			/* normal write */
			reg_w(dev, 0xa0, data[i][2],
					((data[i][0])<<8) | data[i][1]);
			break;
		case 0xaa:			/* i2c op */
			i2c_write(gspca_dev, data[i][1], &data[i][2], 1);
			break;
		case 0xbb:			/* i2c op */
			i2c_write(gspca_dev, data[i][0], &data[i][1], 2);
			break;
		case 0xdd:
			msleep(data[i][2] + 10);
			break;
		}
		i++;
	}
	/*not reached*/
}

/*
 "GammaT"=hex:04,17,31,4f,6a,83,99,ad,bf,ce,da,e5,ee,f5,fb,ff,ff
 "MatrixT"=hex:60,f9,e5,e7,50,05,f3,e6,66
 */

static void vc0321_reset(struct gspca_dev *gspca_dev)
{
	reg_w(gspca_dev->dev, 0xa0, 0x00, 0xb04d);
	reg_w(gspca_dev->dev, 0xa0, 0x01, 0xb301);
	msleep(100);
	reg_w(gspca_dev->dev, 0xa0, 0x01, 0xb003);
	msleep(100);
}

/* this function is called at probe time */
static int sd_config(struct gspca_dev *gspca_dev,
			const struct usb_device_id *id)
{
	struct sd *sd = (struct sd *) gspca_dev;
	struct usb_device *dev = gspca_dev->dev;
	struct cam *cam;
	int sensor;

	cam = &gspca_dev->cam;
	cam->epaddr = 0x02;
	sd->bridge = id->driver_info;
	if (sd->bridge == BRIDGE_VC0321) {
		cam->cam_mode = vc0321_mode;
		cam->nmodes = ARRAY_SIZE(vc0321_mode);
	} else {
		cam->cam_mode = vc0323_mode;
		cam->nmodes = ARRAY_SIZE(vc0323_mode);
	}

	vc0321_reset(gspca_dev);
	sensor = vc032x_probe_sensor(gspca_dev);
	switch (sensor) {
	case -1:
		PDEBUG(D_PROBE, "Unknown sensor...");
		return -EINVAL;
	case SENSOR_HV7131R:
		PDEBUG(D_PROBE, "Find Sensor HV7131R");
		sd->sensor = SENSOR_HV7131R;
		break;
	case SENSOR_MI1310_SOC:
		PDEBUG(D_PROBE, "Find Sensor MI1310_SOC");
		sd->sensor = SENSOR_MI1310_SOC;
		break;
	case SENSOR_MI1320:
		PDEBUG(D_PROBE, "Find Sensor MI1320");
		sd->sensor = SENSOR_MI1320;
		break;
	case SENSOR_OV7660:
		PDEBUG(D_PROBE, "Find Sensor OV7660");
		sd->sensor = SENSOR_OV7660;
		break;
	case SENSOR_OV7670: