xref: /OK3568_Linux_fs/kernel/drivers/media/usb/gspca/se401.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * GSPCA Endpoints (formerly known as AOX) se401 USB Camera sub Driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2011 Hans de Goede <hdegoede@redhat.com>
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Based on the v4l1 se401 driver which is:
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Copyright (c) 2000 Jeroen B. Vreeken (pe1rxq@amsat.org)
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun #define MODULE_NAME "se401"
15*4882a593Smuzhiyun 
16*4882a593Smuzhiyun #define BULK_SIZE 4096
17*4882a593Smuzhiyun #define PACKET_SIZE 1024
18*4882a593Smuzhiyun #define READ_REQ_SIZE 64
19*4882a593Smuzhiyun #define MAX_MODES ((READ_REQ_SIZE - 6) / 4)
20*4882a593Smuzhiyun /* The se401 compression algorithm uses a fixed quant factor, which
21*4882a593Smuzhiyun    can be configured by setting the high nibble of the SE401_OPERATINGMODE
22*4882a593Smuzhiyun    feature. This needs to exactly match what is in libv4l! */
23*4882a593Smuzhiyun #define SE401_QUANT_FACT 8
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun #include <linux/input.h>
26*4882a593Smuzhiyun #include <linux/slab.h>
27*4882a593Smuzhiyun #include "gspca.h"
28*4882a593Smuzhiyun #include "se401.h"
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
31*4882a593Smuzhiyun MODULE_DESCRIPTION("Endpoints se401");
32*4882a593Smuzhiyun MODULE_LICENSE("GPL");
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun /* exposure change state machine states */
35*4882a593Smuzhiyun enum {
36*4882a593Smuzhiyun 	EXPO_CHANGED,
37*4882a593Smuzhiyun 	EXPO_DROP_FRAME,
38*4882a593Smuzhiyun 	EXPO_NO_CHANGE,
39*4882a593Smuzhiyun };
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun /* specific webcam descriptor */
42*4882a593Smuzhiyun struct sd {
43*4882a593Smuzhiyun 	struct gspca_dev gspca_dev;	/* !! must be the first item */
44*4882a593Smuzhiyun 	struct { /* exposure/freq control cluster */
45*4882a593Smuzhiyun 		struct v4l2_ctrl *exposure;
46*4882a593Smuzhiyun 		struct v4l2_ctrl *freq;
47*4882a593Smuzhiyun 	};
48*4882a593Smuzhiyun 	bool has_brightness;
49*4882a593Smuzhiyun 	struct v4l2_pix_format fmts[MAX_MODES];
50*4882a593Smuzhiyun 	int pixels_read;
51*4882a593Smuzhiyun 	int packet_read;
52*4882a593Smuzhiyun 	u8 packet[PACKET_SIZE];
53*4882a593Smuzhiyun 	u8 restart_stream;
54*4882a593Smuzhiyun 	u8 button_state;
55*4882a593Smuzhiyun 	u8 resetlevel;
56*4882a593Smuzhiyun 	u8 resetlevel_frame_count;
57*4882a593Smuzhiyun 	int resetlevel_adjust_dir;
58*4882a593Smuzhiyun 	int expo_change_state;
59*4882a593Smuzhiyun };
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun 
se401_write_req(struct gspca_dev * gspca_dev,u16 req,u16 value,int silent)62*4882a593Smuzhiyun static void se401_write_req(struct gspca_dev *gspca_dev, u16 req, u16 value,
63*4882a593Smuzhiyun 			    int silent)
64*4882a593Smuzhiyun {
65*4882a593Smuzhiyun 	int err;
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 	if (gspca_dev->usb_err < 0)
68*4882a593Smuzhiyun 		return;
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	err = usb_control_msg(gspca_dev->dev,
71*4882a593Smuzhiyun 			      usb_sndctrlpipe(gspca_dev->dev, 0), req,
72*4882a593Smuzhiyun 			      USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
73*4882a593Smuzhiyun 			      value, 0, NULL, 0, 1000);
74*4882a593Smuzhiyun 	if (err < 0) {
75*4882a593Smuzhiyun 		if (!silent)
76*4882a593Smuzhiyun 			pr_err("write req failed req %#04x val %#04x error %d\n",
77*4882a593Smuzhiyun 			       req, value, err);
78*4882a593Smuzhiyun 		gspca_dev->usb_err = err;
79*4882a593Smuzhiyun 	}
80*4882a593Smuzhiyun }
81*4882a593Smuzhiyun 
se401_read_req(struct gspca_dev * gspca_dev,u16 req,int silent)82*4882a593Smuzhiyun static void se401_read_req(struct gspca_dev *gspca_dev, u16 req, int silent)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun 	int err;
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun 	if (gspca_dev->usb_err < 0)
87*4882a593Smuzhiyun 		return;
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun 	if (USB_BUF_SZ < READ_REQ_SIZE) {
90*4882a593Smuzhiyun 		pr_err("USB_BUF_SZ too small!!\n");
91*4882a593Smuzhiyun 		gspca_dev->usb_err = -ENOBUFS;
92*4882a593Smuzhiyun 		return;
93*4882a593Smuzhiyun 	}
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun 	err = usb_control_msg(gspca_dev->dev,
96*4882a593Smuzhiyun 			      usb_rcvctrlpipe(gspca_dev->dev, 0), req,
97*4882a593Smuzhiyun 			      USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
98*4882a593Smuzhiyun 			      0, 0, gspca_dev->usb_buf, READ_REQ_SIZE, 1000);
99*4882a593Smuzhiyun 	if (err < 0) {
100*4882a593Smuzhiyun 		if (!silent)
101*4882a593Smuzhiyun 			pr_err("read req failed req %#04x error %d\n",
102*4882a593Smuzhiyun 			       req, err);
103*4882a593Smuzhiyun 		gspca_dev->usb_err = err;
104*4882a593Smuzhiyun 		/*
105*4882a593Smuzhiyun 		 * Make sure the buffer is zeroed to avoid uninitialized
106*4882a593Smuzhiyun 		 * values.
107*4882a593Smuzhiyun 		 */
108*4882a593Smuzhiyun 		memset(gspca_dev->usb_buf, 0, READ_REQ_SIZE);
109*4882a593Smuzhiyun 	}
110*4882a593Smuzhiyun }
111*4882a593Smuzhiyun 
se401_set_feature(struct gspca_dev * gspca_dev,u16 selector,u16 param)112*4882a593Smuzhiyun static void se401_set_feature(struct gspca_dev *gspca_dev,
113*4882a593Smuzhiyun 			      u16 selector, u16 param)
114*4882a593Smuzhiyun {
115*4882a593Smuzhiyun 	int err;
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 	if (gspca_dev->usb_err < 0)
118*4882a593Smuzhiyun 		return;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	err = usb_control_msg(gspca_dev->dev,
121*4882a593Smuzhiyun 			      usb_sndctrlpipe(gspca_dev->dev, 0),
122*4882a593Smuzhiyun 			      SE401_REQ_SET_EXT_FEATURE,
123*4882a593Smuzhiyun 			      USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
124*4882a593Smuzhiyun 			      param, selector, NULL, 0, 1000);
125*4882a593Smuzhiyun 	if (err < 0) {
126*4882a593Smuzhiyun 		pr_err("set feature failed sel %#04x param %#04x error %d\n",
127*4882a593Smuzhiyun 		       selector, param, err);
128*4882a593Smuzhiyun 		gspca_dev->usb_err = err;
129*4882a593Smuzhiyun 	}
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun 
se401_get_feature(struct gspca_dev * gspca_dev,u16 selector)132*4882a593Smuzhiyun static int se401_get_feature(struct gspca_dev *gspca_dev, u16 selector)
133*4882a593Smuzhiyun {
134*4882a593Smuzhiyun 	int err;
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun 	if (gspca_dev->usb_err < 0)
137*4882a593Smuzhiyun 		return gspca_dev->usb_err;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	if (USB_BUF_SZ < 2) {
140*4882a593Smuzhiyun 		pr_err("USB_BUF_SZ too small!!\n");
141*4882a593Smuzhiyun 		gspca_dev->usb_err = -ENOBUFS;
142*4882a593Smuzhiyun 		return gspca_dev->usb_err;
143*4882a593Smuzhiyun 	}
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 	err = usb_control_msg(gspca_dev->dev,
146*4882a593Smuzhiyun 			      usb_rcvctrlpipe(gspca_dev->dev, 0),
147*4882a593Smuzhiyun 			      SE401_REQ_GET_EXT_FEATURE,
148*4882a593Smuzhiyun 			      USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
149*4882a593Smuzhiyun 			      0, selector, gspca_dev->usb_buf, 2, 1000);
150*4882a593Smuzhiyun 	if (err < 0) {
151*4882a593Smuzhiyun 		pr_err("get feature failed sel %#04x error %d\n",
152*4882a593Smuzhiyun 		       selector, err);
153*4882a593Smuzhiyun 		gspca_dev->usb_err = err;
154*4882a593Smuzhiyun 		return err;
155*4882a593Smuzhiyun 	}
156*4882a593Smuzhiyun 	return gspca_dev->usb_buf[0] | (gspca_dev->usb_buf[1] << 8);
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun 
setbrightness(struct gspca_dev * gspca_dev,s32 val)159*4882a593Smuzhiyun static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun 	/* HDG: this does not seem to do anything on my cam */
162*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_SET_BRT, val, 0);
163*4882a593Smuzhiyun }
164*4882a593Smuzhiyun 
setgain(struct gspca_dev * gspca_dev,s32 val)165*4882a593Smuzhiyun static void setgain(struct gspca_dev *gspca_dev, s32 val)
166*4882a593Smuzhiyun {
167*4882a593Smuzhiyun 	u16 gain = 63 - val;
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	/* red color gain */
170*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_ARCG, gain);
171*4882a593Smuzhiyun 	/* green color gain */
172*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_AGCG, gain);
173*4882a593Smuzhiyun 	/* blue color gain */
174*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_ABCG, gain);
175*4882a593Smuzhiyun }
176*4882a593Smuzhiyun 
setexposure(struct gspca_dev * gspca_dev,s32 val,s32 freq)177*4882a593Smuzhiyun static void setexposure(struct gspca_dev *gspca_dev, s32 val, s32 freq)
178*4882a593Smuzhiyun {
179*4882a593Smuzhiyun 	struct sd *sd = (struct sd *) gspca_dev;
180*4882a593Smuzhiyun 	int integration = val << 6;
181*4882a593Smuzhiyun 	u8 expose_h, expose_m, expose_l;
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	/* Do this before the set_feature calls, for proper timing wrt
184*4882a593Smuzhiyun 	   the interrupt driven pkt_scan. Note we may still race but that
185*4882a593Smuzhiyun 	   is not a big issue, the expo change state machine is merely for
186*4882a593Smuzhiyun 	   avoiding underexposed frames getting send out, if one sneaks
187*4882a593Smuzhiyun 	   through so be it */
188*4882a593Smuzhiyun 	sd->expo_change_state = EXPO_CHANGED;
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun 	if (freq == V4L2_CID_POWER_LINE_FREQUENCY_50HZ)
191*4882a593Smuzhiyun 		integration = integration - integration % 106667;
192*4882a593Smuzhiyun 	if (freq == V4L2_CID_POWER_LINE_FREQUENCY_60HZ)
193*4882a593Smuzhiyun 		integration = integration - integration % 88889;
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 	expose_h = (integration >> 16);
196*4882a593Smuzhiyun 	expose_m = (integration >> 8);
197*4882a593Smuzhiyun 	expose_l = integration;
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	/* integration time low */
200*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_TITL, expose_l);
201*4882a593Smuzhiyun 	/* integration time mid */
202*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_TITM, expose_m);
203*4882a593Smuzhiyun 	/* integration time high */
204*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_TITU, expose_h);
205*4882a593Smuzhiyun }
206*4882a593Smuzhiyun 
sd_config(struct gspca_dev * gspca_dev,const struct usb_device_id * id)207*4882a593Smuzhiyun static int sd_config(struct gspca_dev *gspca_dev,
208*4882a593Smuzhiyun 			const struct usb_device_id *id)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
211*4882a593Smuzhiyun 	struct cam *cam = &gspca_dev->cam;
212*4882a593Smuzhiyun 	u8 *cd = gspca_dev->usb_buf;
213*4882a593Smuzhiyun 	int i, j, n;
214*4882a593Smuzhiyun 	int widths[MAX_MODES], heights[MAX_MODES];
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	/* Read the camera descriptor */
217*4882a593Smuzhiyun 	se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 1);
218*4882a593Smuzhiyun 	if (gspca_dev->usb_err) {
219*4882a593Smuzhiyun 		/* Sometimes after being idle for a while the se401 won't
220*4882a593Smuzhiyun 		   respond and needs a good kicking  */
221*4882a593Smuzhiyun 		usb_reset_device(gspca_dev->dev);
222*4882a593Smuzhiyun 		gspca_dev->usb_err = 0;
223*4882a593Smuzhiyun 		se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 0);
224*4882a593Smuzhiyun 	}
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	/* Some cameras start with their LED on */
227*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0);
228*4882a593Smuzhiyun 	if (gspca_dev->usb_err)
229*4882a593Smuzhiyun 		return gspca_dev->usb_err;
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	if (cd[1] != 0x41) {
232*4882a593Smuzhiyun 		pr_err("Wrong descriptor type\n");
233*4882a593Smuzhiyun 		return -ENODEV;
234*4882a593Smuzhiyun 	}
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	if (!(cd[2] & SE401_FORMAT_BAYER)) {
237*4882a593Smuzhiyun 		pr_err("Bayer format not supported!\n");
238*4882a593Smuzhiyun 		return -ENODEV;
239*4882a593Smuzhiyun 	}
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 	if (cd[3])
242*4882a593Smuzhiyun 		pr_info("ExtraFeatures: %d\n", cd[3]);
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 	n = cd[4] | (cd[5] << 8);
245*4882a593Smuzhiyun 	if (n > MAX_MODES) {
246*4882a593Smuzhiyun 		pr_err("Too many frame sizes\n");
247*4882a593Smuzhiyun 		return -ENODEV;
248*4882a593Smuzhiyun 	}
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	for (i = 0; i < n ; i++) {
251*4882a593Smuzhiyun 		widths[i] = cd[6 + i * 4 + 0] | (cd[6 + i * 4 + 1] << 8);
252*4882a593Smuzhiyun 		heights[i] = cd[6 + i * 4 + 2] | (cd[6 + i * 4 + 3] << 8);
253*4882a593Smuzhiyun 	}
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	for (i = 0; i < n ; i++) {
256*4882a593Smuzhiyun 		sd->fmts[i].width = widths[i];
257*4882a593Smuzhiyun 		sd->fmts[i].height = heights[i];
258*4882a593Smuzhiyun 		sd->fmts[i].field = V4L2_FIELD_NONE;
259*4882a593Smuzhiyun 		sd->fmts[i].colorspace = V4L2_COLORSPACE_SRGB;
260*4882a593Smuzhiyun 		sd->fmts[i].priv = 1;
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 		/* janggu compression only works for 1/4th or 1/16th res */
263*4882a593Smuzhiyun 		for (j = 0; j < n; j++) {
264*4882a593Smuzhiyun 			if (widths[j] / 2 == widths[i] &&
265*4882a593Smuzhiyun 			    heights[j] / 2 == heights[i]) {
266*4882a593Smuzhiyun 				sd->fmts[i].priv = 2;
267*4882a593Smuzhiyun 				break;
268*4882a593Smuzhiyun 			}
269*4882a593Smuzhiyun 		}
270*4882a593Smuzhiyun 		/* 1/16th if available too is better then 1/4th, because
271*4882a593Smuzhiyun 		   we then use a larger area of the sensor */
272*4882a593Smuzhiyun 		for (j = 0; j < n; j++) {
273*4882a593Smuzhiyun 			if (widths[j] / 4 == widths[i] &&
274*4882a593Smuzhiyun 			    heights[j] / 4 == heights[i]) {
275*4882a593Smuzhiyun 				sd->fmts[i].priv = 4;
276*4882a593Smuzhiyun 				break;
277*4882a593Smuzhiyun 			}
278*4882a593Smuzhiyun 		}
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 		if (sd->fmts[i].priv == 1) {
281*4882a593Smuzhiyun 			/* Not a 1/4th or 1/16th res, use bayer */
282*4882a593Smuzhiyun 			sd->fmts[i].pixelformat = V4L2_PIX_FMT_SBGGR8;
283*4882a593Smuzhiyun 			sd->fmts[i].bytesperline = widths[i];
284*4882a593Smuzhiyun 			sd->fmts[i].sizeimage = widths[i] * heights[i];
285*4882a593Smuzhiyun 			pr_info("Frame size: %dx%d bayer\n",
286*4882a593Smuzhiyun 				widths[i], heights[i]);
287*4882a593Smuzhiyun 		} else {
288*4882a593Smuzhiyun 			/* Found a match use janggu compression */
289*4882a593Smuzhiyun 			sd->fmts[i].pixelformat = V4L2_PIX_FMT_SE401;
290*4882a593Smuzhiyun 			sd->fmts[i].bytesperline = 0;
291*4882a593Smuzhiyun 			sd->fmts[i].sizeimage = widths[i] * heights[i] * 3;
292*4882a593Smuzhiyun 			pr_info("Frame size: %dx%d 1/%dth janggu\n",
293*4882a593Smuzhiyun 				widths[i], heights[i],
294*4882a593Smuzhiyun 				sd->fmts[i].priv * sd->fmts[i].priv);
295*4882a593Smuzhiyun 		}
296*4882a593Smuzhiyun 	}
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun 	cam->cam_mode = sd->fmts;
299*4882a593Smuzhiyun 	cam->nmodes = n;
300*4882a593Smuzhiyun 	cam->bulk = 1;
301*4882a593Smuzhiyun 	cam->bulk_size = BULK_SIZE;
302*4882a593Smuzhiyun 	cam->bulk_nurbs = 4;
303*4882a593Smuzhiyun 	sd->resetlevel = 0x2d; /* Set initial resetlevel */
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	/* See if the camera supports brightness */
306*4882a593Smuzhiyun 	se401_read_req(gspca_dev, SE401_REQ_GET_BRT, 1);
307*4882a593Smuzhiyun 	sd->has_brightness = !!gspca_dev->usb_err;
308*4882a593Smuzhiyun 	gspca_dev->usb_err = 0;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	return 0;
311*4882a593Smuzhiyun }
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun /* this function is called at probe and resume time */
sd_init(struct gspca_dev * gspca_dev)314*4882a593Smuzhiyun static int sd_init(struct gspca_dev *gspca_dev)
315*4882a593Smuzhiyun {
316*4882a593Smuzhiyun 	return 0;
317*4882a593Smuzhiyun }
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun /* function called at start time before URB creation */
sd_isoc_init(struct gspca_dev * gspca_dev)320*4882a593Smuzhiyun static int sd_isoc_init(struct gspca_dev *gspca_dev)
321*4882a593Smuzhiyun {
322*4882a593Smuzhiyun 	gspca_dev->alt = 1;	/* Ignore the bogus isoc alt settings */
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	return gspca_dev->usb_err;
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun /* -- start the camera -- */
sd_start(struct gspca_dev * gspca_dev)328*4882a593Smuzhiyun static int sd_start(struct gspca_dev *gspca_dev)
329*4882a593Smuzhiyun {
330*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
331*4882a593Smuzhiyun 	int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
332*4882a593Smuzhiyun 	int mode = 0;
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 1);
335*4882a593Smuzhiyun 	if (gspca_dev->usb_err) {
336*4882a593Smuzhiyun 		/* Sometimes after being idle for a while the se401 won't
337*4882a593Smuzhiyun 		   respond and needs a good kicking  */
338*4882a593Smuzhiyun 		usb_reset_device(gspca_dev->dev);
339*4882a593Smuzhiyun 		gspca_dev->usb_err = 0;
340*4882a593Smuzhiyun 		se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 0);
341*4882a593Smuzhiyun 	}
342*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 1, 0);
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_MODE_B, 0x05);
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun 	/* set size + mode */
347*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_SET_WIDTH,
348*4882a593Smuzhiyun 			gspca_dev->pixfmt.width * mult, 0);
349*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_SET_HEIGHT,
350*4882a593Smuzhiyun 			gspca_dev->pixfmt.height * mult, 0);
351*4882a593Smuzhiyun 	/*
352*4882a593Smuzhiyun 	 * HDG: disabled this as it does not seem to do anything
353*4882a593Smuzhiyun 	 * se401_write_req(gspca_dev, SE401_REQ_SET_OUTPUT_MODE,
354*4882a593Smuzhiyun 	 *		   SE401_FORMAT_BAYER, 0);
355*4882a593Smuzhiyun 	 */
356*4882a593Smuzhiyun 
357*4882a593Smuzhiyun 	switch (mult) {
358*4882a593Smuzhiyun 	case 1: /* Raw bayer */
359*4882a593Smuzhiyun 		mode = 0x03; break;
360*4882a593Smuzhiyun 	case 2: /* 1/4th janggu */
361*4882a593Smuzhiyun 		mode = SE401_QUANT_FACT << 4; break;
362*4882a593Smuzhiyun 	case 4: /* 1/16th janggu */
363*4882a593Smuzhiyun 		mode = (SE401_QUANT_FACT << 4) | 0x02; break;
364*4882a593Smuzhiyun 	}
365*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, SE401_OPERATINGMODE, mode);
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel);
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 	sd->packet_read = 0;
370*4882a593Smuzhiyun 	sd->pixels_read = 0;
371*4882a593Smuzhiyun 	sd->restart_stream = 0;
372*4882a593Smuzhiyun 	sd->resetlevel_frame_count = 0;
373*4882a593Smuzhiyun 	sd->resetlevel_adjust_dir = 0;
374*4882a593Smuzhiyun 	sd->expo_change_state = EXPO_NO_CHANGE;
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_START_CONTINUOUS_CAPTURE, 0, 0);
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	return gspca_dev->usb_err;
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun 
sd_stopN(struct gspca_dev * gspca_dev)381*4882a593Smuzhiyun static void sd_stopN(struct gspca_dev *gspca_dev)
382*4882a593Smuzhiyun {
383*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_STOP_CONTINUOUS_CAPTURE, 0, 0);
384*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0);
385*4882a593Smuzhiyun 	se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 0, 0);
386*4882a593Smuzhiyun }
387*4882a593Smuzhiyun 
sd_dq_callback(struct gspca_dev * gspca_dev)388*4882a593Smuzhiyun static void sd_dq_callback(struct gspca_dev *gspca_dev)
389*4882a593Smuzhiyun {
390*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
391*4882a593Smuzhiyun 	unsigned int ahrc, alrc;
392*4882a593Smuzhiyun 	int oldreset, adjust_dir;
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 	/* Restart the stream if requested do so by pkt_scan */
395*4882a593Smuzhiyun 	if (sd->restart_stream) {
396*4882a593Smuzhiyun 		sd_stopN(gspca_dev);
397*4882a593Smuzhiyun 		sd_start(gspca_dev);
398*4882a593Smuzhiyun 		sd->restart_stream = 0;
399*4882a593Smuzhiyun 	}
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 	/* Automatically adjust sensor reset level
402*4882a593Smuzhiyun 	   Hyundai have some really nice docs about this and other sensor
403*4882a593Smuzhiyun 	   related stuff on their homepage: www.hei.co.kr */
404*4882a593Smuzhiyun 	sd->resetlevel_frame_count++;
405*4882a593Smuzhiyun 	if (sd->resetlevel_frame_count < 20)
406*4882a593Smuzhiyun 		return;
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 	/* For some reason this normally read-only register doesn't get reset
409*4882a593Smuzhiyun 	   to zero after reading them just once... */
410*4882a593Smuzhiyun 	se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH);
411*4882a593Smuzhiyun 	se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL);
412*4882a593Smuzhiyun 	se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH);
413*4882a593Smuzhiyun 	se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL);
414*4882a593Smuzhiyun 	ahrc = 256*se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH) +
415*4882a593Smuzhiyun 	    se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL);
416*4882a593Smuzhiyun 	alrc = 256*se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH) +
417*4882a593Smuzhiyun 	    se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL);
418*4882a593Smuzhiyun 
419*4882a593Smuzhiyun 	/* Not an exact science, but it seems to work pretty well... */
420*4882a593Smuzhiyun 	oldreset = sd->resetlevel;
421*4882a593Smuzhiyun 	if (alrc > 10) {
422*4882a593Smuzhiyun 		while (alrc >= 10 && sd->resetlevel < 63) {
423*4882a593Smuzhiyun 			sd->resetlevel++;
424*4882a593Smuzhiyun 			alrc /= 2;
425*4882a593Smuzhiyun 		}
426*4882a593Smuzhiyun 	} else if (ahrc > 20) {
427*4882a593Smuzhiyun 		while (ahrc >= 20 && sd->resetlevel > 0) {
428*4882a593Smuzhiyun 			sd->resetlevel--;
429*4882a593Smuzhiyun 			ahrc /= 2;
430*4882a593Smuzhiyun 		}
431*4882a593Smuzhiyun 	}
432*4882a593Smuzhiyun 	/* Detect ping-pong-ing and halve adjustment to avoid overshoot */
433*4882a593Smuzhiyun 	if (sd->resetlevel > oldreset)
434*4882a593Smuzhiyun 		adjust_dir = 1;
435*4882a593Smuzhiyun 	else
436*4882a593Smuzhiyun 		adjust_dir = -1;
437*4882a593Smuzhiyun 	if (sd->resetlevel_adjust_dir &&
438*4882a593Smuzhiyun 	    sd->resetlevel_adjust_dir != adjust_dir)
439*4882a593Smuzhiyun 		sd->resetlevel = oldreset + (sd->resetlevel - oldreset) / 2;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	if (sd->resetlevel != oldreset) {
442*4882a593Smuzhiyun 		sd->resetlevel_adjust_dir = adjust_dir;
443*4882a593Smuzhiyun 		se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel);
444*4882a593Smuzhiyun 	}
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 	sd->resetlevel_frame_count = 0;
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun 
sd_complete_frame(struct gspca_dev * gspca_dev,u8 * data,int len)449*4882a593Smuzhiyun static void sd_complete_frame(struct gspca_dev *gspca_dev, u8 *data, int len)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	switch (sd->expo_change_state) {
454*4882a593Smuzhiyun 	case EXPO_CHANGED:
455*4882a593Smuzhiyun 		/* The exposure was changed while this frame
456*4882a593Smuzhiyun 		   was being send, so this frame is ok */
457*4882a593Smuzhiyun 		sd->expo_change_state = EXPO_DROP_FRAME;
458*4882a593Smuzhiyun 		break;
459*4882a593Smuzhiyun 	case EXPO_DROP_FRAME:
460*4882a593Smuzhiyun 		/* The exposure was changed while this frame
461*4882a593Smuzhiyun 		   was being captured, drop it! */
462*4882a593Smuzhiyun 		gspca_dev->last_packet_type = DISCARD_PACKET;
463*4882a593Smuzhiyun 		sd->expo_change_state = EXPO_NO_CHANGE;
464*4882a593Smuzhiyun 		break;
465*4882a593Smuzhiyun 	case EXPO_NO_CHANGE:
466*4882a593Smuzhiyun 		break;
467*4882a593Smuzhiyun 	}
468*4882a593Smuzhiyun 	gspca_frame_add(gspca_dev, LAST_PACKET, data, len);
469*4882a593Smuzhiyun }
470*4882a593Smuzhiyun 
sd_pkt_scan_janggu(struct gspca_dev * gspca_dev,u8 * data,int len)471*4882a593Smuzhiyun static void sd_pkt_scan_janggu(struct gspca_dev *gspca_dev, u8 *data, int len)
472*4882a593Smuzhiyun {
473*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
474*4882a593Smuzhiyun 	int imagesize = gspca_dev->pixfmt.width * gspca_dev->pixfmt.height;
475*4882a593Smuzhiyun 	int i, plen, bits, pixels, info, count;
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun 	if (sd->restart_stream)
478*4882a593Smuzhiyun 		return;
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun 	/* Sometimes a 1024 bytes garbage bulk packet is send between frames */
481*4882a593Smuzhiyun 	if (gspca_dev->last_packet_type == LAST_PACKET && len == 1024) {
482*4882a593Smuzhiyun 		gspca_dev->last_packet_type = DISCARD_PACKET;
483*4882a593Smuzhiyun 		return;
484*4882a593Smuzhiyun 	}
485*4882a593Smuzhiyun 
486*4882a593Smuzhiyun 	i = 0;
487*4882a593Smuzhiyun 	while (i < len) {
488*4882a593Smuzhiyun 		/* Read header if not already be present from prev bulk pkt */
489*4882a593Smuzhiyun 		if (sd->packet_read < 4) {
490*4882a593Smuzhiyun 			count = 4 - sd->packet_read;
491*4882a593Smuzhiyun 			if (count > len - i)
492*4882a593Smuzhiyun 				count = len - i;
493*4882a593Smuzhiyun 			memcpy(&sd->packet[sd->packet_read], &data[i], count);
494*4882a593Smuzhiyun 			sd->packet_read += count;
495*4882a593Smuzhiyun 			i += count;
496*4882a593Smuzhiyun 			if (sd->packet_read < 4)
497*4882a593Smuzhiyun 				break;
498*4882a593Smuzhiyun 		}
499*4882a593Smuzhiyun 		bits   = sd->packet[3] + (sd->packet[2] << 8);
500*4882a593Smuzhiyun 		pixels = sd->packet[1] + ((sd->packet[0] & 0x3f) << 8);
501*4882a593Smuzhiyun 		info   = (sd->packet[0] & 0xc0) >> 6;
502*4882a593Smuzhiyun 		plen   = ((bits + 47) >> 4) << 1;
503*4882a593Smuzhiyun 		/* Sanity checks */
504*4882a593Smuzhiyun 		if (plen > 1024) {
505*4882a593Smuzhiyun 			pr_err("invalid packet len %d restarting stream\n",
506*4882a593Smuzhiyun 			       plen);
507*4882a593Smuzhiyun 			goto error;
508*4882a593Smuzhiyun 		}
509*4882a593Smuzhiyun 		if (info == 3) {
510*4882a593Smuzhiyun 			pr_err("unknown frame info value restarting stream\n");
511*4882a593Smuzhiyun 			goto error;
512*4882a593Smuzhiyun 		}
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun 		/* Read (remainder of) packet contents */
515*4882a593Smuzhiyun 		count = plen - sd->packet_read;
516*4882a593Smuzhiyun 		if (count > len - i)
517*4882a593Smuzhiyun 			count = len - i;
518*4882a593Smuzhiyun 		memcpy(&sd->packet[sd->packet_read], &data[i], count);
519*4882a593Smuzhiyun 		sd->packet_read += count;
520*4882a593Smuzhiyun 		i += count;
521*4882a593Smuzhiyun 		if (sd->packet_read < plen)
522*4882a593Smuzhiyun 			break;
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 		sd->pixels_read += pixels;
525*4882a593Smuzhiyun 		sd->packet_read = 0;
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun 		switch (info) {
528*4882a593Smuzhiyun 		case 0: /* Frame data */
529*4882a593Smuzhiyun 			gspca_frame_add(gspca_dev, INTER_PACKET, sd->packet,
530*4882a593Smuzhiyun 					plen);
531*4882a593Smuzhiyun 			break;
532*4882a593Smuzhiyun 		case 1: /* EOF */
533*4882a593Smuzhiyun 			if (sd->pixels_read != imagesize) {
534*4882a593Smuzhiyun 				pr_err("frame size %d expected %d\n",
535*4882a593Smuzhiyun 				       sd->pixels_read, imagesize);
536*4882a593Smuzhiyun 				goto error;
537*4882a593Smuzhiyun 			}
538*4882a593Smuzhiyun 			sd_complete_frame(gspca_dev, sd->packet, plen);
539*4882a593Smuzhiyun 			return; /* Discard the rest of the bulk packet !! */
540*4882a593Smuzhiyun 		case 2: /* SOF */
541*4882a593Smuzhiyun 			gspca_frame_add(gspca_dev, FIRST_PACKET, sd->packet,
542*4882a593Smuzhiyun 					plen);
543*4882a593Smuzhiyun 			sd->pixels_read = pixels;
544*4882a593Smuzhiyun 			break;
545*4882a593Smuzhiyun 		}
546*4882a593Smuzhiyun 	}
547*4882a593Smuzhiyun 	return;
548*4882a593Smuzhiyun 
549*4882a593Smuzhiyun error:
550*4882a593Smuzhiyun 	sd->restart_stream = 1;
551*4882a593Smuzhiyun 	/* Give userspace a 0 bytes frame, so our dq callback gets
552*4882a593Smuzhiyun 	   called and it can restart the stream */
553*4882a593Smuzhiyun 	gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
554*4882a593Smuzhiyun 	gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
555*4882a593Smuzhiyun }
556*4882a593Smuzhiyun 
sd_pkt_scan_bayer(struct gspca_dev * gspca_dev,u8 * data,int len)557*4882a593Smuzhiyun static void sd_pkt_scan_bayer(struct gspca_dev *gspca_dev, u8 *data, int len)
558*4882a593Smuzhiyun {
559*4882a593Smuzhiyun 	struct cam *cam = &gspca_dev->cam;
560*4882a593Smuzhiyun 	int imagesize = cam->cam_mode[gspca_dev->curr_mode].sizeimage;
561*4882a593Smuzhiyun 
562*4882a593Smuzhiyun 	if (gspca_dev->image_len == 0) {
563*4882a593Smuzhiyun 		gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
564*4882a593Smuzhiyun 		return;
565*4882a593Smuzhiyun 	}
566*4882a593Smuzhiyun 
567*4882a593Smuzhiyun 	if (gspca_dev->image_len + len >= imagesize) {
568*4882a593Smuzhiyun 		sd_complete_frame(gspca_dev, data, len);
569*4882a593Smuzhiyun 		return;
570*4882a593Smuzhiyun 	}
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun 	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
573*4882a593Smuzhiyun }
574*4882a593Smuzhiyun 
sd_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)575*4882a593Smuzhiyun static void sd_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len)
576*4882a593Smuzhiyun {
577*4882a593Smuzhiyun 	int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	if (len == 0)
580*4882a593Smuzhiyun 		return;
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun 	if (mult == 1) /* mult == 1 means raw bayer */
583*4882a593Smuzhiyun 		sd_pkt_scan_bayer(gspca_dev, data, len);
584*4882a593Smuzhiyun 	else
585*4882a593Smuzhiyun 		sd_pkt_scan_janggu(gspca_dev, data, len);
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun #if IS_ENABLED(CONFIG_INPUT)
sd_int_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)589*4882a593Smuzhiyun static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len)
590*4882a593Smuzhiyun {
591*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
592*4882a593Smuzhiyun 	u8 state;
593*4882a593Smuzhiyun 
594*4882a593Smuzhiyun 	if (len != 2)
595*4882a593Smuzhiyun 		return -EINVAL;
596*4882a593Smuzhiyun 
597*4882a593Smuzhiyun 	switch (data[0]) {
598*4882a593Smuzhiyun 	case 0:
599*4882a593Smuzhiyun 	case 1:
600*4882a593Smuzhiyun 		state = data[0];
601*4882a593Smuzhiyun 		break;
602*4882a593Smuzhiyun 	default:
603*4882a593Smuzhiyun 		return -EINVAL;
604*4882a593Smuzhiyun 	}
605*4882a593Smuzhiyun 	if (sd->button_state != state) {
606*4882a593Smuzhiyun 		input_report_key(gspca_dev->input_dev, KEY_CAMERA, state);
607*4882a593Smuzhiyun 		input_sync(gspca_dev->input_dev);
608*4882a593Smuzhiyun 		sd->button_state = state;
609*4882a593Smuzhiyun 	}
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	return 0;
612*4882a593Smuzhiyun }
613*4882a593Smuzhiyun #endif
614*4882a593Smuzhiyun 
sd_s_ctrl(struct v4l2_ctrl * ctrl)615*4882a593Smuzhiyun static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
616*4882a593Smuzhiyun {
617*4882a593Smuzhiyun 	struct gspca_dev *gspca_dev =
618*4882a593Smuzhiyun 		container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
619*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun 	gspca_dev->usb_err = 0;
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	if (!gspca_dev->streaming)
624*4882a593Smuzhiyun 		return 0;
625*4882a593Smuzhiyun 
626*4882a593Smuzhiyun 	switch (ctrl->id) {
627*4882a593Smuzhiyun 	case V4L2_CID_BRIGHTNESS:
628*4882a593Smuzhiyun 		setbrightness(gspca_dev, ctrl->val);
629*4882a593Smuzhiyun 		break;
630*4882a593Smuzhiyun 	case V4L2_CID_GAIN:
631*4882a593Smuzhiyun 		setgain(gspca_dev, ctrl->val);
632*4882a593Smuzhiyun 		break;
633*4882a593Smuzhiyun 	case V4L2_CID_EXPOSURE:
634*4882a593Smuzhiyun 		setexposure(gspca_dev, ctrl->val, sd->freq->val);
635*4882a593Smuzhiyun 		break;
636*4882a593Smuzhiyun 	}
637*4882a593Smuzhiyun 	return gspca_dev->usb_err;
638*4882a593Smuzhiyun }
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun static const struct v4l2_ctrl_ops sd_ctrl_ops = {
641*4882a593Smuzhiyun 	.s_ctrl = sd_s_ctrl,
642*4882a593Smuzhiyun };
643*4882a593Smuzhiyun 
sd_init_controls(struct gspca_dev * gspca_dev)644*4882a593Smuzhiyun static int sd_init_controls(struct gspca_dev *gspca_dev)
645*4882a593Smuzhiyun {
646*4882a593Smuzhiyun 	struct sd *sd = (struct sd *)gspca_dev;
647*4882a593Smuzhiyun 	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	gspca_dev->vdev.ctrl_handler = hdl;
650*4882a593Smuzhiyun 	v4l2_ctrl_handler_init(hdl, 4);
651*4882a593Smuzhiyun 	if (sd->has_brightness)
652*4882a593Smuzhiyun 		v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
653*4882a593Smuzhiyun 			V4L2_CID_BRIGHTNESS, 0, 255, 1, 15);
654*4882a593Smuzhiyun 	/* max is really 63 but > 50 is not pretty */
655*4882a593Smuzhiyun 	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
656*4882a593Smuzhiyun 			V4L2_CID_GAIN, 0, 50, 1, 25);
657*4882a593Smuzhiyun 	sd->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
658*4882a593Smuzhiyun 			V4L2_CID_EXPOSURE, 0, 32767, 1, 15000);
659*4882a593Smuzhiyun 	sd->freq = v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
660*4882a593Smuzhiyun 			V4L2_CID_POWER_LINE_FREQUENCY,
661*4882a593Smuzhiyun 			V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 0, 0);
662*4882a593Smuzhiyun 
663*4882a593Smuzhiyun 	if (hdl->error) {
664*4882a593Smuzhiyun 		pr_err("Could not initialize controls\n");
665*4882a593Smuzhiyun 		return hdl->error;
666*4882a593Smuzhiyun 	}
667*4882a593Smuzhiyun 	v4l2_ctrl_cluster(2, &sd->exposure);
668*4882a593Smuzhiyun 	return 0;
669*4882a593Smuzhiyun }
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun /* sub-driver description */
672*4882a593Smuzhiyun static const struct sd_desc sd_desc = {
673*4882a593Smuzhiyun 	.name = MODULE_NAME,
674*4882a593Smuzhiyun 	.config = sd_config,
675*4882a593Smuzhiyun 	.init = sd_init,
676*4882a593Smuzhiyun 	.init_controls = sd_init_controls,
677*4882a593Smuzhiyun 	.isoc_init = sd_isoc_init,
678*4882a593Smuzhiyun 	.start = sd_start,
679*4882a593Smuzhiyun 	.stopN = sd_stopN,
680*4882a593Smuzhiyun 	.dq_callback = sd_dq_callback,
681*4882a593Smuzhiyun 	.pkt_scan = sd_pkt_scan,
682*4882a593Smuzhiyun #if IS_ENABLED(CONFIG_INPUT)
683*4882a593Smuzhiyun 	.int_pkt_scan = sd_int_pkt_scan,
684*4882a593Smuzhiyun #endif
685*4882a593Smuzhiyun };
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun /* -- module initialisation -- */
688*4882a593Smuzhiyun static const struct usb_device_id device_table[] = {
689*4882a593Smuzhiyun 	{USB_DEVICE(0x03e8, 0x0004)}, /* Endpoints/Aox SE401 */
690*4882a593Smuzhiyun 	{USB_DEVICE(0x0471, 0x030b)}, /* Philips PCVC665K */
691*4882a593Smuzhiyun 	{USB_DEVICE(0x047d, 0x5001)}, /* Kensington 67014 */
692*4882a593Smuzhiyun 	{USB_DEVICE(0x047d, 0x5002)}, /* Kensington 6701(5/7) */
693*4882a593Smuzhiyun 	{USB_DEVICE(0x047d, 0x5003)}, /* Kensington 67016 */
694*4882a593Smuzhiyun 	{}
695*4882a593Smuzhiyun };
696*4882a593Smuzhiyun MODULE_DEVICE_TABLE(usb, device_table);
697*4882a593Smuzhiyun 
698*4882a593Smuzhiyun /* -- device connect -- */
sd_probe(struct usb_interface * intf,const struct usb_device_id * id)699*4882a593Smuzhiyun static int sd_probe(struct usb_interface *intf,
700*4882a593Smuzhiyun 			const struct usb_device_id *id)
701*4882a593Smuzhiyun {
702*4882a593Smuzhiyun 	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
703*4882a593Smuzhiyun 				THIS_MODULE);
704*4882a593Smuzhiyun }
705*4882a593Smuzhiyun 
sd_pre_reset(struct usb_interface * intf)706*4882a593Smuzhiyun static int sd_pre_reset(struct usb_interface *intf)
707*4882a593Smuzhiyun {
708*4882a593Smuzhiyun 	return 0;
709*4882a593Smuzhiyun }
710*4882a593Smuzhiyun 
sd_post_reset(struct usb_interface * intf)711*4882a593Smuzhiyun static int sd_post_reset(struct usb_interface *intf)
712*4882a593Smuzhiyun {
713*4882a593Smuzhiyun 	return 0;
714*4882a593Smuzhiyun }
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun static struct usb_driver sd_driver = {
717*4882a593Smuzhiyun 	.name = MODULE_NAME,
718*4882a593Smuzhiyun 	.id_table = device_table,
719*4882a593Smuzhiyun 	.probe = sd_probe,
720*4882a593Smuzhiyun 	.disconnect = gspca_disconnect,
721*4882a593Smuzhiyun #ifdef CONFIG_PM
722*4882a593Smuzhiyun 	.suspend = gspca_suspend,
723*4882a593Smuzhiyun 	.resume = gspca_resume,
724*4882a593Smuzhiyun 	.reset_resume = gspca_resume,
725*4882a593Smuzhiyun #endif
726*4882a593Smuzhiyun 	.pre_reset = sd_pre_reset,
727*4882a593Smuzhiyun 	.post_reset = sd_post_reset,
728*4882a593Smuzhiyun };
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun module_usb_driver(sd_driver);
731