58 	struct gspca_dev gspca_dev;	/* !! must be the first item */  member
91 static int sd_start(struct gspca_dev *gspca_dev);
92 static void sd_stopN(struct gspca_dev *gspca_dev);
607 static void ov534_reg_write(struct gspca_dev *gspca_dev, u16 reg, u8 val)  in ov534_reg_write()  argument
609 	struct usb_device *udev = gspca_dev->dev;  in ov534_reg_write()
612 	if (gspca_dev->usb_err < 0)  in ov534_reg_write()
615 	gspca_dbg(gspca_dev, D_USBO, "SET 01 0000 %04x %02x\n", reg, val);  in ov534_reg_write()
616 	gspca_dev->usb_buf[0] = val;  in ov534_reg_write()
621 			      0x00, reg, gspca_dev->usb_buf, 1, CTRL_TIMEOUT);  in ov534_reg_write()
624 		gspca_dev->usb_err = ret;  in ov534_reg_write()
628 static u8 ov534_reg_read(struct gspca_dev *gspca_dev, u16 reg)  in ov534_reg_read()  argument
630 	struct usb_device *udev = gspca_dev->dev;  in ov534_reg_read()
633 	if (gspca_dev->usb_err < 0)  in ov534_reg_read()
639 			      0x00, reg, gspca_dev->usb_buf, 1, CTRL_TIMEOUT);  in ov534_reg_read()
640 	gspca_dbg(gspca_dev, D_USBI, "GET 01 0000 %04x %02x\n",  in ov534_reg_read()
641 		  reg, gspca_dev->usb_buf[0]);  in ov534_reg_read()
644 		gspca_dev->usb_err = ret;  in ov534_reg_read()
646 	return gspca_dev->usb_buf[0];  in ov534_reg_read()
651 static void ov534_set_led(struct gspca_dev *gspca_dev, int status)  in ov534_set_led()  argument
655 	gspca_dbg(gspca_dev, D_CONF, "led status: %d\n", status);  in ov534_set_led()
657 	data = ov534_reg_read(gspca_dev, 0x21);  in ov534_set_led()
659 	ov534_reg_write(gspca_dev, 0x21, data);  in ov534_set_led()
661 	data = ov534_reg_read(gspca_dev, 0x23);  in ov534_set_led()
667 	ov534_reg_write(gspca_dev, 0x23, data);  in ov534_set_led()
670 		data = ov534_reg_read(gspca_dev, 0x21);  in ov534_set_led()
672 		ov534_reg_write(gspca_dev, 0x21, data);  in ov534_set_led()
676 static int sccb_check_status(struct gspca_dev *gspca_dev)  in sccb_check_status()  argument
683 		data = ov534_reg_read(gspca_dev, OV534_REG_STATUS);  in sccb_check_status()
693 			gspca_err(gspca_dev, "sccb status 0x%02x, attempt %d/5\n",  in sccb_check_status()
700 static void sccb_reg_write(struct gspca_dev *gspca_dev, u8 reg, u8 val)  in sccb_reg_write()  argument
702 	gspca_dbg(gspca_dev, D_USBO, "sccb write: %02x %02x\n", reg, val);  in sccb_reg_write()
703 	ov534_reg_write(gspca_dev, OV534_REG_SUBADDR, reg);  in sccb_reg_write()
704 	ov534_reg_write(gspca_dev, OV534_REG_WRITE, val);  in sccb_reg_write()
705 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_WRITE_3);  in sccb_reg_write()
707 	if (!sccb_check_status(gspca_dev)) {  in sccb_reg_write()
709 		gspca_dev->usb_err = -EIO;  in sccb_reg_write()
713 static u8 sccb_reg_read(struct gspca_dev *gspca_dev, u16 reg)  in sccb_reg_read()  argument
715 	ov534_reg_write(gspca_dev, OV534_REG_SUBADDR, reg);  in sccb_reg_read()
716 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_WRITE_2);  in sccb_reg_read()
717 	if (!sccb_check_status(gspca_dev))  in sccb_reg_read()
720 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_READ_2);  in sccb_reg_read()
721 	if (!sccb_check_status(gspca_dev))  in sccb_reg_read()
724 	return ov534_reg_read(gspca_dev, OV534_REG_READ);  in sccb_reg_read()
728 static void reg_w_array(struct gspca_dev *gspca_dev,  in reg_w_array()  argument
732 		ov534_reg_write(gspca_dev, (*data)[0], (*data)[1]);  in reg_w_array()
738 static void sccb_w_array(struct gspca_dev *gspca_dev,  in sccb_w_array()  argument
743 			sccb_reg_write(gspca_dev, (*data)[0], (*data)[1]);  in sccb_w_array()
745 			sccb_reg_read(gspca_dev, (*data)[1]);  in sccb_w_array()
746 			sccb_reg_write(gspca_dev, 0xff, 0x00);  in sccb_w_array()
753 static void set_frame_rate(struct gspca_dev *gspca_dev)  in set_frame_rate()  argument
755 	struct sd *sd = (struct sd *) gspca_dev;  in set_frame_rate()
787 	if (gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv == 0) {  in set_frame_rate()
800 	sccb_reg_write(gspca_dev, 0x11, r->r11);  in set_frame_rate()
801 	sccb_reg_write(gspca_dev, 0x0d, r->r0d);  in set_frame_rate()
802 	ov534_reg_write(gspca_dev, 0xe5, r->re5);  in set_frame_rate()
804 	gspca_dbg(gspca_dev, D_PROBE, "frame_rate: %d\n", r->fps);  in set_frame_rate()
807 static void sethue(struct gspca_dev *gspca_dev, s32 val)  in sethue()  argument
809 	struct sd *sd = (struct sd *) gspca_dev;  in sethue()
829 			sccb_reg_write(gspca_dev, 0xab,  in sethue()
830 				sccb_reg_read(gspca_dev, 0xab) | 0x2);  in sethue()
833 			sccb_reg_write(gspca_dev, 0xab,  in sethue()
834 				sccb_reg_read(gspca_dev, 0xab) & ~0x2);  in sethue()
837 		sccb_reg_write(gspca_dev, 0xa9, (u8)huecos);  in sethue()
838 		sccb_reg_write(gspca_dev, 0xaa, (u8)huesin);  in sethue()
842 static void setsaturation(struct gspca_dev *gspca_dev, s32 val)  in setsaturation()  argument
844 	struct sd *sd = (struct sd *) gspca_dev;  in setsaturation()
859 			sccb_reg_write(gspca_dev, 0x4f + i, color_tb[val][i]);  in setsaturation()
861 		sccb_reg_write(gspca_dev, 0xa7, val); /* U saturation */  in setsaturation()
862 		sccb_reg_write(gspca_dev, 0xa8, val); /* V saturation */  in setsaturation()
866 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)  in setbrightness()  argument
868 	struct sd *sd = (struct sd *) gspca_dev;  in setbrightness()
873 		sccb_reg_write(gspca_dev, 0x55, val);	/* bright */  in setbrightness()
875 		sccb_reg_write(gspca_dev, 0x9b, val);  in setbrightness()
879 static void setcontrast(struct gspca_dev *gspca_dev, s32 val)  in setcontrast()  argument
881 	struct sd *sd = (struct sd *) gspca_dev;  in setcontrast()
884 		sccb_reg_write(gspca_dev, 0x56, val);	/* contras */  in setcontrast()
886 		sccb_reg_write(gspca_dev, 0x9c, val);  in setcontrast()
889 static void setgain(struct gspca_dev *gspca_dev, s32 val)  in setgain()  argument
909 	sccb_reg_write(gspca_dev, 0x00, val);  in setgain()
912 static s32 getgain(struct gspca_dev *gspca_dev)  in getgain()  argument
914 	return sccb_reg_read(gspca_dev, 0x00);  in getgain()
917 static void setexposure(struct gspca_dev *gspca_dev, s32 val)  in setexposure()  argument
919 	struct sd *sd = (struct sd *) gspca_dev;  in setexposure()
924 		sccb_reg_write(gspca_dev, 0x10, val);	/* aech */  in setexposure()
933 		sccb_reg_write(gspca_dev, 0x08, val >> 7);  in setexposure()
934 		sccb_reg_write(gspca_dev, 0x10, val << 1);  in setexposure()
938 static s32 getexposure(struct gspca_dev *gspca_dev)  in getexposure()  argument
940 	struct sd *sd = (struct sd *) gspca_dev;  in getexposure()
944 		return sccb_reg_read(gspca_dev, 0x10);	/* aech */  in getexposure()
946 		u8 hi = sccb_reg_read(gspca_dev, 0x08);  in getexposure()
947 		u8 lo = sccb_reg_read(gspca_dev, 0x10);  in getexposure()
952 static void setagc(struct gspca_dev *gspca_dev, s32 val)  in setagc()  argument
955 		sccb_reg_write(gspca_dev, 0x13,  in setagc()
956 				sccb_reg_read(gspca_dev, 0x13) | 0x04);  in setagc()
957 		sccb_reg_write(gspca_dev, 0x64,  in setagc()
958 				sccb_reg_read(gspca_dev, 0x64) | 0x03);  in setagc()
960 		sccb_reg_write(gspca_dev, 0x13,  in setagc()
961 				sccb_reg_read(gspca_dev, 0x13) & ~0x04);  in setagc()
962 		sccb_reg_write(gspca_dev, 0x64,  in setagc()
963 				sccb_reg_read(gspca_dev, 0x64) & ~0x03);  in setagc()
967 static void setawb(struct gspca_dev *gspca_dev, s32 val)  in setawb()  argument
969 	struct sd *sd = (struct sd *) gspca_dev;  in setawb()
972 		sccb_reg_write(gspca_dev, 0x13,  in setawb()
973 				sccb_reg_read(gspca_dev, 0x13) | 0x02);  in setawb()
975 			sccb_reg_write(gspca_dev, 0x63,  in setawb()
976 				sccb_reg_read(gspca_dev, 0x63) | 0xc0);  in setawb()
978 		sccb_reg_write(gspca_dev, 0x13,  in setawb()
979 				sccb_reg_read(gspca_dev, 0x13) & ~0x02);  in setawb()
981 			sccb_reg_write(gspca_dev, 0x63,  in setawb()
982 				sccb_reg_read(gspca_dev, 0x63) & ~0xc0);  in setawb()
986 static void setaec(struct gspca_dev *gspca_dev, s32 val)  in setaec()  argument
988 	struct sd *sd = (struct sd *) gspca_dev;  in setaec()
996 		sccb_reg_write(gspca_dev, 0x13,  in setaec()
997 				sccb_reg_read(gspca_dev, 0x13) | data);  in setaec()
1000 		sccb_reg_write(gspca_dev, 0x13,  in setaec()
1001 				sccb_reg_read(gspca_dev, 0x13) & ~data);  in setaec()
1006 static void setsharpness(struct gspca_dev *gspca_dev, s32 val)  in setsharpness()  argument
1008 	sccb_reg_write(gspca_dev, 0x91, val);	/* Auto de-noise threshold */  in setsharpness()
1009 	sccb_reg_write(gspca_dev, 0x8e, val);	/* De-noise threshold */  in setsharpness()
1012 static void sethvflip(struct gspca_dev *gspca_dev, s32 hflip, s32 vflip)  in sethvflip()  argument
1014 	struct sd *sd = (struct sd *) gspca_dev;  in sethvflip()
1018 		val = sccb_reg_read(gspca_dev, 0x1e);	/* mvfp */  in sethvflip()
1024 		sccb_reg_write(gspca_dev, 0x1e, val);  in sethvflip()
1026 		val = sccb_reg_read(gspca_dev, 0x0c);  in sethvflip()
1032 		sccb_reg_write(gspca_dev, 0x0c, val);  in sethvflip()
1036 static void setlightfreq(struct gspca_dev *gspca_dev, s32 val)  in setlightfreq()  argument
1038 	struct sd *sd = (struct sd *) gspca_dev;  in setlightfreq()
1042 		sccb_reg_write(gspca_dev, 0x2a, 0x00);  in setlightfreq()
1046 	sccb_reg_write(gspca_dev, 0x2b, val);  in setlightfreq()
1051 static int sd_config(struct gspca_dev *gspca_dev,  in sd_config()  argument
1054 	struct sd *sd = (struct sd *) gspca_dev;  in sd_config()
1057 	cam = &gspca_dev->cam;  in sd_config()
1070 	struct gspca_dev *gspca_dev = &sd->gspca_dev;  in ov534_g_volatile_ctrl()  local
1074 		gspca_dev->usb_err = 0;  in ov534_g_volatile_ctrl()
1075 		if (ctrl->val && sd->gain && gspca_dev->streaming)  in ov534_g_volatile_ctrl()
1076 			sd->gain->val = getgain(gspca_dev);  in ov534_g_volatile_ctrl()
1077 		return gspca_dev->usb_err;  in ov534_g_volatile_ctrl()
1080 		gspca_dev->usb_err = 0;  in ov534_g_volatile_ctrl()
1082 		    gspca_dev->streaming)  in ov534_g_volatile_ctrl()
1083 			sd->exposure->val = getexposure(gspca_dev);  in ov534_g_volatile_ctrl()
1084 		return gspca_dev->usb_err;  in ov534_g_volatile_ctrl()
1092 	struct gspca_dev *gspca_dev = &sd->gspca_dev;  in ov534_s_ctrl()  local
1094 	gspca_dev->usb_err = 0;  in ov534_s_ctrl()
1095 	if (!gspca_dev->streaming)  in ov534_s_ctrl()
1100 		sethue(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1103 		setsaturation(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1106 		setbrightness(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1109 		setcontrast(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1113 		setagc(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1114 		if (!gspca_dev->usb_err && !ctrl->val && sd->gain)  in ov534_s_ctrl()
1115 			setgain(gspca_dev, sd->gain->val);  in ov534_s_ctrl()
1118 		setawb(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1122 		setaec(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1123 		if (!gspca_dev->usb_err && ctrl->val == V4L2_EXPOSURE_MANUAL &&  in ov534_s_ctrl()
1125 			setexposure(gspca_dev, sd->exposure->val);  in ov534_s_ctrl()
1128 		setsharpness(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1131 		sethvflip(gspca_dev, ctrl->val, sd->vflip->val);  in ov534_s_ctrl()
1134 		sethvflip(gspca_dev, sd->hflip->val, ctrl->val);  in ov534_s_ctrl()
1137 		setlightfreq(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1140 	return gspca_dev->usb_err;  in ov534_s_ctrl()
1148 static int sd_init_controls(struct gspca_dev *gspca_dev)  in sd_init_controls()  argument
1150 	struct sd *sd = (struct sd *) gspca_dev;  in sd_init_controls()
1194 	gspca_dev->vdev.ctrl_handler = hdl;  in sd_init_controls()
1257 static int sd_init(struct gspca_dev *gspca_dev)  in sd_init()  argument
1259 	struct sd *sd = (struct sd *) gspca_dev;  in sd_init()
1271 	ov534_reg_write(gspca_dev, 0xe7, 0x3a);  in sd_init()
1272 	ov534_reg_write(gspca_dev, 0xe0, 0x08);  in sd_init()
1276 	ov534_reg_write(gspca_dev, OV534_REG_ADDRESS, 0x42);  in sd_init()
1279 	sccb_reg_write(gspca_dev, 0x12, 0x80);  in sd_init()
1283 	sccb_reg_read(gspca_dev, 0x0a);  in sd_init()
1284 	sensor_id = sccb_reg_read(gspca_dev, 0x0a) << 8;  in sd_init()
1285 	sccb_reg_read(gspca_dev, 0x0b);  in sd_init()
1286 	sensor_id |= sccb_reg_read(gspca_dev, 0x0b);  in sd_init()
1287 	gspca_dbg(gspca_dev, D_PROBE, "Sensor ID: %04x\n", sensor_id);  in sd_init()
1291 		gspca_dev->cam.cam_mode = ov767x_mode;  in sd_init()
1292 		gspca_dev->cam.nmodes = ARRAY_SIZE(ov767x_mode);  in sd_init()
1295 		gspca_dev->cam.bulk = 1;  in sd_init()
1296 		gspca_dev->cam.bulk_size = 16384;  in sd_init()
1297 		gspca_dev->cam.bulk_nurbs = 2;  in sd_init()
1298 		gspca_dev->cam.mode_framerates = ov772x_framerates;  in sd_init()
1302 	reg_w_array(gspca_dev, bridge_init[sd->sensor].val,  in sd_init()
1304 	ov534_set_led(gspca_dev, 1);  in sd_init()
1305 	sccb_w_array(gspca_dev, sensor_init[sd->sensor].val,  in sd_init()
1308 	sd_stopN(gspca_dev);  in sd_init()
1311 	return gspca_dev->usb_err;  in sd_init()
1314 static int sd_start(struct gspca_dev *gspca_dev)  in sd_start()  argument
1316 	struct sd *sd = (struct sd *) gspca_dev;  in sd_start()
1341 		sccb_reg_write(gspca_dev, 0x1e, 0x04);  in sd_start()
1344 	mode = gspca_dev->curr_mode;	/* 0: 320x240, 1: 640x480 */  in sd_start()
1345 	reg_w_array(gspca_dev, bridge_start[sd->sensor][mode].val,  in sd_start()
1347 	sccb_w_array(gspca_dev, sensor_start[sd->sensor][mode].val,  in sd_start()
1350 	set_frame_rate(gspca_dev);  in sd_start()
1353 		sethue(gspca_dev, v4l2_ctrl_g_ctrl(sd->hue));  in sd_start()
1354 	setsaturation(gspca_dev, v4l2_ctrl_g_ctrl(sd->saturation));  in sd_start()
1356 		setagc(gspca_dev, v4l2_ctrl_g_ctrl(sd->autogain));  in sd_start()
1357 	setawb(gspca_dev, v4l2_ctrl_g_ctrl(sd->autowhitebalance));  in sd_start()
1358 	setaec(gspca_dev, v4l2_ctrl_g_ctrl(sd->autoexposure));  in sd_start()
1360 		setgain(gspca_dev, v4l2_ctrl_g_ctrl(sd->gain));  in sd_start()
1361 	setexposure(gspca_dev, v4l2_ctrl_g_ctrl(sd->exposure));  in sd_start()
1362 	setbrightness(gspca_dev, v4l2_ctrl_g_ctrl(sd->brightness));  in sd_start()
1363 	setcontrast(gspca_dev, v4l2_ctrl_g_ctrl(sd->contrast));  in sd_start()
1365 		setsharpness(gspca_dev, v4l2_ctrl_g_ctrl(sd->sharpness));  in sd_start()
1366 	sethvflip(gspca_dev, v4l2_ctrl_g_ctrl(sd->hflip),  in sd_start()
1368 	setlightfreq(gspca_dev, v4l2_ctrl_g_ctrl(sd->plfreq));  in sd_start()
1370 	ov534_set_led(gspca_dev, 1);  in sd_start()
1371 	ov534_reg_write(gspca_dev, 0xe0, 0x00);  in sd_start()
1372 	return gspca_dev->usb_err;  in sd_start()
1375 static void sd_stopN(struct gspca_dev *gspca_dev)  in sd_stopN()  argument
1377 	ov534_reg_write(gspca_dev, 0xe0, 0x09);  in sd_stopN()
1378 	ov534_set_led(gspca_dev, 0);  in sd_stopN()
1391 static void sd_pkt_scan(struct gspca_dev *gspca_dev,  in sd_pkt_scan()  argument
1394 	struct sd *sd = (struct sd *) gspca_dev;  in sd_pkt_scan()
1400 	payload_len = gspca_dev->cam.bulk ? 2048 : 2040;  in sd_pkt_scan()
1411 			gspca_dbg(gspca_dev, D_PACK, "bad header\n");  in sd_pkt_scan()
1417 			gspca_dbg(gspca_dev, D_PACK, "payload error\n");  in sd_pkt_scan()
1423 			gspca_dbg(gspca_dev, D_PACK, "PTS not present\n");  in sd_pkt_scan()
1432 			if (gspca_dev->last_packet_type == INTER_PACKET)  in sd_pkt_scan()
1433 				gspca_frame_add(gspca_dev, LAST_PACKET,  in sd_pkt_scan()
1437 			gspca_frame_add(gspca_dev, FIRST_PACKET,  in sd_pkt_scan()
1442 			if (gspca_dev->pixfmt.pixelformat == V4L2_PIX_FMT_YUYV  in sd_pkt_scan()
1443 			 && gspca_dev->image_len + len - 12 !=  in sd_pkt_scan()
1444 				   gspca_dev->pixfmt.width *  in sd_pkt_scan()
1445 					gspca_dev->pixfmt.height * 2) {  in sd_pkt_scan()
1446 				gspca_dbg(gspca_dev, D_PACK, "wrong sized frame\n");  in sd_pkt_scan()
1449 			gspca_frame_add(gspca_dev, LAST_PACKET,  in sd_pkt_scan()
1454 			gspca_frame_add(gspca_dev, INTER_PACKET,  in sd_pkt_scan()
1463 		gspca_dev->last_packet_type = DISCARD_PACKET;  in sd_pkt_scan()
1472 static void sd_get_streamparm(struct gspca_dev *gspca_dev,  in sd_get_streamparm()  argument
1477 	struct sd *sd = (struct sd *) gspca_dev;  in sd_get_streamparm()
1484 static void sd_set_streamparm(struct gspca_dev *gspca_dev,  in sd_set_streamparm()  argument
1489 	struct sd *sd = (struct sd *) gspca_dev;  in sd_set_streamparm()
1496 	if (gspca_dev->streaming)  in sd_set_streamparm()
1497 		set_frame_rate(gspca_dev);  in sd_set_streamparm()