49 	struct gspca_dev gspca_dev;	/* !! must be the first item */  member
82 static int sd_start(struct gspca_dev *gspca_dev);
83 static void sd_stopN(struct gspca_dev *gspca_dev);
658 static void ov534_reg_write(struct gspca_dev *gspca_dev, u16 reg, u8 val)  in ov534_reg_write()  argument
660 	struct usb_device *udev = gspca_dev->dev;  in ov534_reg_write()
663 	if (gspca_dev->usb_err < 0)  in ov534_reg_write()
666 	gspca_dbg(gspca_dev, D_USBO, "SET 01 0000 %04x %02x\n", reg, val);  in ov534_reg_write()
667 	gspca_dev->usb_buf[0] = val;  in ov534_reg_write()
672 			      0x00, reg, gspca_dev->usb_buf, 1, CTRL_TIMEOUT);  in ov534_reg_write()
675 		gspca_dev->usb_err = ret;  in ov534_reg_write()
679 static u8 ov534_reg_read(struct gspca_dev *gspca_dev, u16 reg)  in ov534_reg_read()  argument
681 	struct usb_device *udev = gspca_dev->dev;  in ov534_reg_read()
684 	if (gspca_dev->usb_err < 0)  in ov534_reg_read()
690 			      0x00, reg, gspca_dev->usb_buf, 1, CTRL_TIMEOUT);  in ov534_reg_read()
691 	gspca_dbg(gspca_dev, D_USBI, "GET 01 0000 %04x %02x\n",  in ov534_reg_read()
692 		  reg, gspca_dev->usb_buf[0]);  in ov534_reg_read()
695 		gspca_dev->usb_err = ret;  in ov534_reg_read()
700 		gspca_dev->usb_buf[0] = 0;  in ov534_reg_read()
702 	return gspca_dev->usb_buf[0];  in ov534_reg_read()
707 static void ov534_set_led(struct gspca_dev *gspca_dev, int status)  in ov534_set_led()  argument
711 	gspca_dbg(gspca_dev, D_CONF, "led status: %d\n", status);  in ov534_set_led()
713 	data = ov534_reg_read(gspca_dev, 0x21);  in ov534_set_led()
715 	ov534_reg_write(gspca_dev, 0x21, data);  in ov534_set_led()
717 	data = ov534_reg_read(gspca_dev, 0x23);  in ov534_set_led()
723 	ov534_reg_write(gspca_dev, 0x23, data);  in ov534_set_led()
726 		data = ov534_reg_read(gspca_dev, 0x21);  in ov534_set_led()
728 		ov534_reg_write(gspca_dev, 0x21, data);  in ov534_set_led()
732 static int sccb_check_status(struct gspca_dev *gspca_dev)  in sccb_check_status()  argument
739 		data = ov534_reg_read(gspca_dev, OV534_REG_STATUS);  in sccb_check_status()
749 			gspca_err(gspca_dev, "sccb status 0x%02x, attempt %d/5\n",  in sccb_check_status()
756 static void sccb_reg_write(struct gspca_dev *gspca_dev, u8 reg, u8 val)  in sccb_reg_write()  argument
758 	gspca_dbg(gspca_dev, D_USBO, "sccb write: %02x %02x\n", reg, val);  in sccb_reg_write()
759 	ov534_reg_write(gspca_dev, OV534_REG_SUBADDR, reg);  in sccb_reg_write()
760 	ov534_reg_write(gspca_dev, OV534_REG_WRITE, val);  in sccb_reg_write()
761 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_WRITE_3);  in sccb_reg_write()
763 	if (!sccb_check_status(gspca_dev)) {  in sccb_reg_write()
765 		gspca_dev->usb_err = -EIO;  in sccb_reg_write()
769 static u8 sccb_reg_read(struct gspca_dev *gspca_dev, u16 reg)  in sccb_reg_read()  argument
771 	ov534_reg_write(gspca_dev, OV534_REG_SUBADDR, reg);  in sccb_reg_read()
772 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_WRITE_2);  in sccb_reg_read()
773 	if (!sccb_check_status(gspca_dev))  in sccb_reg_read()
776 	ov534_reg_write(gspca_dev, OV534_REG_OPERATION, OV534_OP_READ_2);  in sccb_reg_read()
777 	if (!sccb_check_status(gspca_dev))  in sccb_reg_read()
780 	return ov534_reg_read(gspca_dev, OV534_REG_READ);  in sccb_reg_read()
784 static void reg_w_array(struct gspca_dev *gspca_dev,  in reg_w_array()  argument
788 		ov534_reg_write(gspca_dev, (*data)[0], (*data)[1]);  in reg_w_array()
794 static void sccb_w_array(struct gspca_dev *gspca_dev,  in sccb_w_array()  argument
799 			sccb_reg_write(gspca_dev, (*data)[0], (*data)[1]);  in sccb_w_array()
801 			sccb_reg_read(gspca_dev, (*data)[1]);  in sccb_w_array()
802 			sccb_reg_write(gspca_dev, 0xff, 0x00);  in sccb_w_array()
809 static void set_frame_rate(struct gspca_dev *gspca_dev)  in set_frame_rate()  argument
811 	struct sd *sd = (struct sd *) gspca_dev;  in set_frame_rate()
843 	if (gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv == 0) {  in set_frame_rate()
856 	sccb_reg_write(gspca_dev, 0x11, r->r11);  in set_frame_rate()
857 	sccb_reg_write(gspca_dev, 0x0d, r->r0d);  in set_frame_rate()
858 	ov534_reg_write(gspca_dev, 0xe5, r->re5);  in set_frame_rate()
860 	gspca_dbg(gspca_dev, D_PROBE, "frame_rate: %d\n", r->fps);  in set_frame_rate()
863 static void sethue(struct gspca_dev *gspca_dev, s32 val)  in sethue()  argument
865 	struct sd *sd = (struct sd *) gspca_dev;  in sethue()
885 			sccb_reg_write(gspca_dev, 0xab,  in sethue()
886 				sccb_reg_read(gspca_dev, 0xab) | 0x2);  in sethue()
889 			sccb_reg_write(gspca_dev, 0xab,  in sethue()
890 				sccb_reg_read(gspca_dev, 0xab) & ~0x2);  in sethue()
893 		sccb_reg_write(gspca_dev, 0xa9, (u8)huecos);  in sethue()
894 		sccb_reg_write(gspca_dev, 0xaa, (u8)huesin);  in sethue()
898 static void setsaturation(struct gspca_dev *gspca_dev, s32 val)  in setsaturation()  argument
900 	struct sd *sd = (struct sd *) gspca_dev;  in setsaturation()
915 			sccb_reg_write(gspca_dev, 0x4f + i, color_tb[val][i]);  in setsaturation()
917 		sccb_reg_write(gspca_dev, 0xa7, val); /* U saturation */  in setsaturation()
918 		sccb_reg_write(gspca_dev, 0xa8, val); /* V saturation */  in setsaturation()
922 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)  in setbrightness()  argument
924 	struct sd *sd = (struct sd *) gspca_dev;  in setbrightness()
929 		sccb_reg_write(gspca_dev, 0x55, val);	/* bright */  in setbrightness()
931 		sccb_reg_write(gspca_dev, 0x9b, val);  in setbrightness()
935 static void setcontrast(struct gspca_dev *gspca_dev, s32 val)  in setcontrast()  argument
937 	struct sd *sd = (struct sd *) gspca_dev;  in setcontrast()
940 		sccb_reg_write(gspca_dev, 0x56, val);	/* contras */  in setcontrast()
942 		sccb_reg_write(gspca_dev, 0x9c, val);  in setcontrast()
945 static void setgain(struct gspca_dev *gspca_dev, s32 val)  in setgain()  argument
965 	sccb_reg_write(gspca_dev, 0x00, val);  in setgain()
968 static s32 getgain(struct gspca_dev *gspca_dev)  in getgain()  argument
970 	return sccb_reg_read(gspca_dev, 0x00);  in getgain()
973 static void setexposure(struct gspca_dev *gspca_dev, s32 val)  in setexposure()  argument
975 	struct sd *sd = (struct sd *) gspca_dev;  in setexposure()
980 		sccb_reg_write(gspca_dev, 0x10, val);	/* aech */  in setexposure()
989 		sccb_reg_write(gspca_dev, 0x08, val >> 7);  in setexposure()
990 		sccb_reg_write(gspca_dev, 0x10, val << 1);  in setexposure()
994 static s32 getexposure(struct gspca_dev *gspca_dev)  in getexposure()  argument
996 	struct sd *sd = (struct sd *) gspca_dev;  in getexposure()
1000 		return sccb_reg_read(gspca_dev, 0x10);	/* aech */  in getexposure()
1002 		u8 hi = sccb_reg_read(gspca_dev, 0x08);  in getexposure()
1003 		u8 lo = sccb_reg_read(gspca_dev, 0x10);  in getexposure()
1008 static void setagc(struct gspca_dev *gspca_dev, s32 val)  in setagc()  argument
1011 		sccb_reg_write(gspca_dev, 0x13,  in setagc()
1012 				sccb_reg_read(gspca_dev, 0x13) | 0x04);  in setagc()
1013 		sccb_reg_write(gspca_dev, 0x64,  in setagc()
1014 				sccb_reg_read(gspca_dev, 0x64) | 0x03);  in setagc()
1016 		sccb_reg_write(gspca_dev, 0x13,  in setagc()
1017 				sccb_reg_read(gspca_dev, 0x13) & ~0x04);  in setagc()
1018 		sccb_reg_write(gspca_dev, 0x64,  in setagc()
1019 				sccb_reg_read(gspca_dev, 0x64) & ~0x03);  in setagc()
1023 static void setawb(struct gspca_dev *gspca_dev, s32 val)  in setawb()  argument
1025 	struct sd *sd = (struct sd *) gspca_dev;  in setawb()
1028 		sccb_reg_write(gspca_dev, 0x13,  in setawb()
1029 				sccb_reg_read(gspca_dev, 0x13) | 0x02);  in setawb()
1031 			sccb_reg_write(gspca_dev, 0x63,  in setawb()
1032 				sccb_reg_read(gspca_dev, 0x63) | 0xc0);  in setawb()
1034 		sccb_reg_write(gspca_dev, 0x13,  in setawb()
1035 				sccb_reg_read(gspca_dev, 0x13) & ~0x02);  in setawb()
1037 			sccb_reg_write(gspca_dev, 0x63,  in setawb()
1038 				sccb_reg_read(gspca_dev, 0x63) & ~0xc0);  in setawb()
1042 static void setaec(struct gspca_dev *gspca_dev, s32 val)  in setaec()  argument
1044 	struct sd *sd = (struct sd *) gspca_dev;  in setaec()
1052 		sccb_reg_write(gspca_dev, 0x13,  in setaec()
1053 				sccb_reg_read(gspca_dev, 0x13) | data);  in setaec()
1056 		sccb_reg_write(gspca_dev, 0x13,  in setaec()
1057 				sccb_reg_read(gspca_dev, 0x13) & ~data);  in setaec()
1062 static void setsharpness(struct gspca_dev *gspca_dev, s32 val)  in setsharpness()  argument
1064 	sccb_reg_write(gspca_dev, 0x91, val);	/* Auto de-noise threshold */  in setsharpness()
1065 	sccb_reg_write(gspca_dev, 0x8e, val);	/* De-noise threshold */  in setsharpness()
1068 static void sethvflip(struct gspca_dev *gspca_dev, s32 hflip, s32 vflip)  in sethvflip()  argument
1070 	struct sd *sd = (struct sd *) gspca_dev;  in sethvflip()
1074 		val = sccb_reg_read(gspca_dev, 0x1e);	/* mvfp */  in sethvflip()
1080 		sccb_reg_write(gspca_dev, 0x1e, val);  in sethvflip()
1082 		val = sccb_reg_read(gspca_dev, 0x0c);  in sethvflip()
1088 		sccb_reg_write(gspca_dev, 0x0c, val);  in sethvflip()
1092 static void setlightfreq(struct gspca_dev *gspca_dev, s32 val)  in setlightfreq()  argument
1094 	struct sd *sd = (struct sd *) gspca_dev;  in setlightfreq()
1098 		sccb_reg_write(gspca_dev, 0x2a, 0x00);  in setlightfreq()
1102 	sccb_reg_write(gspca_dev, 0x2b, val);  in setlightfreq()
1107 static int sd_config(struct gspca_dev *gspca_dev,  in sd_config()  argument
1110 	struct sd *sd = (struct sd *) gspca_dev;  in sd_config()
1113 	cam = &gspca_dev->cam;  in sd_config()
1126 	struct gspca_dev *gspca_dev = &sd->gspca_dev;  in ov534_g_volatile_ctrl()  local
1130 		gspca_dev->usb_err = 0;  in ov534_g_volatile_ctrl()
1131 		if (ctrl->val && sd->gain && gspca_dev->streaming)  in ov534_g_volatile_ctrl()
1132 			sd->gain->val = getgain(gspca_dev);  in ov534_g_volatile_ctrl()
1133 		return gspca_dev->usb_err;  in ov534_g_volatile_ctrl()
1136 		gspca_dev->usb_err = 0;  in ov534_g_volatile_ctrl()
1138 		    gspca_dev->streaming)  in ov534_g_volatile_ctrl()
1139 			sd->exposure->val = getexposure(gspca_dev);  in ov534_g_volatile_ctrl()
1140 		return gspca_dev->usb_err;  in ov534_g_volatile_ctrl()
1148 	struct gspca_dev *gspca_dev = &sd->gspca_dev;  in ov534_s_ctrl()  local
1150 	gspca_dev->usb_err = 0;  in ov534_s_ctrl()
1151 	if (!gspca_dev->streaming)  in ov534_s_ctrl()
1156 		sethue(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1159 		setsaturation(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1162 		setbrightness(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1165 		setcontrast(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1169 		setagc(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1170 		if (!gspca_dev->usb_err && !ctrl->val && sd->gain)  in ov534_s_ctrl()
1171 			setgain(gspca_dev, sd->gain->val);  in ov534_s_ctrl()
1174 		setawb(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1178 		setaec(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1179 		if (!gspca_dev->usb_err && ctrl->val == V4L2_EXPOSURE_MANUAL &&  in ov534_s_ctrl()
1181 			setexposure(gspca_dev, sd->exposure->val);  in ov534_s_ctrl()
1184 		setsharpness(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1187 		sethvflip(gspca_dev, ctrl->val, sd->vflip->val);  in ov534_s_ctrl()
1190 		sethvflip(gspca_dev, sd->hflip->val, ctrl->val);  in ov534_s_ctrl()
1193 		setlightfreq(gspca_dev, ctrl->val);  in ov534_s_ctrl()
1196 	return gspca_dev->usb_err;  in ov534_s_ctrl()
1204 static int sd_init_controls(struct gspca_dev *gspca_dev)  in sd_init_controls()  argument
1206 	struct sd *sd = (struct sd *) gspca_dev;  in sd_init_controls()
1250 	gspca_dev->vdev.ctrl_handler = hdl;  in sd_init_controls()
1313 static int sd_init(struct gspca_dev *gspca_dev)  in sd_init()  argument
1315 	struct sd *sd = (struct sd *) gspca_dev;  in sd_init()
1327 	ov534_reg_write(gspca_dev, 0xe7, 0x3a);  in sd_init()
1328 	ov534_reg_write(gspca_dev, 0xe0, 0x08);  in sd_init()
1332 	ov534_reg_write(gspca_dev, OV534_REG_ADDRESS, 0x42);  in sd_init()
1335 	sccb_reg_write(gspca_dev, 0x12, 0x80);  in sd_init()
1339 	sccb_reg_read(gspca_dev, 0x0a);  in sd_init()
1340 	sensor_id = sccb_reg_read(gspca_dev, 0x0a) << 8;  in sd_init()
1341 	sccb_reg_read(gspca_dev, 0x0b);  in sd_init()
1342 	sensor_id |= sccb_reg_read(gspca_dev, 0x0b);  in sd_init()
1343 	gspca_dbg(gspca_dev, D_PROBE, "Sensor ID: %04x\n", sensor_id);  in sd_init()
1347 		gspca_dev->cam.cam_mode = ov767x_mode;  in sd_init()
1348 		gspca_dev->cam.nmodes = ARRAY_SIZE(ov767x_mode);  in sd_init()
1351 		gspca_dev->cam.bulk = 1;  in sd_init()
1352 		gspca_dev->cam.bulk_size = 16384;  in sd_init()
1353 		gspca_dev->cam.bulk_nurbs = 2;  in sd_init()
1354 		gspca_dev->cam.mode_framerates = ov772x_framerates;  in sd_init()
1358 	reg_w_array(gspca_dev, bridge_init[sd->sensor].val,  in sd_init()
1360 	ov534_set_led(gspca_dev, 1);  in sd_init()
1361 	sccb_w_array(gspca_dev, sensor_init[sd->sensor].val,  in sd_init()
1364 	sd_stopN(gspca_dev);  in sd_init()
1367 	return gspca_dev->usb_err;  in sd_init()
1370 static int sd_start(struct gspca_dev *gspca_dev)  in sd_start()  argument
1372 	struct sd *sd = (struct sd *) gspca_dev;  in sd_start()
1405 		sccb_reg_write(gspca_dev, 0x1e, 0x04);  in sd_start()
1408 	mode = gspca_dev->curr_mode;	/* 0: 320x240, 1: 640x480 */  in sd_start()
1409 	reg_w_array(gspca_dev, bridge_start[sd->sensor][mode].val,  in sd_start()
1411 	sccb_w_array(gspca_dev, sensor_start[sd->sensor][mode].val,  in sd_start()
1414 	set_frame_rate(gspca_dev);  in sd_start()
1417 		sethue(gspca_dev, v4l2_ctrl_g_ctrl(sd->hue));  in sd_start()
1418 	setsaturation(gspca_dev, v4l2_ctrl_g_ctrl(sd->saturation));  in sd_start()
1420 		setagc(gspca_dev, v4l2_ctrl_g_ctrl(sd->autogain));  in sd_start()
1421 	setawb(gspca_dev, v4l2_ctrl_g_ctrl(sd->autowhitebalance));  in sd_start()
1422 	setaec(gspca_dev, v4l2_ctrl_g_ctrl(sd->autoexposure));  in sd_start()
1424 		setgain(gspca_dev, v4l2_ctrl_g_ctrl(sd->gain));  in sd_start()
1425 	setexposure(gspca_dev, v4l2_ctrl_g_ctrl(sd->exposure));  in sd_start()
1426 	setbrightness(gspca_dev, v4l2_ctrl_g_ctrl(sd->brightness));  in sd_start()
1427 	setcontrast(gspca_dev, v4l2_ctrl_g_ctrl(sd->contrast));  in sd_start()
1429 		setsharpness(gspca_dev, v4l2_ctrl_g_ctrl(sd->sharpness));  in sd_start()
1430 	sethvflip(gspca_dev, v4l2_ctrl_g_ctrl(sd->hflip),  in sd_start()
1432 	setlightfreq(gspca_dev, v4l2_ctrl_g_ctrl(sd->plfreq));  in sd_start()
1434 	ov534_set_led(gspca_dev, 1);  in sd_start()
1435 	ov534_reg_write(gspca_dev, 0xe0, 0x00);  in sd_start()
1436 	return gspca_dev->usb_err;  in sd_start()
1439 static void sd_stopN(struct gspca_dev *gspca_dev)  in sd_stopN()  argument
1441 	ov534_reg_write(gspca_dev, 0xe0, 0x09);  in sd_stopN()
1442 	ov534_set_led(gspca_dev, 0);  in sd_stopN()
1455 static void sd_pkt_scan(struct gspca_dev *gspca_dev,  in sd_pkt_scan()  argument
1458 	struct sd *sd = (struct sd *) gspca_dev;  in sd_pkt_scan()
1464 	payload_len = gspca_dev->cam.bulk ? 2048 : 2040;  in sd_pkt_scan()
1475 			gspca_dbg(gspca_dev, D_PACK, "bad header\n");  in sd_pkt_scan()
1481 			gspca_dbg(gspca_dev, D_PACK, "payload error\n");  in sd_pkt_scan()
1487 			gspca_dbg(gspca_dev, D_PACK, "PTS not present\n");  in sd_pkt_scan()
1496 			if (gspca_dev->last_packet_type == INTER_PACKET)  in sd_pkt_scan()
1497 				gspca_frame_add(gspca_dev, LAST_PACKET,  in sd_pkt_scan()
1501 			gspca_frame_add(gspca_dev, FIRST_PACKET,  in sd_pkt_scan()
1506 			if (gspca_dev->pixfmt.pixelformat != V4L2_PIX_FMT_JPEG  in sd_pkt_scan()
1507 			 && gspca_dev->image_len + len - 12 !=  in sd_pkt_scan()
1508 			    gspca_dev->pixfmt.sizeimage) {  in sd_pkt_scan()
1509 				gspca_dbg(gspca_dev, D_PACK, "wrong sized frame\n");  in sd_pkt_scan()
1512 			gspca_frame_add(gspca_dev, LAST_PACKET,  in sd_pkt_scan()
1517 			gspca_frame_add(gspca_dev, INTER_PACKET,  in sd_pkt_scan()
1526 		gspca_dev->last_packet_type = DISCARD_PACKET;  in sd_pkt_scan()
1535 static void sd_get_streamparm(struct gspca_dev *gspca_dev,  in sd_get_streamparm()  argument
1540 	struct sd *sd = (struct sd *) gspca_dev;  in sd_get_streamparm()
1547 static void sd_set_streamparm(struct gspca_dev *gspca_dev,  in sd_set_streamparm()  argument
1552 	struct sd *sd = (struct sd *) gspca_dev;  in sd_set_streamparm()
1559 	if (gspca_dev->streaming)  in sd_set_streamparm()
1560 		set_frame_rate(gspca_dev);  in sd_set_streamparm()