61 	struct gspca_dev gspca_dev;	/* !! must be the first item */  member
94 static int sd_start(struct gspca_dev *gspca_dev);
95 static void sd_stopN(struct gspca_dev *gspca_dev);
610 static void ov534_reg_write(struct gspca_dev *gspca_dev, u16 reg, u8 val)  in ov534_reg_write()  argument
612 	struct usb_device *udev = gspca_dev->dev;  in ov534_reg_write()
615 	if (gspca_dev->usb_err < 0)  in ov534_reg_write()
619 	gspca_dev->usb_buf[0] = val;  in ov534_reg_write()
624 			      0x00, reg, gspca_dev->usb_buf, 1, CTRL_TIMEOUT);  in ov534_reg_write()
627 		gspca_dev->usb_err = ret;  in ov534_reg_write()
631 static u8 ov534_reg_read(struct gspca_dev *gspca_dev, u16 reg)  in ov534_reg_read()  argument
633 	struct usb_device *udev = gspca_dev->dev;  in ov534_reg_read()
636 	if (gspca_dev->usb_err < 0)  in ov534_reg_read()
642 			      0x00, reg, gspca_dev->usb_buf, 1, CTRL_TIMEOUT);  in ov534_reg_read()
643 	PDEBUG(D_USBI, "GET 01 0000 %04x %02x", reg, gspca_dev->usb_buf[0]);  in ov534_reg_read()
646 		gspca_dev->usb_err = ret;  in ov534_reg_read()
648 	return gspca_dev->usb_buf[0];  in ov534_reg_read()
653 static void ov534_set_led(struct gspca_dev *gspca_dev, int status)  in ov534_set_led()  argument
659 	data = ov534_reg_read(gspca_dev, 0x21);  in ov534_set_led()
661 	ov534_reg_write(gspca_dev, 0x21, data);  in ov534_set_led()
663 	data = ov534_reg_read(gspca_dev, 0x23);  in ov534_set_led()
669 	ov534_reg_write(gspca_dev, 0x23, data);  in ov534_set_led()
672 		data = ov534_reg_read(gspca_dev, 0x21);  in ov534_set_led()
674 		ov534_reg_write(gspca_dev, 0x21, data);  in ov534_set_led()
678 static int sccb_check_status(struct gspca_dev *gspca_dev)  in sccb_check_status()  argument
685 		data = ov534_reg_read(gspca_dev, OV534_REG_STATUS);  in sccb_check_status()
702 static void sccb_reg_write(struct gspca_dev *gspca_dev, u8 reg, u8 val)  in sccb_reg_write()  argument
705 	ov534_reg_write(gspca_dev, OV534_REG_SUBADDR, reg);  in sccb_reg_write()
706 	ov534_reg_write(gspca_dev, OV534_REG_WRITE, val);  in sccb_reg_write()
707 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_WRITE_3);  in sccb_reg_write()
709 	if (!sccb_check_status(gspca_dev)) {  in sccb_reg_write()
711 		gspca_dev->usb_err = -EIO;  in sccb_reg_write()
715 static u8 sccb_reg_read(struct gspca_dev *gspca_dev, u16 reg)  in sccb_reg_read()  argument
717 	ov534_reg_write(gspca_dev, OV534_REG_SUBADDR, reg);  in sccb_reg_read()
718 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_WRITE_2);  in sccb_reg_read()
719 	if (!sccb_check_status(gspca_dev))  in sccb_reg_read()
722 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_READ_2);  in sccb_reg_read()
723 	if (!sccb_check_status(gspca_dev))  in sccb_reg_read()
726 	return ov534_reg_read(gspca_dev, OV534_REG_READ);  in sccb_reg_read()
730 static void reg_w_array(struct gspca_dev *gspca_dev,  in reg_w_array()  argument
734 		ov534_reg_write(gspca_dev, (*data)[0], (*data)[1]);  in reg_w_array()
740 static void sccb_w_array(struct gspca_dev *gspca_dev,  in sccb_w_array()  argument
745 			sccb_reg_write(gspca_dev, (*data)[0], (*data)[1]);  in sccb_w_array()
747 			sccb_reg_read(gspca_dev, (*data)[1]);  in sccb_w_array()
748 			sccb_reg_write(gspca_dev, 0xff, 0x00);  in sccb_w_array()
755 static void set_frame_rate(struct gspca_dev *gspca_dev)  in set_frame_rate()  argument
757 	struct sd *sd = (struct sd *) gspca_dev;  in set_frame_rate()
789 	if (gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv == 0) {  in set_frame_rate()
802 	sccb_reg_write(gspca_dev, 0x11, r->r11);  in set_frame_rate()
803 	sccb_reg_write(gspca_dev, 0x0d, r->r0d);  in set_frame_rate()
804 	ov534_reg_write(gspca_dev, 0xe5, r->re5);  in set_frame_rate()
809 static void sethue(struct gspca_dev *gspca_dev, s32 val)  in sethue()  argument
811 	struct sd *sd = (struct sd *) gspca_dev;  in sethue()
831 			sccb_reg_write(gspca_dev, 0xab,  in sethue()
832 				sccb_reg_read(gspca_dev, 0xab) | 0x2);  in sethue()
835 			sccb_reg_write(gspca_dev, 0xab,  in sethue()
836 				sccb_reg_read(gspca_dev, 0xab) & ~0x2);  in sethue()
839 		sccb_reg_write(gspca_dev, 0xa9, (u8)huecos);  in sethue()
840 		sccb_reg_write(gspca_dev, 0xaa, (u8)huesin);  in sethue()
844 static void setsaturation(struct gspca_dev *gspca_dev, s32 val)  in setsaturation()  argument
846 	struct sd *sd = (struct sd *) gspca_dev;  in setsaturation()
861 			sccb_reg_write(gspca_dev, 0x4f + i, color_tb[val][i]);  in setsaturation()
863 		sccb_reg_write(gspca_dev, 0xa7, val); /* U saturation */  in setsaturation()
864 		sccb_reg_write(gspca_dev, 0xa8, val); /* V saturation */  in setsaturation()
868 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)  in setbrightness()  argument
870 	struct sd *sd = (struct sd *) gspca_dev;  in setbrightness()
875 		sccb_reg_write(gspca_dev, 0x55, val);	/* bright */  in setbrightness()
877 		sccb_reg_write(gspca_dev, 0x9b, val);  in setbrightness()
881 static void setcontrast(struct gspca_dev *gspca_dev, s32 val)  in setcontrast()  argument
883 	struct sd *sd = (struct sd *) gspca_dev;  in setcontrast()
886 		sccb_reg_write(gspca_dev, 0x56, val);	/* contras */  in setcontrast()
888 		sccb_reg_write(gspca_dev, 0x9c, val);  in setcontrast()
891 static void setgain(struct gspca_dev *gspca_dev, s32 val)  in setgain()  argument
911 	sccb_reg_write(gspca_dev, 0x00, val);  in setgain()
914 static s32 getgain(struct gspca_dev *gspca_dev)  in getgain()  argument
916 	return sccb_reg_read(gspca_dev, 0x00);  in getgain()
919 static void setexposure(struct gspca_dev *gspca_dev, s32 val)  in setexposure()  argument
921 	struct sd *sd = (struct sd *) gspca_dev;  in setexposure()
926 		sccb_reg_write(gspca_dev, 0x10, val);	/* aech */  in setexposure()
935 		sccb_reg_write(gspca_dev, 0x08, val >> 7);  in setexposure()
936 		sccb_reg_write(gspca_dev, 0x10, val << 1);  in setexposure()
940 static s32 getexposure(struct gspca_dev *gspca_dev)  in getexposure()  argument
942 	struct sd *sd = (struct sd *) gspca_dev;  in getexposure()
946 		return sccb_reg_read(gspca_dev, 0x10);	/* aech */  in getexposure()
948 		u8 hi = sccb_reg_read(gspca_dev, 0x08);  in getexposure()
949 		u8 lo = sccb_reg_read(gspca_dev, 0x10);  in getexposure()
954 static void setagc(struct gspca_dev *gspca_dev, s32 val)  in setagc()  argument
957 		sccb_reg_write(gspca_dev, 0x13,  in setagc()
958 				sccb_reg_read(gspca_dev, 0x13) | 0x04);  in setagc()
959 		sccb_reg_write(gspca_dev, 0x64,  in setagc()
960 				sccb_reg_read(gspca_dev, 0x64) | 0x03);  in setagc()
962 		sccb_reg_write(gspca_dev, 0x13,  in setagc()
963 				sccb_reg_read(gspca_dev, 0x13) & ~0x04);  in setagc()
964 		sccb_reg_write(gspca_dev, 0x64,  in setagc()
965 				sccb_reg_read(gspca_dev, 0x64) & ~0x03);  in setagc()
969 static void setawb(struct gspca_dev *gspca_dev, s32 val)  in setawb()  argument
971 	struct sd *sd = (struct sd *) gspca_dev;  in setawb()
974 		sccb_reg_write(gspca_dev, 0x13,  in setawb()
975 				sccb_reg_read(gspca_dev, 0x13) | 0x02);  in setawb()
977 			sccb_reg_write(gspca_dev, 0x63,  in setawb()
978 				sccb_reg_read(gspca_dev, 0x63) | 0xc0);  in setawb()
980 		sccb_reg_write(gspca_dev, 0x13,  in setawb()
981 				sccb_reg_read(gspca_dev, 0x13) & ~0x02);  in setawb()
983 			sccb_reg_write(gspca_dev, 0x63,  in setawb()
984 				sccb_reg_read(gspca_dev, 0x63) & ~0xc0);  in setawb()
988 static void setaec(struct gspca_dev *gspca_dev, s32 val)  in setaec()  argument
990 	struct sd *sd = (struct sd *) gspca_dev;  in setaec()
998 		sccb_reg_write(gspca_dev, 0x13,  in setaec()
999 				sccb_reg_read(gspca_dev, 0x13) | data);  in setaec()
1002 		sccb_reg_write(gspca_dev, 0x13,  in setaec()
1003 				sccb_reg_read(gspca_dev, 0x13) & ~data);  in setaec()
1008 static void setsharpness(struct gspca_dev *gspca_dev, s32 val)  in setsharpness()  argument
1010 	sccb_reg_write(gspca_dev, 0x91, val);	/* Auto de-noise threshold */  in setsharpness()
1011 	sccb_reg_write(gspca_dev, 0x8e, val);	/* De-noise threshold */  in setsharpness()
1014 static void sethvflip(struct gspca_dev *gspca_dev, s32 hflip, s32 vflip)  in sethvflip()  argument
1016 	struct sd *sd = (struct sd *) gspca_dev;  in sethvflip()
1020 		val = sccb_reg_read(gspca_dev, 0x1e);	/* mvfp */  in sethvflip()
1026 		sccb_reg_write(gspca_dev, 0x1e, val);  in sethvflip()
1028 		val = sccb_reg_read(gspca_dev, 0x0c);  in sethvflip()
1034 		sccb_reg_write(gspca_dev, 0x0c, val);  in sethvflip()
1038 static void setlightfreq(struct gspca_dev *gspca_dev, s32 val)  in setlightfreq()  argument
1040 	struct sd *sd = (struct sd *) gspca_dev;  in setlightfreq()
1044 		sccb_reg_write(gspca_dev, 0x2a, 0x00);  in setlightfreq()
1048 	sccb_reg_write(gspca_dev, 0x2b, val);  in setlightfreq()
1053 static int sd_config(struct gspca_dev *gspca_dev,  in sd_config()  argument
1056 	struct sd *sd = (struct sd *) gspca_dev;  in sd_config()
1059 	cam = &gspca_dev->cam;  in sd_config()
1072 	struct gspca_dev *gspca_dev = &sd->gspca_dev;  in ov534_g_volatile_ctrl()  local
1076 		gspca_dev->usb_err = 0;  in ov534_g_volatile_ctrl()
1077 		if (ctrl->val && sd->gain && gspca_dev->streaming)  in ov534_g_volatile_ctrl()
1078 			sd->gain->val = getgain(gspca_dev);  in ov534_g_volatile_ctrl()
1079 		return gspca_dev->usb_err;  in ov534_g_volatile_ctrl()
1082 		gspca_dev->usb_err = 0;  in ov534_g_volatile_ctrl()
1084 		    gspca_dev->streaming)  in ov534_g_volatile_ctrl()
1085 			sd->exposure->val = getexposure(gspca_dev);  in ov534_g_volatile_ctrl()
1086 		return gspca_dev->usb_err;  in ov534_g_volatile_ctrl()
1094 	struct gspca_dev *gspca_dev = &sd->gspca_dev;  in ov534_s_ctrl()  local
1096 	gspca_dev->usb_err = 0;  in ov534_s_ctrl()
1097 	if (!gspca_dev->streaming)  in ov534_s_ctrl()
1102 		sethue(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1105 		setsaturation(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1108 		setbrightness(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1111 		setcontrast(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1115 		setagc(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1116 		if (!gspca_dev->usb_err && !ctrl->val && sd->gain)  in ov534_s_ctrl()
1117 			setgain(gspca_dev, sd->gain->val);  in ov534_s_ctrl()
1120 		setawb(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1124 		setaec(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1125 		if (!gspca_dev->usb_err && ctrl->val == V4L2_EXPOSURE_MANUAL &&  in ov534_s_ctrl()
1127 			setexposure(gspca_dev, sd->exposure->val);  in ov534_s_ctrl()
1130 		setsharpness(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1133 		sethvflip(gspca_dev, ctrl->val, sd->vflip->val);  in ov534_s_ctrl()
1136 		sethvflip(gspca_dev, sd->hflip->val, ctrl->val);  in ov534_s_ctrl()
1139 		setlightfreq(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1142 	return gspca_dev->usb_err;  in ov534_s_ctrl()
1150 static int sd_init_controls(struct gspca_dev *gspca_dev)  in sd_init_controls()  argument
1152 	struct sd *sd = (struct sd *) gspca_dev;  in sd_init_controls()
1196 	gspca_dev->vdev.ctrl_handler = hdl;  in sd_init_controls()
1259 static int sd_init(struct gspca_dev *gspca_dev)  in sd_init()  argument
1261 	struct sd *sd = (struct sd *) gspca_dev;  in sd_init()
1273 	ov534_reg_write(gspca_dev, 0xe7, 0x3a);  in sd_init()
1274 	ov534_reg_write(gspca_dev, 0xe0, 0x08);  in sd_init()
1278 	ov534_reg_write(gspca_dev, OV534_REG_ADDRESS, 0x42);  in sd_init()
1281 	sccb_reg_write(gspca_dev, 0x12, 0x80);  in sd_init()
1285 	sccb_reg_read(gspca_dev, 0x0a);  in sd_init()
1286 	sensor_id = sccb_reg_read(gspca_dev, 0x0a) << 8;  in sd_init()
1287 	sccb_reg_read(gspca_dev, 0x0b);  in sd_init()
1288 	sensor_id |= sccb_reg_read(gspca_dev, 0x0b);  in sd_init()
1293 		gspca_dev->cam.cam_mode = ov767x_mode;  in sd_init()
1294 		gspca_dev->cam.nmodes = ARRAY_SIZE(ov767x_mode);  in sd_init()
1297 		gspca_dev->cam.bulk = 1;  in sd_init()
1298 		gspca_dev->cam.bulk_size = 16384;  in sd_init()
1299 		gspca_dev->cam.bulk_nurbs = 2;  in sd_init()
1300 		gspca_dev->cam.mode_framerates = ov772x_framerates;  in sd_init()
1304 	reg_w_array(gspca_dev, bridge_init[sd->sensor].val,  in sd_init()
1306 	ov534_set_led(gspca_dev, 1);  in sd_init()
1307 	sccb_w_array(gspca_dev, sensor_init[sd->sensor].val,  in sd_init()
1310 	sd_stopN(gspca_dev);  in sd_init()
1313 	return gspca_dev->usb_err;  in sd_init()
1316 static int sd_start(struct gspca_dev *gspca_dev)  in sd_start()  argument
1318 	struct sd *sd = (struct sd *) gspca_dev;  in sd_start()
1343 		sccb_reg_write(gspca_dev, 0x1e, 0x04);  in sd_start()
1346 	mode = gspca_dev->curr_mode;	/* 0: 320x240, 1: 640x480 */  in sd_start()
1347 	reg_w_array(gspca_dev, bridge_start[sd->sensor][mode].val,  in sd_start()
1349 	sccb_w_array(gspca_dev, sensor_start[sd->sensor][mode].val,  in sd_start()
1352 	set_frame_rate(gspca_dev);  in sd_start()
1355 		sethue(gspca_dev, v4l2_ctrl_g_ctrl(sd->hue));  in sd_start()
1356 	setsaturation(gspca_dev, v4l2_ctrl_g_ctrl(sd->saturation));  in sd_start()
1358 		setagc(gspca_dev, v4l2_ctrl_g_ctrl(sd->autogain));  in sd_start()
1359 	setawb(gspca_dev, v4l2_ctrl_g_ctrl(sd->autowhitebalance));  in sd_start()
1360 	setaec(gspca_dev, v4l2_ctrl_g_ctrl(sd->autoexposure));  in sd_start()
1362 		setgain(gspca_dev, v4l2_ctrl_g_ctrl(sd->gain));  in sd_start()
1363 	setexposure(gspca_dev, v4l2_ctrl_g_ctrl(sd->exposure));  in sd_start()
1364 	setbrightness(gspca_dev, v4l2_ctrl_g_ctrl(sd->brightness));  in sd_start()
1365 	setcontrast(gspca_dev, v4l2_ctrl_g_ctrl(sd->contrast));  in sd_start()
1367 		setsharpness(gspca_dev, v4l2_ctrl_g_ctrl(sd->sharpness));  in sd_start()
1368 	sethvflip(gspca_dev, v4l2_ctrl_g_ctrl(sd->hflip),  in sd_start()
1370 	setlightfreq(gspca_dev, v4l2_ctrl_g_ctrl(sd->plfreq));  in sd_start()
1372 	ov534_set_led(gspca_dev, 1);  in sd_start()
1373 	ov534_reg_write(gspca_dev, 0xe0, 0x00);  in sd_start()
1374 	return gspca_dev->usb_err;  in sd_start()
1377 static void sd_stopN(struct gspca_dev *gspca_dev)  in sd_stopN()  argument
1379 	ov534_reg_write(gspca_dev, 0xe0, 0x09);  in sd_stopN()
1380 	ov534_set_led(gspca_dev, 0);  in sd_stopN()
1393 static void sd_pkt_scan(struct gspca_dev *gspca_dev,  in sd_pkt_scan()  argument
1396 	struct sd *sd = (struct sd *) gspca_dev;  in sd_pkt_scan()
1402 	payload_len = gspca_dev->cam.bulk ? 2048 : 2040;  in sd_pkt_scan()
1434 			if (gspca_dev->last_packet_type == INTER_PACKET)  in sd_pkt_scan()
1435 				gspca_frame_add(gspca_dev, LAST_PACKET,  in sd_pkt_scan()
1439 			gspca_frame_add(gspca_dev, FIRST_PACKET,  in sd_pkt_scan()
1444 			if (gspca_dev->pixfmt.pixelformat == V4L2_PIX_FMT_YUYV  in sd_pkt_scan()
1445 			 && gspca_dev->image_len + len - 12 !=  in sd_pkt_scan()
1446 				   gspca_dev->pixfmt.width *  in sd_pkt_scan()
1447 					gspca_dev->pixfmt.height * 2) {  in sd_pkt_scan()
1451 			gspca_frame_add(gspca_dev, LAST_PACKET,  in sd_pkt_scan()
1456 			gspca_frame_add(gspca_dev, INTER_PACKET,  in sd_pkt_scan()
1465 		gspca_dev->last_packet_type = DISCARD_PACKET;  in sd_pkt_scan()
1474 static void sd_get_streamparm(struct gspca_dev *gspca_dev,  in sd_get_streamparm()  argument
1479 	struct sd *sd = (struct sd *) gspca_dev;  in sd_get_streamparm()
1487 static void sd_set_streamparm(struct gspca_dev *gspca_dev,  in sd_set_streamparm()  argument
1492 	struct sd *sd = (struct sd *) gspca_dev;  in sd_set_streamparm()
1501 	if (gspca_dev->streaming)  in sd_set_streamparm()
1502 		set_frame_rate(gspca_dev);  in sd_set_streamparm()