usb/gspca/vc032x.c

22 	struct gspca_dev gspca_dev;	/* !! must be the first item */
2889 /* read 'len' bytes in gspca_dev->usb_buf */
2890 static void reg_r_i(struct gspca_dev *gspca_dev,
2897 	if (gspca_dev->usb_err < 0)
2899 	ret = usb_control_msg(gspca_dev->dev,
2900 			usb_rcvctrlpipe(gspca_dev->dev, 0),
2904 			index, gspca_dev->usb_buf, len,
2908 		gspca_dev->usb_err = ret;
2913 		memset(gspca_dev->usb_buf, 0, USB_BUF_SZ);
2916 static void reg_r(struct gspca_dev *gspca_dev,
2921 	reg_r_i(gspca_dev, req, index, len);
2922 	if (gspca_dev->usb_err < 0)
2925 		gspca_dbg(gspca_dev, D_USBI, "GET %02x 0001 %04x %02x\n",
2927 			  gspca_dev->usb_buf[0]);
2929 		gspca_dbg(gspca_dev, D_USBI, "GET %02x 0001 %04x %*ph\n",
2930 			  req, index, 3, gspca_dev->usb_buf);
2933 static void reg_w_i(struct gspca_dev *gspca_dev,
2940 	if (gspca_dev->usb_err < 0)
2942 	ret = usb_control_msg(gspca_dev->dev,
2943 			usb_sndctrlpipe(gspca_dev->dev, 0),
2950 		gspca_dev->usb_err = ret;
2953 static void reg_w(struct gspca_dev *gspca_dev,
2958 	if (gspca_dev->usb_err < 0)
2960 	gspca_dbg(gspca_dev, D_USBO, "SET %02x %04x %04x\n", req, value, index);
2961 	reg_w_i(gspca_dev, req, value, index);
2964 static u16 read_sensor_register(struct gspca_dev *gspca_dev,
2970 	reg_r(gspca_dev, 0xa1, 0xb33f, 1);
2971 	if (!(gspca_dev->usb_buf[0] & 0x02)) {
2972 		pr_err("I2c Bus Busy Wait %02x\n", gspca_dev->usb_buf[0]);
2975 	reg_w(gspca_dev, 0xa0, address, 0xb33a);
2976 	reg_w(gspca_dev, 0xa0, 0x02, 0xb339);
2979 		reg_r(gspca_dev, 0xa1, 0xb33b, 1);
2980 		if (gspca_dev->usb_buf[0] == 0x00)
2985 	reg_r(gspca_dev, 0xa1, 0xb33e, 1);
2986 	ldata = gspca_dev->usb_buf[0];
2987 	reg_r(gspca_dev, 0xa1, 0xb33d, 1);
2988 	mdata = gspca_dev->usb_buf[0];
2989 	reg_r(gspca_dev, 0xa1, 0xb33c, 1);
2990 	hdata = gspca_dev->usb_buf[0];
2992 		gspca_dbg(gspca_dev, D_PROBE, "Read Sensor %02x%02x %02x\n",
2994 	reg_r(gspca_dev, 0xa1, 0xb334, 1);
2995 	if (gspca_dev->usb_buf[0] == 0x02)
3000 static int vc032x_probe_sensor(struct gspca_dev *gspca_dev)
3002 	struct sd *sd = (struct sd *) gspca_dev;
3009 		reg_w(gspca_dev, 0xa0, 0x01, 0xb301);
3010 		reg_w(gspca_dev, 0x89, 0xf0ff, 0xffff);
3014 	reg_r(gspca_dev, 0xa1, 0xbfcf, 1);
3015 	gspca_dbg(gspca_dev, D_PROBE, "vc032%d check sensor header %02x\n",
3016 		  sd->bridge == BRIDGE_VC0321 ? 1 : 3, gspca_dev->usb_buf[0]);
3025 		reg_w(gspca_dev, 0xa0, 0x02, 0xb334);
3026 		reg_w(gspca_dev, 0xa0, ptsensor_info->m1, 0xb300);
3027 		reg_w(gspca_dev, 0xa0, ptsensor_info->m2, 0xb300);
3028 		reg_w(gspca_dev, 0xa0, 0x01, 0xb308);
3029 		reg_w(gspca_dev, 0xa0, 0x0c, 0xb309);
3030 		reg_w(gspca_dev, 0xa0, ptsensor_info->I2cAdd, 0xb335);
3031 		reg_w(gspca_dev, 0xa0, ptsensor_info->op, 0xb301);
3032 		value = read_sensor_register(gspca_dev, ptsensor_info->IdAdd);
3034 			value = read_sensor_register(gspca_dev, 0x83);
3036 			gspca_dbg(gspca_dev, D_PROBE, "Sensor ID %04x (%d)\n",
3055 static void i2c_write(struct gspca_dev *gspca_dev,
3061 	if (gspca_dev->usb_err < 0)
3064 		gspca_dbg(gspca_dev, D_USBO, "i2c_w %02x %02x\n", reg, *val);
3066 		gspca_dbg(gspca_dev, D_USBO, "i2c_w %02x %02x%02x\n",
3068 	reg_r_i(gspca_dev, 0xa1, 0xb33f, 1);
3069 /*fixme:should check if (!(gspca_dev->usb_buf[0] & 0x02)) error*/
3070 	reg_w_i(gspca_dev, 0xa0, size, 0xb334);
3071 	reg_w_i(gspca_dev, 0xa0, reg, 0xb33a);
3072 	reg_w_i(gspca_dev, 0xa0, val[0], 0xb336);
3074 		reg_w_i(gspca_dev, 0xa0, val[1], 0xb337);
3075 	reg_w_i(gspca_dev, 0xa0, 0x01, 0xb339);
3078 		reg_r_i(gspca_dev, 0xa1, 0xb33b, 1);
3079 		if (gspca_dev->usb_buf[0] == 0)
3087 static void put_tab_to_reg(struct gspca_dev *gspca_dev,
3094 		reg_w(gspca_dev, 0xa0, tab[j], ad++);
3097 static void usb_exchange(struct gspca_dev *gspca_dev,
3107 			reg_w(gspca_dev, 0xa0, data[i][2],
3111 			i2c_write(gspca_dev, data[i][1], &data[i][2], 1);
3114 			i2c_write(gspca_dev, data[i][0], &data[i][1], 2);
3127 static int sd_config(struct gspca_dev *gspca_dev,
3130 	struct sd *sd = (struct sd *) gspca_dev;
3143 static int sd_init(struct gspca_dev *gspca_dev)
3145 	struct sd *sd = (struct sd *) gspca_dev;
3163 		sensor = vc032x_probe_sensor(gspca_dev);
3172 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor HV7131R\n");
3175 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor MI0360\n");
3179 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor MI1310_SOC\n");
3182 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor MI1320\n");
3185 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor MI1320_SOC\n");
3188 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor OV7660\n");
3191 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor OV7670\n");
3194 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor PO1200\n");
3197 		gspca_dbg(gspca_dev, D_PROBE, "Find Sensor PO3130NC\n");
3200 		gspca_dbg(gspca_dev, D_PROBE, "Sensor POxxxx\n");
3205 	cam = &gspca_dev->cam;
3239 		reg_r(gspca_dev, 0x8a, 0, 3);
3240 		reg_w(gspca_dev, 0x87, 0x00, 0x0f0f);
3241 		reg_r(gspca_dev, 0x8b, 0, 3);
3242 		reg_w(gspca_dev, 0x88, 0x00, 0x0202);
3244 			reg_r(gspca_dev, 0xa1, 0xb300, 1);
3245 			if (gspca_dev->usb_buf[0] != 0) {
3246 				reg_w(gspca_dev, 0xa0, 0x26, 0xb300);
3247 				reg_w(gspca_dev, 0xa0, 0x04, 0xb300);
3249 			reg_w(gspca_dev, 0xa0, 0x00, 0xb300);
3252 	return gspca_dev->usb_err;
3255 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
3264 	i2c_write(gspca_dev, 0x98, &data, 1);
3267 static void setcontrast(struct gspca_dev *gspca_dev, u8 val)
3269 	i2c_write(gspca_dev, 0x99, &val, 1);
3272 static void setcolors(struct gspca_dev *gspca_dev, u8 val)
3277 	i2c_write(gspca_dev, 0x94, &data, 1);
3278 	i2c_write(gspca_dev, 0x95, &val, 1);
3281 static void sethvflip(struct gspca_dev *gspca_dev, bool hflip, bool vflip)
3283 	struct sd *sd = (struct sd *) gspca_dev;
3295 		i2c_write(gspca_dev, 0xf0, data, 2);
3299 		i2c_write(gspca_dev, 0x20, data, 2);
3306 		i2c_write(gspca_dev, OV7660_REG_MVFP, data, 1);
3310 		i2c_write(gspca_dev, 0x03, data, 1);
3314 		i2c_write(gspca_dev, 0x1e, data, 1);
3319 static void setlightfreq(struct gspca_dev *gspca_dev, s32 val)
3321 	struct sd *sd = (struct sd *) gspca_dev;
3327 	usb_exchange(gspca_dev, ov7660_freq_tb[val]);
3330 static void setsharpness(struct gspca_dev *gspca_dev, s32 val)
3332 	struct sd *sd = (struct sd *) gspca_dev;
3338 		i2c_write(gspca_dev, 0x03, &data, 1);
3343 		i2c_write(gspca_dev, 0x61, &data, 1);
3350 		i2c_write(gspca_dev, 0x59, &data, 1);
3354 static void setgain(struct gspca_dev *gspca_dev, u8 val)
3356 	i2c_write(gspca_dev, 0x15, &val, 1);
3359 static void setexposure(struct gspca_dev *gspca_dev, s32 val)
3364 	i2c_write(gspca_dev, 0x1a, &data, 1);
3366 	i2c_write(gspca_dev, 0x1b, &data, 1);
3369 static void setautogain(struct gspca_dev *gspca_dev, s32 val)
3373 	i2c_write(gspca_dev, 0xd1, &data[val], 1);
3376 static void setgamma(struct gspca_dev *gspca_dev)
3379 	usb_exchange(gspca_dev, poxxxx_gamma);
3382 static void setbacklight(struct gspca_dev *gspca_dev, s32 val)
3388 	i2c_write(gspca_dev, 0xaa, &data, 1);
3391 	i2c_write(gspca_dev, 0xc4, &data, 1);
3393 	i2c_write(gspca_dev, 0xc5, &data, 1);
3396 	i2c_write(gspca_dev, 0xc6, &data, 1);
3398 	i2c_write(gspca_dev, 0xc7, &data, 1);
3401 	i2c_write(gspca_dev, 0xc8, &data, 1);
3403 	i2c_write(gspca_dev, 0xc9, &data, 1);
3406 	i2c_write(gspca_dev, 0xca, &data, 1);
3408 	i2c_write(gspca_dev, 0xcb, &data, 1);
3411 static void setwb(struct gspca_dev *gspca_dev)
3416 	i2c_write(gspca_dev, 0x16, &data[0], 1);
3417 	i2c_write(gspca_dev, 0x18, &data[1], 1);
3420 static int sd_start(struct gspca_dev *gspca_dev)
3422 	struct sd *sd = (struct sd *) gspca_dev;
3435 		reg_w(gspca_dev, 0x89, 0xf0ff, 0xffff);
3436 		reg_w(gspca_dev, 0xa9, 0x8348, 0x000e);
3437 		reg_w(gspca_dev, 0xa9, 0x0000, 0x001a);
3440 	/* Assume start use the good resolution from gspca_dev->mode */
3442 		reg_w(gspca_dev, 0xa0, 0xff, 0xbfec);
3443 		reg_w(gspca_dev, 0xa0, 0xff, 0xbfed);
3444 		reg_w(gspca_dev, 0xa0, 0xff, 0xbfee);
3445 		reg_w(gspca_dev, 0xa0, 0xff, 0xbfef);
3448 		if (gspca_dev->cam.cam_mode[gspca_dev->curr_mode].pixelformat
3455 	mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
3519 		usb_exchange(gspca_dev, init);
3529 		usb_exchange(gspca_dev, poxxxx_init_common);
3530 		setgamma(gspca_dev);
3531 		usb_exchange(gspca_dev, poxxxx_init_start_3);
3536 		usb_exchange(gspca_dev, init);
3537 		reg_r(gspca_dev, 0x8c, 0x0000, 3);
3538 		reg_w(gspca_dev, 0xa0,
3539 				gspca_dev->usb_buf[2] & 1 ? 0 : 1,
3546 	usb_exchange(gspca_dev, init);
3548 		put_tab_to_reg(gspca_dev, GammaT, 17, 0xb84a);
3549 		put_tab_to_reg(gspca_dev, GammaT, 17, 0xb85b);
3550 		put_tab_to_reg(gspca_dev, GammaT, 17, 0xb86c);
3551 		put_tab_to_reg(gspca_dev, MatrixT, 9, 0xb82c);
3556 			reg_w(gspca_dev, 0x89, 0x0400, 0x1415);
3559 			reg_w(gspca_dev, 0x89, 0x058c, 0x0000);
3566 		reg_w(gspca_dev, 0x87, 0xffff, 0xffff);
3567 		reg_w(gspca_dev, 0x88, 0xff00, 0xf0f1);
3568 		reg_w(gspca_dev, 0xa0, 0x0000, 0xbfff);
3571 		usb_exchange(gspca_dev, poxxxx_init_end_2);
3572 		setwb(gspca_dev);
3574 		reg_w(gspca_dev, 0x89, 0xffff, 0xfdff);
3577 	return gspca_dev->usb_err;
3580 static void sd_stopN(struct gspca_dev *gspca_dev)
3582 	struct sd *sd = (struct sd *) gspca_dev;
3586 		reg_w(gspca_dev, 0x89, 0x058c, 0x00ff);
3592 			reg_w(gspca_dev, 0x89, 0xffff, 0xffff);
3595 	reg_w(gspca_dev, 0xa0, 0x01, 0xb301);
3596 	reg_w(gspca_dev, 0xa0, 0x09, 0xb003);
3600 static void sd_stop0(struct gspca_dev *gspca_dev)
3602 	struct sd *sd = (struct sd *) gspca_dev;
3604 	if (!gspca_dev->present)
3608 		reg_w(gspca_dev, 0x89, 0x058c, 0x00ff);
3610 		reg_w(gspca_dev, 0x89, 0xffff, 0xffff);
3613 		reg_w(gspca_dev, 0xa0, 0x26, 0xb300);
3614 		reg_w(gspca_dev, 0xa0, 0x04, 0xb300);
3615 		reg_w(gspca_dev, 0xa0, 0x00, 0xb300);
3619 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
3623 	struct sd *sd = (struct sd *) gspca_dev;
3626 		gspca_dbg(gspca_dev, D_PACK,
3628 		gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
3631 		gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
3640 		l = gspca_dev->image_len;
3641 		size = gspca_dev->pixfmt.sizeimage;
3645 	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
3650 	struct gspca_dev *gspca_dev =
3651 		container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
3652 	struct sd *sd = (struct sd *)gspca_dev;
3654 	gspca_dev->usb_err = 0;
3656 	if (!gspca_dev->streaming && ctrl->id != V4L2_CID_POWER_LINE_FREQUENCY)
3661 		setbrightness(gspca_dev, ctrl->val);
3664 		setcontrast(gspca_dev, ctrl->val);
3667 		setcolors(gspca_dev, ctrl->val);
3670 		sethvflip(gspca_dev, sd->hflip->val, sd->vflip->val);
3673 		setsharpness(gspca_dev, ctrl->val);
3676 		setautogain(gspca_dev, ctrl->val);
3679 		setgain(gspca_dev, ctrl->val);
3682 		setexposure(gspca_dev, ctrl->val);
3685 		setbacklight(gspca_dev, ctrl->val);
3688 		setlightfreq(gspca_dev, ctrl->val);
3691 	return gspca_dev->usb_err;
3698 static int sd_init_controls(struct gspca_dev *gspca_dev)
3700 	struct sd *sd = (struct sd *)gspca_dev;
3701 	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
3737 	gspca_dev->vdev.ctrl_handler = hdl;