xref: /openbmc/linux/drivers/media/usb/gspca/spca500.c (revision fd9871f7)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * SPCA500 chip based cameras initialization data
4  *
5  * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
6  */
7 
8 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
9 
10 #define MODULE_NAME "spca500"
11 
12 #include "gspca.h"
13 #include "jpeg.h"
14 
15 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
16 MODULE_DESCRIPTION("GSPCA/SPCA500 USB Camera Driver");
17 MODULE_LICENSE("GPL");
18 
19 #define QUALITY 85
20 
21 /* specific webcam descriptor */
22 struct sd {
23 	struct gspca_dev gspca_dev;		/* !! must be the first item */
24 
25 	char subtype;
26 #define AgfaCl20 0
27 #define AiptekPocketDV 1
28 #define BenqDC1016 2
29 #define CreativePCCam300 3
30 #define DLinkDSC350 4
31 #define Gsmartmini 5
32 #define IntelPocketPCCamera 6
33 #define KodakEZ200 7
34 #define LogitechClickSmart310 8
35 #define LogitechClickSmart510 9
36 #define LogitechTraveler 10
37 #define MustekGsmart300 11
38 #define Optimedia 12
39 #define PalmPixDC85 13
40 #define ToptroIndus 14
41 
42 	u8 jpeg_hdr[JPEG_HDR_SZ];
43 };
44 
45 static const struct v4l2_pix_format vga_mode[] = {
46 	{320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
47 		.bytesperline = 320,
48 		.sizeimage = 320 * 240 * 3 / 8 + 590,
49 		.colorspace = V4L2_COLORSPACE_JPEG,
50 		.priv = 1},
51 	{640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
52 		.bytesperline = 640,
53 		.sizeimage = 640 * 480 * 3 / 8 + 590,
54 		.colorspace = V4L2_COLORSPACE_JPEG,
55 		.priv = 0},
56 };
57 
58 static const struct v4l2_pix_format sif_mode[] = {
59 	{176, 144, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
60 		.bytesperline = 176,
61 		.sizeimage = 176 * 144 * 3 / 8 + 590,
62 		.colorspace = V4L2_COLORSPACE_JPEG,
63 		.priv = 1},
64 	{352, 288, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
65 		.bytesperline = 352,
66 		.sizeimage = 352 * 288 * 3 / 8 + 590,
67 		.colorspace = V4L2_COLORSPACE_JPEG,
68 		.priv = 0},
69 };
70 
71 /* Frame packet header offsets for the spca500 */
72 #define SPCA500_OFFSET_PADDINGLB 2
73 #define SPCA500_OFFSET_PADDINGHB 3
74 #define SPCA500_OFFSET_MODE      4
75 #define SPCA500_OFFSET_IMGWIDTH  5
76 #define SPCA500_OFFSET_IMGHEIGHT 6
77 #define SPCA500_OFFSET_IMGMODE   7
78 #define SPCA500_OFFSET_QTBLINDEX 8
79 #define SPCA500_OFFSET_FRAMSEQ   9
80 #define SPCA500_OFFSET_CDSPINFO  10
81 #define SPCA500_OFFSET_GPIO      11
82 #define SPCA500_OFFSET_AUGPIO    12
83 #define SPCA500_OFFSET_DATA      16
84 
85 
86 static const __u16 spca500_visual_defaults[][3] = {
87 	{0x00, 0x0003, 0x816b},	/* SSI not active sync with vsync,
88 				 * hue (H byte) = 0,
89 				 * saturation/hue enable,
90 				 * brightness/contrast enable.
91 				 */
92 	{0x00, 0x0000, 0x8167},	/* brightness = 0 */
93 	{0x00, 0x0020, 0x8168},	/* contrast = 0 */
94 	{0x00, 0x0003, 0x816b},	/* SSI not active sync with vsync,
95 				 * hue (H byte) = 0, saturation/hue enable,
96 				 * brightness/contrast enable.
97 				 * was 0x0003, now 0x0000.
98 				 */
99 	{0x00, 0x0000, 0x816a},	/* hue (L byte) = 0 */
100 	{0x00, 0x0020, 0x8169},	/* saturation = 0x20 */
101 	{0x00, 0x0050, 0x8157},	/* edge gain high threshold */
102 	{0x00, 0x0030, 0x8158},	/* edge gain low threshold */
103 	{0x00, 0x0028, 0x8159},	/* edge bandwidth high threshold */
104 	{0x00, 0x000a, 0x815a},	/* edge bandwidth low threshold */
105 	{0x00, 0x0001, 0x8202},	/* clock rate compensation = 1/25 sec/frame */
106 	{0x0c, 0x0004, 0x0000},
107 	/* set interface */
108 	{}
109 };
110 static const __u16 Clicksmart510_defaults[][3] = {
111 	{0x00, 0x00, 0x8211},
112 	{0x00, 0x01, 0x82c0},
113 	{0x00, 0x10, 0x82cb},
114 	{0x00, 0x0f, 0x800d},
115 	{0x00, 0x82, 0x8225},
116 	{0x00, 0x21, 0x8228},
117 	{0x00, 0x00, 0x8203},
118 	{0x00, 0x00, 0x8204},
119 	{0x00, 0x08, 0x8205},
120 	{0x00, 0xf8, 0x8206},
121 	{0x00, 0x28, 0x8207},
122 	{0x00, 0xa0, 0x8208},
123 	{0x00, 0x08, 0x824a},
124 	{0x00, 0x08, 0x8214},
125 	{0x00, 0x80, 0x82c1},
126 	{0x00, 0x00, 0x82c2},
127 	{0x00, 0x00, 0x82ca},
128 	{0x00, 0x80, 0x82c1},
129 	{0x00, 0x04, 0x82c2},
130 	{0x00, 0x00, 0x82ca},
131 	{0x00, 0xfc, 0x8100},
132 	{0x00, 0xfc, 0x8105},
133 	{0x00, 0x30, 0x8101},
134 	{0x00, 0x00, 0x8102},
135 	{0x00, 0x00, 0x8103},
136 	{0x00, 0x66, 0x8107},
137 	{0x00, 0x00, 0x816b},
138 	{0x00, 0x00, 0x8155},
139 	{0x00, 0x01, 0x8156},
140 	{0x00, 0x60, 0x8157},
141 	{0x00, 0x40, 0x8158},
142 	{0x00, 0x0a, 0x8159},
143 	{0x00, 0x06, 0x815a},
144 	{0x00, 0x00, 0x813f},
145 	{0x00, 0x00, 0x8200},
146 	{0x00, 0x19, 0x8201},
147 	{0x00, 0x00, 0x82c1},
148 	{0x00, 0xa0, 0x82c2},
149 	{0x00, 0x00, 0x82ca},
150 	{0x00, 0x00, 0x8117},
151 	{0x00, 0x00, 0x8118},
152 	{0x00, 0x65, 0x8119},
153 	{0x00, 0x00, 0x811a},
154 	{0x00, 0x00, 0x811b},
155 	{0x00, 0x55, 0x811c},
156 	{0x00, 0x65, 0x811d},
157 	{0x00, 0x55, 0x811e},
158 	{0x00, 0x16, 0x811f},
159 	{0x00, 0x19, 0x8120},
160 	{0x00, 0x80, 0x8103},
161 	{0x00, 0x83, 0x816b},
162 	{0x00, 0x25, 0x8168},
163 	{0x00, 0x01, 0x820f},
164 	{0x00, 0xff, 0x8115},
165 	{0x00, 0x48, 0x8116},
166 	{0x00, 0x50, 0x8151},
167 	{0x00, 0x40, 0x8152},
168 	{0x00, 0x78, 0x8153},
169 	{0x00, 0x40, 0x8154},
170 	{0x00, 0x00, 0x8167},
171 	{0x00, 0x20, 0x8168},
172 	{0x00, 0x00, 0x816a},
173 	{0x00, 0x03, 0x816b},
174 	{0x00, 0x20, 0x8169},
175 	{0x00, 0x60, 0x8157},
176 	{0x00, 0x00, 0x8190},
177 	{0x00, 0x00, 0x81a1},
178 	{0x00, 0x00, 0x81b2},
179 	{0x00, 0x27, 0x8191},
180 	{0x00, 0x27, 0x81a2},
181 	{0x00, 0x27, 0x81b3},
182 	{0x00, 0x4b, 0x8192},
183 	{0x00, 0x4b, 0x81a3},
184 	{0x00, 0x4b, 0x81b4},
185 	{0x00, 0x66, 0x8193},
186 	{0x00, 0x66, 0x81a4},
187 	{0x00, 0x66, 0x81b5},
188 	{0x00, 0x79, 0x8194},
189 	{0x00, 0x79, 0x81a5},
190 	{0x00, 0x79, 0x81b6},
191 	{0x00, 0x8a, 0x8195},
192 	{0x00, 0x8a, 0x81a6},
193 	{0x00, 0x8a, 0x81b7},
194 	{0x00, 0x9b, 0x8196},
195 	{0x00, 0x9b, 0x81a7},
196 	{0x00, 0x9b, 0x81b8},
197 	{0x00, 0xa6, 0x8197},
198 	{0x00, 0xa6, 0x81a8},
199 	{0x00, 0xa6, 0x81b9},
200 	{0x00, 0xb2, 0x8198},
201 	{0x00, 0xb2, 0x81a9},
202 	{0x00, 0xb2, 0x81ba},
203 	{0x00, 0xbe, 0x8199},
204 	{0x00, 0xbe, 0x81aa},
205 	{0x00, 0xbe, 0x81bb},
206 	{0x00, 0xc8, 0x819a},
207 	{0x00, 0xc8, 0x81ab},
208 	{0x00, 0xc8, 0x81bc},
209 	{0x00, 0xd2, 0x819b},
210 	{0x00, 0xd2, 0x81ac},
211 	{0x00, 0xd2, 0x81bd},
212 	{0x00, 0xdb, 0x819c},
213 	{0x00, 0xdb, 0x81ad},
214 	{0x00, 0xdb, 0x81be},
215 	{0x00, 0xe4, 0x819d},
216 	{0x00, 0xe4, 0x81ae},
217 	{0x00, 0xe4, 0x81bf},
218 	{0x00, 0xed, 0x819e},
219 	{0x00, 0xed, 0x81af},
220 	{0x00, 0xed, 0x81c0},
221 	{0x00, 0xf7, 0x819f},
222 	{0x00, 0xf7, 0x81b0},
223 	{0x00, 0xf7, 0x81c1},
224 	{0x00, 0xff, 0x81a0},
225 	{0x00, 0xff, 0x81b1},
226 	{0x00, 0xff, 0x81c2},
227 	{0x00, 0x03, 0x8156},
228 	{0x00, 0x00, 0x8211},
229 	{0x00, 0x20, 0x8168},
230 	{0x00, 0x01, 0x8202},
231 	{0x00, 0x30, 0x8101},
232 	{0x00, 0x00, 0x8111},
233 	{0x00, 0x00, 0x8112},
234 	{0x00, 0x00, 0x8113},
235 	{0x00, 0x00, 0x8114},
236 	{}
237 };
238 
239 static const __u8 qtable_creative_pccam[2][64] = {
240 	{				/* Q-table Y-components */
241 	 0x05, 0x03, 0x03, 0x05, 0x07, 0x0c, 0x0f, 0x12,
242 	 0x04, 0x04, 0x04, 0x06, 0x08, 0x11, 0x12, 0x11,
243 	 0x04, 0x04, 0x05, 0x07, 0x0c, 0x11, 0x15, 0x11,
244 	 0x04, 0x05, 0x07, 0x09, 0x0f, 0x1a, 0x18, 0x13,
245 	 0x05, 0x07, 0x0b, 0x11, 0x14, 0x21, 0x1f, 0x17,
246 	 0x07, 0x0b, 0x11, 0x13, 0x18, 0x1f, 0x22, 0x1c,
247 	 0x0f, 0x13, 0x17, 0x1a, 0x1f, 0x24, 0x24, 0x1e,
248 	 0x16, 0x1c, 0x1d, 0x1d, 0x22, 0x1e, 0x1f, 0x1e},
249 	{				/* Q-table C-components */
250 	 0x05, 0x05, 0x07, 0x0e, 0x1e, 0x1e, 0x1e, 0x1e,
251 	 0x05, 0x06, 0x08, 0x14, 0x1e, 0x1e, 0x1e, 0x1e,
252 	 0x07, 0x08, 0x11, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e,
253 	 0x0e, 0x14, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e,
254 	 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e,
255 	 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e,
256 	 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e,
257 	 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e, 0x1e}
258 };
259 
260 static const __u8 qtable_kodak_ez200[2][64] = {
261 	{				/* Q-table Y-components */
262 	 0x02, 0x01, 0x01, 0x02, 0x02, 0x04, 0x05, 0x06,
263 	 0x01, 0x01, 0x01, 0x02, 0x03, 0x06, 0x06, 0x06,
264 	 0x01, 0x01, 0x02, 0x02, 0x04, 0x06, 0x07, 0x06,
265 	 0x01, 0x02, 0x02, 0x03, 0x05, 0x09, 0x08, 0x06,
266 	 0x02, 0x02, 0x04, 0x06, 0x07, 0x0b, 0x0a, 0x08,
267 	 0x02, 0x04, 0x06, 0x06, 0x08, 0x0a, 0x0b, 0x09,
268 	 0x05, 0x06, 0x08, 0x09, 0x0a, 0x0c, 0x0c, 0x0a,
269 	 0x07, 0x09, 0x0a, 0x0a, 0x0b, 0x0a, 0x0a, 0x0a},
270 	{				/* Q-table C-components */
271 	 0x02, 0x02, 0x02, 0x05, 0x0a, 0x0a, 0x0a, 0x0a,
272 	 0x02, 0x02, 0x03, 0x07, 0x0a, 0x0a, 0x0a, 0x0a,
273 	 0x02, 0x03, 0x06, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
274 	 0x05, 0x07, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
275 	 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
276 	 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
277 	 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
278 	 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a}
279 };
280 
281 static const __u8 qtable_pocketdv[2][64] = {
282 	{		/* Q-table Y-components start registers 0x8800 */
283 	 0x06, 0x04, 0x04, 0x06, 0x0a, 0x10, 0x14, 0x18,
284 	 0x05, 0x05, 0x06, 0x08, 0x0a, 0x17, 0x18, 0x16,
285 	 0x06, 0x05, 0x06, 0x0a, 0x10, 0x17, 0x1c, 0x16,
286 	 0x06, 0x07, 0x09, 0x0c, 0x14, 0x23, 0x20, 0x19,
287 	 0x07, 0x09, 0x0f, 0x16, 0x1b, 0x2c, 0x29, 0x1f,
288 	 0x0a, 0x0e, 0x16, 0x1a, 0x20, 0x2a, 0x2d, 0x25,
289 	 0x14, 0x1a, 0x1f, 0x23, 0x29, 0x30, 0x30, 0x28,
290 	 0x1d, 0x25, 0x26, 0x27, 0x2d, 0x28, 0x29, 0x28,
291 	 },
292 	{		/* Q-table C-components start registers 0x8840 */
293 	 0x07, 0x07, 0x0a, 0x13, 0x28, 0x28, 0x28, 0x28,
294 	 0x07, 0x08, 0x0a, 0x1a, 0x28, 0x28, 0x28, 0x28,
295 	 0x0a, 0x0a, 0x16, 0x28, 0x28, 0x28, 0x28, 0x28,
296 	 0x13, 0x1a, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,
297 	 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,
298 	 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,
299 	 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28,
300 	 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28}
301 };
302 
303 /* read 'len' bytes to gspca_dev->usb_buf */
reg_r(struct gspca_dev * gspca_dev,__u16 index,__u16 length)304 static void reg_r(struct gspca_dev *gspca_dev,
305 		  __u16 index,
306 		  __u16 length)
307 {
308 	usb_control_msg(gspca_dev->dev,
309 			usb_rcvctrlpipe(gspca_dev->dev, 0),
310 			0,
311 			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
312 			0,		/* value */
313 			index, gspca_dev->usb_buf, length, 500);
314 }
315 
reg_w(struct gspca_dev * gspca_dev,__u16 req,__u16 index,__u16 value)316 static int reg_w(struct gspca_dev *gspca_dev,
317 		     __u16 req, __u16 index, __u16 value)
318 {
319 	int ret;
320 
321 	gspca_dbg(gspca_dev, D_USBO, "reg write: [0x%02x] = 0x%02x\n",
322 		  index, value);
323 	ret = usb_control_msg(gspca_dev->dev,
324 			usb_sndctrlpipe(gspca_dev->dev, 0),
325 			req,
326 			USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
327 			value, index, NULL, 0, 500);
328 	if (ret < 0)
329 		pr_err("reg write: error %d\n", ret);
330 	return ret;
331 }
332 
333 /* returns: negative is error, pos or zero is data */
reg_r_12(struct gspca_dev * gspca_dev,__u16 req,__u16 index,__u16 length)334 static int reg_r_12(struct gspca_dev *gspca_dev,
335 			__u16 req,	/* bRequest */
336 			__u16 index,	/* wIndex */
337 			__u16 length)	/* wLength (1 or 2 only) */
338 {
339 	int ret;
340 
341 	gspca_dev->usb_buf[1] = 0;
342 	ret = usb_control_msg(gspca_dev->dev,
343 			usb_rcvctrlpipe(gspca_dev->dev, 0),
344 			req,
345 			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
346 			0,		/* value */
347 			index,
348 			gspca_dev->usb_buf, length,
349 			500);		/* timeout */
350 	if (ret < 0) {
351 		pr_err("reg_r_12 err %d\n", ret);
352 		return ret;
353 	}
354 	return (gspca_dev->usb_buf[1] << 8) + gspca_dev->usb_buf[0];
355 }
356 
357 /*
358  * Simple function to wait for a given 8-bit value to be returned from
359  * a reg_read call.
360  * Returns: negative is error or timeout, zero is success.
361  */
reg_r_wait(struct gspca_dev * gspca_dev,__u16 reg,__u16 index,__u16 value)362 static int reg_r_wait(struct gspca_dev *gspca_dev,
363 			__u16 reg, __u16 index, __u16 value)
364 {
365 	int ret, cnt = 20;
366 
367 	while (--cnt > 0) {
368 		ret = reg_r_12(gspca_dev, reg, index, 1);
369 		if (ret == value)
370 			return 0;
371 		msleep(50);
372 	}
373 	return -EIO;
374 }
375 
write_vector(struct gspca_dev * gspca_dev,const __u16 data[][3])376 static int write_vector(struct gspca_dev *gspca_dev,
377 			const __u16 data[][3])
378 {
379 	int ret, i = 0;
380 
381 	while (data[i][0] != 0 || data[i][1] != 0 || data[i][2] != 0) {
382 		ret = reg_w(gspca_dev, data[i][0], data[i][2], data[i][1]);
383 		if (ret < 0)
384 			return ret;
385 		i++;
386 	}
387 	return 0;
388 }
389 
spca50x_setup_qtable(struct gspca_dev * gspca_dev,unsigned int request,unsigned int ybase,unsigned int cbase,const __u8 qtable[2][64])390 static int spca50x_setup_qtable(struct gspca_dev *gspca_dev,
391 				unsigned int request,
392 				unsigned int ybase,
393 				unsigned int cbase,
394 				const __u8 qtable[2][64])
395 {
396 	int i, err;
397 
398 	/* loop over y components */
399 	for (i = 0; i < 64; i++) {
400 		err = reg_w(gspca_dev, request, ybase + i, qtable[0][i]);
401 		if (err < 0)
402 			return err;
403 	}
404 
405 	/* loop over c components */
406 	for (i = 0; i < 64; i++) {
407 		err = reg_w(gspca_dev, request, cbase + i, qtable[1][i]);
408 		if (err < 0)
409 			return err;
410 	}
411 	return 0;
412 }
413 
spca500_ping310(struct gspca_dev * gspca_dev)414 static void spca500_ping310(struct gspca_dev *gspca_dev)
415 {
416 	reg_r(gspca_dev, 0x0d04, 2);
417 	gspca_dbg(gspca_dev, D_STREAM, "ClickSmart310 ping 0x0d04 0x%02x 0x%02x\n",
418 		  gspca_dev->usb_buf[0], gspca_dev->usb_buf[1]);
419 }
420 
spca500_clksmart310_init(struct gspca_dev * gspca_dev)421 static void spca500_clksmart310_init(struct gspca_dev *gspca_dev)
422 {
423 	reg_r(gspca_dev, 0x0d05, 2);
424 	gspca_dbg(gspca_dev, D_STREAM, "ClickSmart310 init 0x0d05 0x%02x 0x%02x\n",
425 		  gspca_dev->usb_buf[0], gspca_dev->usb_buf[1]);
426 	reg_w(gspca_dev, 0x00, 0x8167, 0x5a);
427 	spca500_ping310(gspca_dev);
428 
429 	reg_w(gspca_dev, 0x00, 0x8168, 0x22);
430 	reg_w(gspca_dev, 0x00, 0x816a, 0xc0);
431 	reg_w(gspca_dev, 0x00, 0x816b, 0x0b);
432 	reg_w(gspca_dev, 0x00, 0x8169, 0x25);
433 	reg_w(gspca_dev, 0x00, 0x8157, 0x5b);
434 	reg_w(gspca_dev, 0x00, 0x8158, 0x5b);
435 	reg_w(gspca_dev, 0x00, 0x813f, 0x03);
436 	reg_w(gspca_dev, 0x00, 0x8151, 0x4a);
437 	reg_w(gspca_dev, 0x00, 0x8153, 0x78);
438 	reg_w(gspca_dev, 0x00, 0x0d01, 0x04);
439 						/* 00 for adjust shutter */
440 	reg_w(gspca_dev, 0x00, 0x0d02, 0x01);
441 	reg_w(gspca_dev, 0x00, 0x8169, 0x25);
442 	reg_w(gspca_dev, 0x00, 0x0d01, 0x02);
443 }
444 
spca500_setmode(struct gspca_dev * gspca_dev,__u8 xmult,__u8 ymult)445 static void spca500_setmode(struct gspca_dev *gspca_dev,
446 			__u8 xmult, __u8 ymult)
447 {
448 	int mode;
449 
450 	/* set x multiplier */
451 	reg_w(gspca_dev, 0, 0x8001, xmult);
452 
453 	/* set y multiplier */
454 	reg_w(gspca_dev, 0, 0x8002, ymult);
455 
456 	/* use compressed mode, VGA, with mode specific subsample */
457 	mode = gspca_dev->cam.cam_mode[(int) gspca_dev->curr_mode].priv;
458 	reg_w(gspca_dev, 0, 0x8003, mode << 4);
459 }
460 
spca500_full_reset(struct gspca_dev * gspca_dev)461 static int spca500_full_reset(struct gspca_dev *gspca_dev)
462 {
463 	int err;
464 
465 	/* send the reset command */
466 	err = reg_w(gspca_dev, 0xe0, 0x0001, 0x0000);
467 	if (err < 0)
468 		return err;
469 
470 	/* wait for the reset to complete */
471 	err = reg_r_wait(gspca_dev, 0x06, 0x0000, 0x0000);
472 	if (err < 0)
473 		return err;
474 	err = reg_w(gspca_dev, 0xe0, 0x0000, 0x0000);
475 	if (err < 0)
476 		return err;
477 	err = reg_r_wait(gspca_dev, 0x06, 0, 0);
478 	if (err < 0) {
479 		gspca_err(gspca_dev, "reg_r_wait() failed\n");
480 		return err;
481 	}
482 	/* all ok */
483 	return 0;
484 }
485 
486 /* Synchro the Bridge with sensor */
487 /* Maybe that will work on all spca500 chip */
488 /* because i only own a clicksmart310 try for that chip */
489 /* using spca50x_set_packet_size() cause an Ooops here */
490 /* usb_set_interface from kernel 2.6.x clear all the urb stuff */
491 /* up-port the same feature as in 2.4.x kernel */
spca500_synch310(struct gspca_dev * gspca_dev)492 static int spca500_synch310(struct gspca_dev *gspca_dev)
493 {
494 	if (usb_set_interface(gspca_dev->dev, gspca_dev->iface, 0) < 0) {
495 		gspca_err(gspca_dev, "Set packet size: set interface error\n");
496 		goto error;
497 	}
498 	spca500_ping310(gspca_dev);
499 
500 	reg_r(gspca_dev, 0x0d00, 1);
501 
502 	/* need alt setting here */
503 	gspca_dbg(gspca_dev, D_PACK, "ClickSmart310 sync alt: %d\n",
504 		  gspca_dev->alt);
505 
506 	/* Windoze use pipe with altsetting 6 why 7 here */
507 	if (usb_set_interface(gspca_dev->dev,
508 				gspca_dev->iface,
509 				gspca_dev->alt) < 0) {
510 		gspca_err(gspca_dev, "Set packet size: set interface error\n");
511 		goto error;
512 	}
513 	return 0;
514 error:
515 	return -EBUSY;
516 }
517 
spca500_reinit(struct gspca_dev * gspca_dev)518 static void spca500_reinit(struct gspca_dev *gspca_dev)
519 {
520 	int err;
521 	__u8 Data;
522 
523 	/* some unknown command from Aiptek pocket dv and family300 */
524 
525 	reg_w(gspca_dev, 0x00, 0x0d01, 0x01);
526 	reg_w(gspca_dev, 0x00, 0x0d03, 0x00);
527 	reg_w(gspca_dev, 0x00, 0x0d02, 0x01);
528 
529 	/* enable drop packet */
530 	reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
531 
532 	err = spca50x_setup_qtable(gspca_dev, 0x00, 0x8800, 0x8840,
533 				 qtable_pocketdv);
534 	if (err < 0)
535 		gspca_err(gspca_dev, "spca50x_setup_qtable failed on init\n");
536 
537 	/* set qtable index */
538 	reg_w(gspca_dev, 0x00, 0x8880, 2);
539 	/* family cam Quicksmart stuff */
540 	reg_w(gspca_dev, 0x00, 0x800a, 0x00);
541 	/* Set agc transfer: synced between frames */
542 	reg_w(gspca_dev, 0x00, 0x820f, 0x01);
543 	/* Init SDRAM - needed for SDRAM access */
544 	reg_w(gspca_dev, 0x00, 0x870a, 0x04);
545 	/*Start init sequence or stream */
546 	reg_w(gspca_dev, 0, 0x8003, 0x00);
547 	/* switch to video camera mode */
548 	reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
549 	msleep(2000);
550 	if (reg_r_wait(gspca_dev, 0, 0x8000, 0x44) != 0) {
551 		reg_r(gspca_dev, 0x816b, 1);
552 		Data = gspca_dev->usb_buf[0];
553 		reg_w(gspca_dev, 0x00, 0x816b, Data);
554 	}
555 }
556 
557 /* this function is called at probe time */
sd_config(struct gspca_dev * gspca_dev,const struct usb_device_id * id)558 static int sd_config(struct gspca_dev *gspca_dev,
559 			const struct usb_device_id *id)
560 {
561 	struct sd *sd = (struct sd *) gspca_dev;
562 	struct cam *cam;
563 
564 	cam = &gspca_dev->cam;
565 	sd->subtype = id->driver_info;
566 	if (sd->subtype != LogitechClickSmart310) {
567 		cam->cam_mode = vga_mode;
568 		cam->nmodes = ARRAY_SIZE(vga_mode);
569 	} else {
570 		cam->cam_mode = sif_mode;
571 		cam->nmodes = ARRAY_SIZE(sif_mode);
572 	}
573 	return 0;
574 }
575 
576 /* this function is called at probe and resume time */
sd_init(struct gspca_dev * gspca_dev)577 static int sd_init(struct gspca_dev *gspca_dev)
578 {
579 	struct sd *sd = (struct sd *) gspca_dev;
580 
581 	/* initialisation of spca500 based cameras is deferred */
582 	gspca_dbg(gspca_dev, D_STREAM, "SPCA500 init\n");
583 	if (sd->subtype == LogitechClickSmart310)
584 		spca500_clksmart310_init(gspca_dev);
585 /*	else
586 		spca500_initialise(gspca_dev); */
587 	gspca_dbg(gspca_dev, D_STREAM, "SPCA500 init done\n");
588 	return 0;
589 }
590 
sd_start(struct gspca_dev * gspca_dev)591 static int sd_start(struct gspca_dev *gspca_dev)
592 {
593 	struct sd *sd = (struct sd *) gspca_dev;
594 	int err;
595 	__u8 Data;
596 	__u8 xmult, ymult;
597 
598 	/* create the JPEG header */
599 	jpeg_define(sd->jpeg_hdr, gspca_dev->pixfmt.height,
600 			gspca_dev->pixfmt.width,
601 			0x22);		/* JPEG 411 */
602 	jpeg_set_qual(sd->jpeg_hdr, QUALITY);
603 
604 	if (sd->subtype == LogitechClickSmart310) {
605 		xmult = 0x16;
606 		ymult = 0x12;
607 	} else {
608 		xmult = 0x28;
609 		ymult = 0x1e;
610 	}
611 
612 	/* is there a sensor here ? */
613 	reg_r(gspca_dev, 0x8a04, 1);
614 	gspca_dbg(gspca_dev, D_STREAM, "Spca500 Sensor Address 0x%02x\n",
615 		  gspca_dev->usb_buf[0]);
616 	gspca_dbg(gspca_dev, D_STREAM, "Spca500 curr_mode: %d Xmult: 0x%02x, Ymult: 0x%02x",
617 		  gspca_dev->curr_mode, xmult, ymult);
618 
619 	/* setup qtable */
620 	switch (sd->subtype) {
621 	case LogitechClickSmart310:
622 		 spca500_setmode(gspca_dev, xmult, ymult);
623 
624 		/* enable drop packet */
625 		reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
626 		reg_w(gspca_dev, 0x00, 0x8880, 3);
627 		err = spca50x_setup_qtable(gspca_dev,
628 					   0x00, 0x8800, 0x8840,
629 					   qtable_creative_pccam);
630 		if (err < 0)
631 			gspca_err(gspca_dev, "spca50x_setup_qtable failed\n");
632 		/* Init SDRAM - needed for SDRAM access */
633 		reg_w(gspca_dev, 0x00, 0x870a, 0x04);
634 
635 		/* switch to video camera mode */
636 		reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
637 		msleep(500);
638 		if (reg_r_wait(gspca_dev, 0, 0x8000, 0x44) != 0)
639 			gspca_err(gspca_dev, "reg_r_wait() failed\n");
640 
641 		reg_r(gspca_dev, 0x816b, 1);
642 		Data = gspca_dev->usb_buf[0];
643 		reg_w(gspca_dev, 0x00, 0x816b, Data);
644 
645 		spca500_synch310(gspca_dev);
646 
647 		write_vector(gspca_dev, spca500_visual_defaults);
648 		spca500_setmode(gspca_dev, xmult, ymult);
649 		/* enable drop packet */
650 		err = reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
651 		if (err < 0)
652 			gspca_err(gspca_dev, "failed to enable drop packet\n");
653 		reg_w(gspca_dev, 0x00, 0x8880, 3);
654 		err = spca50x_setup_qtable(gspca_dev,
655 					   0x00, 0x8800, 0x8840,
656 					   qtable_creative_pccam);
657 		if (err < 0)
658 			gspca_err(gspca_dev, "spca50x_setup_qtable failed\n");
659 
660 		/* Init SDRAM - needed for SDRAM access */
661 		reg_w(gspca_dev, 0x00, 0x870a, 0x04);
662 
663 		/* switch to video camera mode */
664 		reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
665 
666 		if (reg_r_wait(gspca_dev, 0, 0x8000, 0x44) != 0)
667 			gspca_err(gspca_dev, "reg_r_wait() failed\n");
668 
669 		reg_r(gspca_dev, 0x816b, 1);
670 		Data = gspca_dev->usb_buf[0];
671 		reg_w(gspca_dev, 0x00, 0x816b, Data);
672 		break;
673 	case CreativePCCam300:		/* Creative PC-CAM 300 640x480 CCD */
674 	case IntelPocketPCCamera:	/* FIXME: Temporary fix for
675 					 *	Intel Pocket PC Camera
676 					 *	- NWG (Sat 29th March 2003) */
677 
678 		/* do a full reset */
679 		err = spca500_full_reset(gspca_dev);
680 		if (err < 0)
681 			gspca_err(gspca_dev, "spca500_full_reset failed\n");
682 
683 		/* enable drop packet */
684 		err = reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
685 		if (err < 0)
686 			gspca_err(gspca_dev, "failed to enable drop packet\n");
687 		reg_w(gspca_dev, 0x00, 0x8880, 3);
688 		err = spca50x_setup_qtable(gspca_dev,
689 					   0x00, 0x8800, 0x8840,
690 					   qtable_creative_pccam);
691 		if (err < 0)
692 			gspca_err(gspca_dev, "spca50x_setup_qtable failed\n");
693 
694 		spca500_setmode(gspca_dev, xmult, ymult);
695 		reg_w(gspca_dev, 0x20, 0x0001, 0x0004);
696 
697 		/* switch to video camera mode */
698 		reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
699 
700 		if (reg_r_wait(gspca_dev, 0, 0x8000, 0x44) != 0)
701 			gspca_err(gspca_dev, "reg_r_wait() failed\n");
702 
703 		reg_r(gspca_dev, 0x816b, 1);
704 		Data = gspca_dev->usb_buf[0];
705 		reg_w(gspca_dev, 0x00, 0x816b, Data);
706 
707 /*		write_vector(gspca_dev, spca500_visual_defaults); */
708 		break;
709 	case KodakEZ200:		/* Kodak EZ200 */
710 
711 		/* do a full reset */
712 		err = spca500_full_reset(gspca_dev);
713 		if (err < 0)
714 			gspca_err(gspca_dev, "spca500_full_reset failed\n");
715 		/* enable drop packet */
716 		reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
717 		reg_w(gspca_dev, 0x00, 0x8880, 0);
718 		err = spca50x_setup_qtable(gspca_dev,
719 					   0x00, 0x8800, 0x8840,
720 					   qtable_kodak_ez200);
721 		if (err < 0)
722 			gspca_err(gspca_dev, "spca50x_setup_qtable failed\n");
723 		spca500_setmode(gspca_dev, xmult, ymult);
724 
725 		reg_w(gspca_dev, 0x20, 0x0001, 0x0004);
726 
727 		/* switch to video camera mode */
728 		reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
729 
730 		if (reg_r_wait(gspca_dev, 0, 0x8000, 0x44) != 0)
731 			gspca_err(gspca_dev, "reg_r_wait() failed\n");
732 
733 		reg_r(gspca_dev, 0x816b, 1);
734 		Data = gspca_dev->usb_buf[0];
735 		reg_w(gspca_dev, 0x00, 0x816b, Data);
736 
737 /*		write_vector(gspca_dev, spca500_visual_defaults); */
738 		break;
739 
740 	case BenqDC1016:
741 	case DLinkDSC350:		/* FamilyCam 300 */
742 	case AiptekPocketDV:		/* Aiptek PocketDV */
743 	case Gsmartmini:		/*Mustek Gsmart Mini */
744 	case MustekGsmart300:		/* Mustek Gsmart 300 */
745 	case PalmPixDC85:
746 	case Optimedia:
747 	case ToptroIndus:
748 	case AgfaCl20:
749 		spca500_reinit(gspca_dev);
750 		reg_w(gspca_dev, 0x00, 0x0d01, 0x01);
751 		/* enable drop packet */
752 		reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
753 
754 		err = spca50x_setup_qtable(gspca_dev,
755 				   0x00, 0x8800, 0x8840, qtable_pocketdv);
756 		if (err < 0)
757 			gspca_err(gspca_dev, "spca50x_setup_qtable failed\n");
758 		reg_w(gspca_dev, 0x00, 0x8880, 2);
759 
760 		/* familycam Quicksmart pocketDV stuff */
761 		reg_w(gspca_dev, 0x00, 0x800a, 0x00);
762 		/* Set agc transfer: synced between frames */
763 		reg_w(gspca_dev, 0x00, 0x820f, 0x01);
764 		/* Init SDRAM - needed for SDRAM access */
765 		reg_w(gspca_dev, 0x00, 0x870a, 0x04);
766 
767 		spca500_setmode(gspca_dev, xmult, ymult);
768 		/* switch to video camera mode */
769 		reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
770 
771 		reg_r_wait(gspca_dev, 0, 0x8000, 0x44);
772 
773 		reg_r(gspca_dev, 0x816b, 1);
774 		Data = gspca_dev->usb_buf[0];
775 		reg_w(gspca_dev, 0x00, 0x816b, Data);
776 		break;
777 	case LogitechTraveler:
778 	case LogitechClickSmart510:
779 		reg_w(gspca_dev, 0x02, 0x00, 0x00);
780 		/* enable drop packet */
781 		reg_w(gspca_dev, 0x00, 0x850a, 0x0001);
782 
783 		err = spca50x_setup_qtable(gspca_dev,
784 					0x00, 0x8800,
785 					0x8840, qtable_creative_pccam);
786 		if (err < 0)
787 			gspca_err(gspca_dev, "spca50x_setup_qtable failed\n");
788 		reg_w(gspca_dev, 0x00, 0x8880, 3);
789 		reg_w(gspca_dev, 0x00, 0x800a, 0x00);
790 		/* Init SDRAM - needed for SDRAM access */
791 		reg_w(gspca_dev, 0x00, 0x870a, 0x04);
792 
793 		spca500_setmode(gspca_dev, xmult, ymult);
794 
795 		/* switch to video camera mode */
796 		reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
797 		reg_r_wait(gspca_dev, 0, 0x8000, 0x44);
798 
799 		reg_r(gspca_dev, 0x816b, 1);
800 		Data = gspca_dev->usb_buf[0];
801 		reg_w(gspca_dev, 0x00, 0x816b, Data);
802 		write_vector(gspca_dev, Clicksmart510_defaults);
803 		break;
804 	}
805 	return 0;
806 }
807 
sd_stopN(struct gspca_dev * gspca_dev)808 static void sd_stopN(struct gspca_dev *gspca_dev)
809 {
810 	reg_w(gspca_dev, 0, 0x8003, 0x00);
811 
812 	/* switch to video camera mode */
813 	reg_w(gspca_dev, 0x00, 0x8000, 0x0004);
814 	reg_r(gspca_dev, 0x8000, 1);
815 	gspca_dbg(gspca_dev, D_STREAM, "stop SPCA500 done reg8000: 0x%2x\n",
816 		  gspca_dev->usb_buf[0]);
817 }
818 
sd_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)819 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
820 			u8 *data,			/* isoc packet */
821 			int len)			/* iso packet length */
822 {
823 	struct sd *sd = (struct sd *) gspca_dev;
824 	int i;
825 	static __u8 ffd9[] = {0xff, 0xd9};
826 
827 /* frames are jpeg 4.1.1 without 0xff escape */
828 	if (data[0] == 0xff) {
829 		if (data[1] != 0x01) {	/* drop packet */
830 /*			gspca_dev->last_packet_type = DISCARD_PACKET; */
831 			return;
832 		}
833 		gspca_frame_add(gspca_dev, LAST_PACKET,
834 					ffd9, 2);
835 
836 		/* put the JPEG header in the new frame */
837 		gspca_frame_add(gspca_dev, FIRST_PACKET,
838 			sd->jpeg_hdr, JPEG_HDR_SZ);
839 
840 		data += SPCA500_OFFSET_DATA;
841 		len -= SPCA500_OFFSET_DATA;
842 	} else {
843 		data += 1;
844 		len -= 1;
845 	}
846 
847 	/* add 0x00 after 0xff */
848 	i = 0;
849 	do {
850 		if (data[i] == 0xff) {
851 			gspca_frame_add(gspca_dev, INTER_PACKET,
852 					data, i + 1);
853 			len -= i;
854 			data += i;
855 			*data = 0x00;
856 			i = 0;
857 		}
858 		i++;
859 	} while (i < len);
860 	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
861 }
862 
setbrightness(struct gspca_dev * gspca_dev,s32 val)863 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
864 {
865 	reg_w(gspca_dev, 0x00, 0x8167,
866 			(__u8) (val - 128));
867 }
868 
setcontrast(struct gspca_dev * gspca_dev,s32 val)869 static void setcontrast(struct gspca_dev *gspca_dev, s32 val)
870 {
871 	reg_w(gspca_dev, 0x00, 0x8168, val);
872 }
873 
setcolors(struct gspca_dev * gspca_dev,s32 val)874 static void setcolors(struct gspca_dev *gspca_dev, s32 val)
875 {
876 	reg_w(gspca_dev, 0x00, 0x8169, val);
877 }
878 
sd_s_ctrl(struct v4l2_ctrl * ctrl)879 static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
880 {
881 	struct gspca_dev *gspca_dev =
882 		container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
883 
884 	gspca_dev->usb_err = 0;
885 
886 	if (!gspca_dev->streaming)
887 		return 0;
888 
889 	switch (ctrl->id) {
890 	case V4L2_CID_BRIGHTNESS:
891 		setbrightness(gspca_dev, ctrl->val);
892 		break;
893 	case V4L2_CID_CONTRAST:
894 		setcontrast(gspca_dev, ctrl->val);
895 		break;
896 	case V4L2_CID_SATURATION:
897 		setcolors(gspca_dev, ctrl->val);
898 		break;
899 	}
900 	return gspca_dev->usb_err;
901 }
902 
903 static const struct v4l2_ctrl_ops sd_ctrl_ops = {
904 	.s_ctrl = sd_s_ctrl,
905 };
906 
sd_init_controls(struct gspca_dev * gspca_dev)907 static int sd_init_controls(struct gspca_dev *gspca_dev)
908 {
909 	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
910 
911 	gspca_dev->vdev.ctrl_handler = hdl;
912 	v4l2_ctrl_handler_init(hdl, 3);
913 	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
914 			V4L2_CID_BRIGHTNESS, 0, 255, 1, 127);
915 	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
916 			V4L2_CID_CONTRAST, 0, 63, 1, 31);
917 	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
918 			V4L2_CID_SATURATION, 0, 63, 1, 31);
919 
920 	if (hdl->error) {
921 		pr_err("Could not initialize controls\n");
922 		return hdl->error;
923 	}
924 	return 0;
925 }
926 
927 /* sub-driver description */
928 static const struct sd_desc sd_desc = {
929 	.name = MODULE_NAME,
930 	.config = sd_config,
931 	.init = sd_init,
932 	.init_controls = sd_init_controls,
933 	.start = sd_start,
934 	.stopN = sd_stopN,
935 	.pkt_scan = sd_pkt_scan,
936 };
937 
938 /* -- module initialisation -- */
939 static const struct usb_device_id device_table[] = {
940 	{USB_DEVICE(0x040a, 0x0300), .driver_info = KodakEZ200},
941 	{USB_DEVICE(0x041e, 0x400a), .driver_info = CreativePCCam300},
942 	{USB_DEVICE(0x046d, 0x0890), .driver_info = LogitechTraveler},
943 	{USB_DEVICE(0x046d, 0x0900), .driver_info = LogitechClickSmart310},
944 	{USB_DEVICE(0x046d, 0x0901), .driver_info = LogitechClickSmart510},
945 	{USB_DEVICE(0x04a5, 0x300c), .driver_info = BenqDC1016},
946 	{USB_DEVICE(0x04fc, 0x7333), .driver_info = PalmPixDC85},
947 	{USB_DEVICE(0x055f, 0xc200), .driver_info = MustekGsmart300},
948 	{USB_DEVICE(0x055f, 0xc220), .driver_info = Gsmartmini},
949 	{USB_DEVICE(0x06bd, 0x0404), .driver_info = AgfaCl20},
950 	{USB_DEVICE(0x06be, 0x0800), .driver_info = Optimedia},
951 	{USB_DEVICE(0x084d, 0x0003), .driver_info = DLinkDSC350},
952 	{USB_DEVICE(0x08ca, 0x0103), .driver_info = AiptekPocketDV},
953 	{USB_DEVICE(0x2899, 0x012c), .driver_info = ToptroIndus},
954 	{USB_DEVICE(0x8086, 0x0630), .driver_info = IntelPocketPCCamera},
955 	{}
956 };
957 MODULE_DEVICE_TABLE(usb, device_table);
958 
959 /* -- device connect -- */
sd_probe(struct usb_interface * intf,const struct usb_device_id * id)960 static int sd_probe(struct usb_interface *intf,
961 			const struct usb_device_id *id)
962 {
963 	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
964 				THIS_MODULE);
965 }
966 
967 static struct usb_driver sd_driver = {
968 	.name = MODULE_NAME,
969 	.id_table = device_table,
970 	.probe = sd_probe,
971 	.disconnect = gspca_disconnect,
972 #ifdef CONFIG_PM
973 	.suspend = gspca_suspend,
974 	.resume = gspca_resume,
975 	.reset_resume = gspca_resume,
976 #endif
977 };
978 
979 module_usb_driver(sd_driver);
980