?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.34-rc3
[pohmelfs.git] / drivers / media / video / gspca / sonixj.c
blob83d5773d4629efda315fd96899541aa5f00f1155
1 /*
2 * Sonix sn9c102p sn9c105 sn9c120 (jpeg) subdriver
3 *
4 * Copyright (C) 2009 Jean-Francois Moine <http://moinejf.free.fr>
5 * Copyright (C) 2005 Michel Xhaard mxhaard@magic.fr
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 */
21
22 #define MODULE_NAME "sonixj"
23
24 #include <linux/input.h>
25 #include "gspca.h"
26 #include "jpeg.h"
27
28 #define V4L2_CID_INFRARED (V4L2_CID_PRIVATE_BASE + 0)
29
30 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
31 MODULE_DESCRIPTION("GSPCA/SONIX JPEG USB Camera Driver");
32 MODULE_LICENSE("GPL");
33
34 /* specific webcam descriptor */
35 struct sd {
36 struct gspca_dev gspca_dev; /* !! must be the first item */
37
38 atomic_t avg_lum;
39 u32 exposure;
40
41 u16 brightness;
42 u8 contrast;
43 u8 colors;
44 u8 autogain;
45 u8 blue;
46 u8 red;
47 u8 gamma;
48 u8 vflip; /* ov7630/ov7648 only */
49 u8 sharpness;
50 u8 infrared; /* mt9v111 only */
51 u8 freq; /* ov76xx only */
52 u8 quality; /* image quality */
53 #define QUALITY_MIN 60
54 #define QUALITY_MAX 95
55 #define QUALITY_DEF 80
56 u8 jpegqual; /* webcam quality */
57
58 u8 reg18;
59
60 s8 ag_cnt;
61 #define AG_CNT_START 13
62
63 u8 bridge;
64 #define BRIDGE_SN9C102P 0
65 #define BRIDGE_SN9C105 1
66 #define BRIDGE_SN9C110 2
67 #define BRIDGE_SN9C120 3
68 u8 sensor; /* Type of image sensor chip */
69 #define SENSOR_ADCM1700 0
70 #define SENSOR_HV7131R 1
71 #define SENSOR_MI0360 2
72 #define SENSOR_MO4000 3
73 #define SENSOR_MT9V111 4
74 #define SENSOR_OM6802 5
75 #define SENSOR_OV7630 6
76 #define SENSOR_OV7648 7
77 #define SENSOR_OV7660 8
78 #define SENSOR_PO1030 9
79 #define SENSOR_SP80708 10
80 u8 i2c_addr;
81
82 u8 *jpeg_hdr;
83 };
84
85 /* V4L2 controls supported by the driver */
86 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
87 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
88 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
89 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
90 static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val);
91 static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val);
92 static int sd_setblue_balance(struct gspca_dev *gspca_dev, __s32 val);
93 static int sd_getblue_balance(struct gspca_dev *gspca_dev, __s32 *val);
94 static int sd_setred_balance(struct gspca_dev *gspca_dev, __s32 val);
95 static int sd_getred_balance(struct gspca_dev *gspca_dev, __s32 *val);
96 static int sd_setgamma(struct gspca_dev *gspca_dev, __s32 val);
97 static int sd_getgamma(struct gspca_dev *gspca_dev, __s32 *val);
98 static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val);
99 static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val);
100 static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val);
101 static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val);
102 static int sd_setsharpness(struct gspca_dev *gspca_dev, __s32 val);
103 static int sd_getsharpness(struct gspca_dev *gspca_dev, __s32 *val);
104 static int sd_setinfrared(struct gspca_dev *gspca_dev, __s32 val);
105 static int sd_getinfrared(struct gspca_dev *gspca_dev, __s32 *val);
106 static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val);
107 static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val);
108
109 static const struct ctrl sd_ctrls[] = {
110 #define BRIGHTNESS_IDX 0
111 {
112 {
113 .id = V4L2_CID_BRIGHTNESS,
114 .type = V4L2_CTRL_TYPE_INTEGER,
115 .name = "Brightness",
116 .minimum = 0,
117 #define BRIGHTNESS_MAX 0xffff
118 .maximum = BRIGHTNESS_MAX,
119 .step = 1,
120 #define BRIGHTNESS_DEF 0x8000
121 .default_value = BRIGHTNESS_DEF,
122 },
123 .set = sd_setbrightness,
124 .get = sd_getbrightness,
125 },
126 #define CONTRAST_IDX 1
127 {
128 {
129 .id = V4L2_CID_CONTRAST,
130 .type = V4L2_CTRL_TYPE_INTEGER,
131 .name = "Contrast",
132 .minimum = 0,
133 #define CONTRAST_MAX 127
134 .maximum = CONTRAST_MAX,
135 .step = 1,
136 #define CONTRAST_DEF 63
137 .default_value = CONTRAST_DEF,
138 },
139 .set = sd_setcontrast,
140 .get = sd_getcontrast,
141 },
142 #define COLOR_IDX 2
143 {
144 {
145 .id = V4L2_CID_SATURATION,
146 .type = V4L2_CTRL_TYPE_INTEGER,
147 .name = "Saturation",
148 .minimum = 0,
149 .maximum = 40,
150 .step = 1,
151 #define COLOR_DEF 25
152 .default_value = COLOR_DEF,
153 },
154 .set = sd_setcolors,
155 .get = sd_getcolors,
156 },
157 #define BLUE_BALANCE_IDX 3
158 {
159 {
160 .id = V4L2_CID_BLUE_BALANCE,
161 .type = V4L2_CTRL_TYPE_INTEGER,
162 .name = "Blue Balance",
163 .minimum = 24,
164 .maximum = 40,
165 .step = 1,
166 #define BLUE_BALANCE_DEF 32
167 .default_value = BLUE_BALANCE_DEF,
168 },
169 .set = sd_setblue_balance,
170 .get = sd_getblue_balance,
171 },
172 #define RED_BALANCE_IDX 4
173 {
174 {
175 .id = V4L2_CID_RED_BALANCE,
176 .type = V4L2_CTRL_TYPE_INTEGER,
177 .name = "Red Balance",
178 .minimum = 24,
179 .maximum = 40,
180 .step = 1,
181 #define RED_BALANCE_DEF 32
182 .default_value = RED_BALANCE_DEF,
183 },
184 .set = sd_setred_balance,
185 .get = sd_getred_balance,
186 },
187 #define GAMMA_IDX 5
188 {
189 {
190 .id = V4L2_CID_GAMMA,
191 .type = V4L2_CTRL_TYPE_INTEGER,
192 .name = "Gamma",
193 .minimum = 0,
194 .maximum = 40,
195 .step = 1,
196 #define GAMMA_DEF 20
197 .default_value = GAMMA_DEF,
198 },
199 .set = sd_setgamma,
200 .get = sd_getgamma,
201 },
202 #define AUTOGAIN_IDX 6
203 {
204 {
205 .id = V4L2_CID_AUTOGAIN,
206 .type = V4L2_CTRL_TYPE_BOOLEAN,
207 .name = "Auto Gain",
208 .minimum = 0,
209 .maximum = 1,
210 .step = 1,
211 #define AUTOGAIN_DEF 1
212 .default_value = AUTOGAIN_DEF,
213 },
214 .set = sd_setautogain,
215 .get = sd_getautogain,
216 },
217 /* ov7630/ov7648 only */
218 #define VFLIP_IDX 7
219 {
220 {
221 .id = V4L2_CID_VFLIP,
222 .type = V4L2_CTRL_TYPE_BOOLEAN,
223 .name = "Vflip",
224 .minimum = 0,
225 .maximum = 1,
226 .step = 1,
227 #define VFLIP_DEF 0
228 .default_value = VFLIP_DEF,
229 },
230 .set = sd_setvflip,
231 .get = sd_getvflip,
232 },
233 #define SHARPNESS_IDX 8
234 {
235 {
236 .id = V4L2_CID_SHARPNESS,
237 .type = V4L2_CTRL_TYPE_INTEGER,
238 .name = "Sharpness",
239 .minimum = 0,
240 .maximum = 255,
241 .step = 1,
242 #define SHARPNESS_DEF 90
243 .default_value = SHARPNESS_DEF,
244 },
245 .set = sd_setsharpness,
246 .get = sd_getsharpness,
247 },
248 /* mt9v111 only */
249 #define INFRARED_IDX 9
250 {
251 {
252 .id = V4L2_CID_INFRARED,
253 .type = V4L2_CTRL_TYPE_BOOLEAN,
254 .name = "Infrared",
255 .minimum = 0,
256 .maximum = 1,
257 .step = 1,
258 #define INFRARED_DEF 0
259 .default_value = INFRARED_DEF,
260 },
261 .set = sd_setinfrared,
262 .get = sd_getinfrared,
263 },
264 /* ov7630/ov7648/ov7660 only */
265 #define FREQ_IDX 10
266 {
267 {
268 .id = V4L2_CID_POWER_LINE_FREQUENCY,
269 .type = V4L2_CTRL_TYPE_MENU,
270 .name = "Light frequency filter",
271 .minimum = 0,
272 .maximum = 2, /* 0: 0, 1: 50Hz, 2:60Hz */
273 .step = 1,
274 #define FREQ_DEF 1
275 .default_value = FREQ_DEF,
276 },
277 .set = sd_setfreq,
278 .get = sd_getfreq,
279 },
280 };
281
282 /* table of the disabled controls */
283 static __u32 ctrl_dis[] = {
284 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX) |
285 (1 << AUTOGAIN_IDX), /* SENSOR_ADCM1700 0 */
286 (1 << INFRARED_IDX) | (1 << FREQ_IDX),
287 /* SENSOR_HV7131R 1 */
288 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
289 /* SENSOR_MI0360 2 */
290 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
291 /* SENSOR_MO4000 3 */
292 (1 << VFLIP_IDX) | (1 << FREQ_IDX),
293 /* SENSOR_MT9V111 4 */
294 (1 << INFRARED_IDX) | (1 << VFLIP_IDX) | (1 << FREQ_IDX),
295 /* SENSOR_OM6802 5 */
296 (1 << INFRARED_IDX),
297 /* SENSOR_OV7630 6 */
298 (1 << INFRARED_IDX),
299 /* SENSOR_OV7648 7 */
300 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX),
301 /* SENSOR_OV7660 8 */
302 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX) |
303 (1 << FREQ_IDX), /* SENSOR_PO1030 9 */
304 (1 << AUTOGAIN_IDX) | (1 << INFRARED_IDX) | (1 << VFLIP_IDX) |
305 (1 << FREQ_IDX), /* SENSOR_SP80708 10 */
306 };
307
308 static const struct v4l2_pix_format cif_mode[] = {
309 {352, 288, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
310 .bytesperline = 352,
311 .sizeimage = 352 * 288 * 4 / 8 + 590,
312 .colorspace = V4L2_COLORSPACE_JPEG,
313 .priv = 0},
314 };
315 static const struct v4l2_pix_format vga_mode[] = {
316 {160, 120, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
317 .bytesperline = 160,
318 .sizeimage = 160 * 120 * 4 / 8 + 590,
319 .colorspace = V4L2_COLORSPACE_JPEG,
320 .priv = 2},
321 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
322 .bytesperline = 320,
323 .sizeimage = 320 * 240 * 3 / 8 + 590,
324 .colorspace = V4L2_COLORSPACE_JPEG,
325 .priv = 1},
326 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
327 .bytesperline = 640,
328 /* Note 3 / 8 is not large enough, not even 5 / 8 is ?! */
329 .sizeimage = 640 * 480 * 3 / 4 + 590,
330 .colorspace = V4L2_COLORSPACE_JPEG,
331 .priv = 0},
332 };
333
334 static const u8 sn_adcm1700[0x1c] = {
335 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
336 0x00, 0x43, 0x60, 0x00, 0x1a, 0x00, 0x00, 0x00,
337 /* reg8 reg9 rega regb regc regd rege regf */
338 0x80, 0x51, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
339 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
340 0x03, 0x00, 0x05, 0x01, 0x05, 0x16, 0x12, 0x42,
341 /* reg18 reg19 reg1a reg1b */
342 0x06, 0x00, 0x00, 0x00
343 };
344
345 /*Data from sn9c102p+hv7131r */
346 static const u8 sn_hv7131[0x1c] = {
347 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
348 0x00, 0x03, 0x64, 0x00, 0x1a, 0x20, 0x20, 0x20,
349 /* reg8 reg9 rega regb regc regd rege regf */
350 0x81, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
351 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
352 0x03, 0x00, 0x00, 0x01, 0x03, 0x28, 0x1e, 0x41,
353 /* reg18 reg19 reg1a reg1b */
354 0x0a, 0x00, 0x00, 0x00
355 };
356
357 static const u8 sn_mi0360[0x1c] = {
358 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
359 0x00, 0x61, 0x44, 0x00, 0x1a, 0x20, 0x20, 0x20,
360 /* reg8 reg9 rega regb regc regd rege regf */
361 0x81, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
362 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
363 0x03, 0x00, 0x00, 0x02, 0x0a, 0x28, 0x1e, 0x61,
364 /* reg18 reg19 reg1a reg1b */
365 0x06, 0x00, 0x00, 0x00
366 };
367
368 static const u8 sn_mo4000[0x1c] = {
369 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
370 0x00, 0x23, 0x60, 0x00, 0x1a, 0x00, 0x20, 0x18,
371 /* reg8 reg9 rega regb regc regd rege regf */
372 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
373 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
374 0x03, 0x00, 0x0b, 0x0f, 0x14, 0x28, 0x1e, 0x40,
375 /* reg18 reg19 reg1a reg1b */
376 0x08, 0x00, 0x00, 0x00
377 };
378
379 static const u8 sn_mt9v111[0x1c] = {
380 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
381 0x00, 0x61, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
382 /* reg8 reg9 rega regb regc regd rege regf */
383 0x81, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
384 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
385 0x03, 0x00, 0x00, 0x02, 0x1c, 0x28, 0x1e, 0x40,
386 /* reg18 reg19 reg1a reg1b */
387 0x06, 0x00, 0x00, 0x00
388 };
389
390 static const u8 sn_om6802[0x1c] = {
391 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
392 0x00, 0x23, 0x72, 0x00, 0x1a, 0x20, 0x20, 0x19,
393 /* reg8 reg9 rega regb regc regd rege regf */
394 0x80, 0x34, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
395 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
396 0x03, 0x00, 0x51, 0x01, 0x00, 0x28, 0x1e, 0x40,
397 /* reg18 reg19 reg1a reg1b */
398 0x05, 0x00, 0x00, 0x00
399 };
400
401 static const u8 sn_ov7630[0x1c] = {
402 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
403 0x00, 0x21, 0x40, 0x00, 0x1a, 0x20, 0x1f, 0x20,
404 /* reg8 reg9 rega regb regc regd rege regf */
405 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
406 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
407 0x03, 0x00, 0x04, 0x01, 0x0a, 0x28, 0x1e, 0xc2,
408 /* reg18 reg19 reg1a reg1b */
409 0x0b, 0x00, 0x00, 0x00
410 };
411
412 static const u8 sn_ov7648[0x1c] = {
413 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
414 0x00, 0x63, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
415 /* reg8 reg9 rega regb regc regd rege regf */
416 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
417 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
418 0x03, 0x00, 0x00, 0x01, 0x00, 0x28, 0x1e, 0x00,
419 /* reg18 reg19 reg1a reg1b */
420 0x0b, 0x00, 0x00, 0x00
421 };
422
423 static const u8 sn_ov7660[0x1c] = {
424 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
425 0x00, 0x61, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
426 /* reg8 reg9 rega regb regc regd rege regf */
427 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
428 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
429 0x03, 0x00, 0x01, 0x01, 0x08, 0x28, 0x1e, 0x20,
430 /* reg18 reg19 reg1a reg1b */
431 0x07, 0x00, 0x00, 0x00
432 };
433
434 static const u8 sn_po1030[0x1c] = {
435 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
436 0x00, 0x21, 0x62, 0x00, 0x1a, 0x20, 0x20, 0x20,
437 /* reg8 reg9 rega regb regc regd rege regf */
438 0x81, 0x6e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
439 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
440 0x03, 0x00, 0x00, 0x06, 0x06, 0x28, 0x1e, 0x00,
441 /* reg18 reg19 reg1a reg1b */
442 0x07, 0x00, 0x00, 0x00
443 };
444
445 static const u8 sn_sp80708[0x1c] = {
446 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
447 0x00, 0x63, 0x60, 0x00, 0x1a, 0x20, 0x20, 0x20,
448 /* reg8 reg9 rega regb regc regd rege regf */
449 0x81, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
450 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
451 0x03, 0x00, 0x00, 0x03, 0x04, 0x28, 0x1e, 0x00,
452 /* reg18 reg19 reg1a reg1b */
453 0x07, 0x00, 0x00, 0x00
454 };
455
456 /* sequence specific to the sensors - !! index = SENSOR_xxx */
457 static const u8 *sn_tb[] = {
458 sn_adcm1700,
459 sn_hv7131,
460 sn_mi0360,
461 sn_mo4000,
462 sn_mt9v111,
463 sn_om6802,
464 sn_ov7630,
465 sn_ov7648,
466 sn_ov7660,
467 sn_po1030,
468 sn_sp80708
469 };
470
471 /* default gamma table */
472 static const u8 gamma_def[17] = {
473 0x00, 0x2d, 0x46, 0x5a, 0x6c, 0x7c, 0x8b, 0x99,
474 0xa6, 0xb2, 0xbf, 0xca, 0xd5, 0xe0, 0xeb, 0xf5, 0xff
475 };
476 /* gamma for sensor ADCM1700 */
477 static const u8 gamma_spec_0[17] = {
478 0x0f, 0x39, 0x5a, 0x74, 0x86, 0x95, 0xa6, 0xb4,
479 0xbd, 0xc4, 0xcc, 0xd4, 0xd5, 0xde, 0xe4, 0xed, 0xf5
480 };
481 /* gamma for sensors HV7131R and MT9V111 */
482 static const u8 gamma_spec_1[17] = {
483 0x08, 0x3a, 0x52, 0x65, 0x75, 0x83, 0x91, 0x9d,
484 0xa9, 0xb4, 0xbe, 0xc8, 0xd2, 0xdb, 0xe4, 0xed, 0xf5
485 };
486 /* gamma for sensor SP80708 */
487 static const u8 gamma_spec_2[17] = {
488 0x0a, 0x2d, 0x4e, 0x68, 0x7d, 0x8f, 0x9f, 0xab,
489 0xb7, 0xc2, 0xcc, 0xd3, 0xd8, 0xde, 0xe2, 0xe5, 0xe6
490 };
491
492 /* color matrix and offsets */
493 static const u8 reg84[] = {
494 0x14, 0x00, 0x27, 0x00, 0x07, 0x00, /* YR YG YB gains */
495 0xe8, 0x0f, 0xda, 0x0f, 0x40, 0x00, /* UR UG UB */
496 0x3e, 0x00, 0xcd, 0x0f, 0xf7, 0x0f, /* VR VG VB */
497 0x00, 0x00, 0x00 /* YUV offsets */
498 };
499 static const u8 adcm1700_sensor_init[][8] = {
500 {0xa0, 0x51, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x10},
501 {0xb0, 0x51, 0x04, 0x08, 0x00, 0x00, 0x00, 0x10}, /* reset */
502 {0xdd, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
503 {0xb0, 0x51, 0x04, 0x00, 0x00, 0x00, 0x00, 0x10},
504 {0xdd, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
505 {0xb0, 0x51, 0x0c, 0xe0, 0x2e, 0x00, 0x00, 0x10},
506 {0xb0, 0x51, 0x10, 0x02, 0x02, 0x00, 0x00, 0x10},
507 {0xb0, 0x51, 0x14, 0x0e, 0x0e, 0x00, 0x00, 0x10},
508 {0xb0, 0x51, 0x1c, 0x00, 0x80, 0x00, 0x00, 0x10},
509 {0xb0, 0x51, 0x20, 0x01, 0x00, 0x00, 0x00, 0x10},
510 {0xdd, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
511 {0xb0, 0x51, 0x04, 0x04, 0x00, 0x00, 0x00, 0x10},
512 {0xdd, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
513 {0xb0, 0x51, 0x04, 0x01, 0x00, 0x00, 0x00, 0x10},
514 {0xa0, 0x51, 0xfe, 0x10, 0x00, 0x00, 0x00, 0x10},
515 {0xb0, 0x51, 0x14, 0x01, 0x00, 0x00, 0x00, 0x10},
516 {0xb0, 0x51, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
517 {}
518 };
519 static const u8 adcm1700_sensor_param1[][8] = {
520 {0xb0, 0x51, 0x26, 0xf9, 0x01, 0x00, 0x00, 0x10}, /* exposure? */
521 {0xd0, 0x51, 0x1e, 0x8e, 0x8e, 0x8e, 0x8e, 0x10},
522
523 {0xa0, 0x51, 0xfe, 0x01, 0x00, 0x00, 0x00, 0x10},
524 {0xb0, 0x51, 0x00, 0x02, 0x00, 0x00, 0x00, 0x10},
525 {0xa0, 0x51, 0xfe, 0x10, 0x00, 0x00, 0x00, 0x10},
526 {0xb0, 0x51, 0x32, 0x00, 0x72, 0x00, 0x00, 0x10},
527 {0xd0, 0x51, 0x1e, 0xbe, 0xd7, 0xe8, 0xbe, 0x10}, /* exposure? */
528
529 {0xa0, 0x51, 0xfe, 0x01, 0x00, 0x00, 0x00, 0x10},
530 {0xb0, 0x51, 0x00, 0x02, 0x00, 0x00, 0x00, 0x10},
531 {0xa0, 0x51, 0xfe, 0x10, 0x00, 0x00, 0x00, 0x10},
532 {0xb0, 0x51, 0x32, 0x00, 0xa2, 0x00, 0x00, 0x10},
533 {}
534 };
535 static const u8 hv7131r_sensor_init[][8] = {
536 {0xc1, 0x11, 0x01, 0x08, 0x01, 0x00, 0x00, 0x10},
537 {0xb1, 0x11, 0x34, 0x17, 0x7f, 0x00, 0x00, 0x10},
538 {0xd1, 0x11, 0x40, 0xff, 0x7f, 0x7f, 0x7f, 0x10},
539 /* {0x91, 0x11, 0x44, 0x00, 0x00, 0x00, 0x00, 0x10}, */
540 {0xd1, 0x11, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
541 {0xd1, 0x11, 0x14, 0x01, 0xe2, 0x02, 0x82, 0x10},
542 /* {0x91, 0x11, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10}, */
543
544 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
545 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
546 {0xc1, 0x11, 0x25, 0x00, 0x61, 0xa8, 0x00, 0x10},
547 {0xa1, 0x11, 0x30, 0x22, 0x00, 0x00, 0x00, 0x10},
548 {0xc1, 0x11, 0x31, 0x20, 0x2e, 0x20, 0x00, 0x10},
549 {0xc1, 0x11, 0x25, 0x00, 0xc3, 0x50, 0x00, 0x10},
550 {0xa1, 0x11, 0x30, 0x07, 0x00, 0x00, 0x00, 0x10}, /* gain14 */
551 {0xc1, 0x11, 0x31, 0x10, 0x10, 0x10, 0x00, 0x10}, /* r g b 101a10 */
552
553 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
554 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
555 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
556 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
557 {0xa1, 0x11, 0x23, 0x09, 0x00, 0x00, 0x00, 0x10},
558
559 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
560 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
561 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
562 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
563 {0xa1, 0x11, 0x23, 0x10, 0x00, 0x00, 0x00, 0x10},
564 {0xa1, 0x11, 0x01, 0x18, 0x00, 0x00, 0x00, 0x10},
565 /* set sensor clock */
566 {}
567 };
568 static const u8 mi0360_sensor_init[][8] = {
569 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
570 {0xb1, 0x5d, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10},
571 {0xb1, 0x5d, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
572 {0xd1, 0x5d, 0x01, 0x00, 0x08, 0x00, 0x16, 0x10},
573 {0xd1, 0x5d, 0x03, 0x01, 0xe2, 0x02, 0x82, 0x10},
574 {0xd1, 0x5d, 0x05, 0x00, 0x09, 0x00, 0x53, 0x10},
575 {0xb1, 0x5d, 0x0d, 0x00, 0x02, 0x00, 0x00, 0x10},
576 {0xd1, 0x5d, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
577 {0xd1, 0x5d, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10},
578 {0xd1, 0x5d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
579 {0xd1, 0x5d, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
580 {0xd1, 0x5d, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
581 {0xd1, 0x5d, 0x14, 0x00, 0x00, 0x00, 0x00, 0x10},
582 {0xd1, 0x5d, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10},
583 {0xd1, 0x5d, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10},
584 {0xd1, 0x5d, 0x1a, 0x00, 0x00, 0x00, 0x00, 0x10},
585 {0xd1, 0x5d, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x10},
586 {0xb1, 0x5d, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
587 {0xd1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
588 {0xd1, 0x5d, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
589 {0xd1, 0x5d, 0x24, 0x00, 0x00, 0x00, 0x00, 0x10},
590 {0xd1, 0x5d, 0x26, 0x00, 0x00, 0x00, 0x24, 0x10},
591 {0xd1, 0x5d, 0x2f, 0xf7, 0xB0, 0x00, 0x04, 0x10},
592 {0xd1, 0x5d, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10},
593 {0xd1, 0x5d, 0x33, 0x00, 0x00, 0x01, 0x00, 0x10},
594 {0xb1, 0x5d, 0x3d, 0x06, 0x8f, 0x00, 0x00, 0x10},
595 {0xd1, 0x5d, 0x40, 0x01, 0xe0, 0x00, 0xd1, 0x10},
596 {0xb1, 0x5d, 0x44, 0x00, 0x82, 0x00, 0x00, 0x10},
597 {0xd1, 0x5d, 0x58, 0x00, 0x78, 0x00, 0x43, 0x10},
598 {0xd1, 0x5d, 0x5a, 0x00, 0x00, 0x00, 0x00, 0x10},
599 {0xd1, 0x5d, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x10},
600 {0xd1, 0x5d, 0x5e, 0x00, 0x00, 0xa3, 0x1d, 0x10},
601 {0xb1, 0x5d, 0x62, 0x04, 0x11, 0x00, 0x00, 0x10},
602
603 {0xb1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
604 {0xb1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
605 {0xb1, 0x5d, 0x09, 0x00, 0x64, 0x00, 0x00, 0x10},
606 {0xd1, 0x5d, 0x2b, 0x00, 0xa0, 0x00, 0xb0, 0x10},
607 {0xd1, 0x5d, 0x2d, 0x00, 0xa0, 0x00, 0xa0, 0x10},
608
609 {0xb1, 0x5d, 0x0a, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor clck ?2 */
610 {0xb1, 0x5d, 0x06, 0x00, 0x30, 0x00, 0x00, 0x10},
611 {0xb1, 0x5d, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10},
612 {0xb1, 0x5d, 0x09, 0x02, 0x35, 0x00, 0x00, 0x10}, /* exposure 2 */
613
614 {0xd1, 0x5d, 0x2b, 0x00, 0xb9, 0x00, 0xe3, 0x10},
615 {0xd1, 0x5d, 0x2d, 0x00, 0x5f, 0x00, 0xb9, 0x10}, /* 42 */
616 /* {0xb1, 0x5d, 0x35, 0x00, 0x67, 0x00, 0x00, 0x10}, * gain orig */
617 /* {0xb1, 0x5d, 0x35, 0x00, 0x20, 0x00, 0x00, 0x10}, * gain */
618 {0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10}, /* update */
619 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor on */
620 {}
621 };
622 static const u8 mo4000_sensor_init[][8] = {
623 {0xa1, 0x21, 0x01, 0x02, 0x00, 0x00, 0x00, 0x10},
624 {0xa1, 0x21, 0x02, 0x00, 0x00, 0x00, 0x00, 0x10},
625 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
626 {0xa1, 0x21, 0x04, 0x00, 0x00, 0x00, 0x00, 0x10},
627 {0xa1, 0x21, 0x05, 0x00, 0x00, 0x00, 0x00, 0x10},
628 {0xa1, 0x21, 0x05, 0x04, 0x00, 0x00, 0x00, 0x10},
629 {0xa1, 0x21, 0x06, 0x80, 0x00, 0x00, 0x00, 0x10},
630 {0xa1, 0x21, 0x06, 0x81, 0x00, 0x00, 0x00, 0x10},
631 {0xa1, 0x21, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
632 {0xa1, 0x21, 0x11, 0x00, 0x00, 0x00, 0x00, 0x10},
633 {0xa1, 0x21, 0x11, 0x20, 0x00, 0x00, 0x00, 0x10},
634 {0xa1, 0x21, 0x11, 0x30, 0x00, 0x00, 0x00, 0x10},
635 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
636 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
637 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
638 {0xa1, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
639 {0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10},
640 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10},
641 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
642 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
643 {}
644 };
645 static const u8 mt9v111_sensor_init[][8] = {
646 {0xb1, 0x5c, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10}, /* reset? */
647 {0xdd, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
648 {0xb1, 0x5c, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
649 {0xb1, 0x5c, 0x01, 0x00, 0x01, 0x00, 0x00, 0x10}, /* IFP select */
650 {0xb1, 0x5c, 0x08, 0x04, 0x80, 0x00, 0x00, 0x10}, /* output fmt ctrl */
651 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10}, /* op mode ctrl */
652 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10},
653 {0xb1, 0x5c, 0x03, 0x01, 0xe1, 0x00, 0x00, 0x10},
654 {0xb1, 0x5c, 0x04, 0x02, 0x81, 0x00, 0x00, 0x10},
655 {0xb1, 0x5c, 0x05, 0x00, 0x04, 0x00, 0x00, 0x10},
656 {0xb1, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10}, /* sensor select */
657 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10},
658 {0xb1, 0x5c, 0x03, 0x01, 0xe6, 0x00, 0x00, 0x10},
659 {0xb1, 0x5c, 0x04, 0x02, 0x86, 0x00, 0x00, 0x10},
660 {0xb1, 0x5c, 0x05, 0x00, 0x04, 0x00, 0x00, 0x10},
661 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10},
662 {0xb1, 0x5c, 0x08, 0x00, 0x08, 0x00, 0x00, 0x10}, /* row start */
663 {0xb1, 0x5c, 0x0e, 0x00, 0x08, 0x00, 0x00, 0x10},
664 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10}, /* col start */
665 {0xb1, 0x5c, 0x03, 0x01, 0xe7, 0x00, 0x00, 0x10}, /* window height */
666 {0xb1, 0x5c, 0x04, 0x02, 0x87, 0x00, 0x00, 0x10}, /* window width */
667 {0xb1, 0x5c, 0x07, 0x30, 0x02, 0x00, 0x00, 0x10}, /* output ctrl */
668 {0xb1, 0x5c, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10}, /* shutter delay */
669 {0xb1, 0x5c, 0x12, 0x00, 0xb0, 0x00, 0x00, 0x10}, /* zoom col start */
670 {0xb1, 0x5c, 0x13, 0x00, 0x7c, 0x00, 0x00, 0x10}, /* zoom row start */
671 {0xb1, 0x5c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* digital zoom */
672 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10}, /* read mode */
673 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
674 {}
675 };
676 static const u8 mt9v111_sensor_param1[][8] = {
677 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
678 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
679 {0xb1, 0x5c, 0x09, 0x01, 0x2c, 0x00, 0x00, 0x10},
680 {0xd1, 0x5c, 0x2b, 0x00, 0x33, 0x00, 0xa0, 0x10}, /* green1 gain */
681 {0xd1, 0x5c, 0x2d, 0x00, 0xa0, 0x00, 0x33, 0x10}, /* red gain */
682 /*******/
683 {0xb1, 0x5c, 0x06, 0x00, 0x1e, 0x00, 0x00, 0x10}, /* vert blanking */
684 {0xb1, 0x5c, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10}, /* horiz blanking */
685 {0xd1, 0x5c, 0x2c, 0x00, 0xad, 0x00, 0xad, 0x10}, /* blue gain */
686 {0xb1, 0x5c, 0x35, 0x01, 0xc0, 0x00, 0x00, 0x10}, /* global gain */
687 {}
688 };
689 static const u8 om6802_init0[2][8] = {
690 /*fixme: variable*/
691 {0xa0, 0x34, 0x29, 0x0e, 0x00, 0x00, 0x00, 0x10},
692 {0xa0, 0x34, 0x23, 0xb0, 0x00, 0x00, 0x00, 0x10},
693 };
694 static const u8 om6802_sensor_init[][8] = {
695 {0xa0, 0x34, 0xdf, 0x6d, 0x00, 0x00, 0x00, 0x10},
696 /* factory mode */
697 {0xa0, 0x34, 0xdd, 0x18, 0x00, 0x00, 0x00, 0x10},
698 /* output raw RGB */
699 {0xa0, 0x34, 0x5a, 0xc0, 0x00, 0x00, 0x00, 0x10},
700 /* {0xa0, 0x34, 0xfb, 0x11, 0x00, 0x00, 0x00, 0x10}, */
701 {0xa0, 0x34, 0xf0, 0x04, 0x00, 0x00, 0x00, 0x10},
702 /* auto-exposure speed (0) / white balance mode (auto RGB) */
703 /* {0xa0, 0x34, 0xf1, 0x02, 0x00, 0x00, 0x00, 0x10},
704 * set color mode */
705 /* {0xa0, 0x34, 0xfe, 0x5b, 0x00, 0x00, 0x00, 0x10},
706 * max AGC value in AE */
707 /* {0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10},
708 * preset AGC */
709 /* {0xa0, 0x34, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x10},
710 * preset brightness */
711 /* {0xa0, 0x34, 0xe7, 0x00, 0x00, 0x00, 0x00, 0x10},
712 * preset contrast */
713 /* {0xa0, 0x34, 0xe8, 0x31, 0x00, 0x00, 0x00, 0x10},
714 * preset gamma */
715 {0xa0, 0x34, 0xe9, 0x0f, 0x00, 0x00, 0x00, 0x10},
716 /* luminance mode (0x4f -> AutoExpo on) */
717 {0xa0, 0x34, 0xe4, 0xff, 0x00, 0x00, 0x00, 0x10},
718 /* preset shutter */
719 /* {0xa0, 0x34, 0xef, 0x00, 0x00, 0x00, 0x00, 0x10},
720 * auto frame rate */
721 /* {0xa0, 0x34, 0xfb, 0xee, 0x00, 0x00, 0x00, 0x10}, */
722 {0xa0, 0x34, 0x5d, 0x80, 0x00, 0x00, 0x00, 0x10},
723 {}
724 };
725 static const u8 om6802_sensor_param1[][8] = {
726 {0xa0, 0x34, 0x71, 0x84, 0x00, 0x00, 0x00, 0x10},
727 {0xa0, 0x34, 0x72, 0x05, 0x00, 0x00, 0x00, 0x10},
728 {0xa0, 0x34, 0x68, 0x80, 0x00, 0x00, 0x00, 0x10},
729 {0xa0, 0x34, 0x69, 0x01, 0x00, 0x00, 0x00, 0x10},
730 {}
731 };
732 static const u8 ov7630_sensor_init[][8] = {
733 {0xa1, 0x21, 0x76, 0x01, 0x00, 0x00, 0x00, 0x10},
734 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
735 {0xdd, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
736 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
737 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
738 {0xdd, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
739 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
740 /* win: i2c_r from 00 to 80 */
741 {0xd1, 0x21, 0x03, 0x80, 0x10, 0x20, 0x80, 0x10},
742 {0xb1, 0x21, 0x0c, 0x20, 0x20, 0x00, 0x00, 0x10},
743 /* HDG: 0x11 was 0x00 change to 0x01 for better exposure (15 fps instead of 30)
744 0x13 was 0xc0 change to 0xc3 for auto gain and exposure */
745 {0xd1, 0x21, 0x11, 0x01, 0x48, 0xc3, 0x00, 0x10},
746 {0xb1, 0x21, 0x15, 0x80, 0x03, 0x00, 0x00, 0x10},
747 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
748 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
749 {0xd1, 0x21, 0x1f, 0x00, 0x80, 0x80, 0x80, 0x10},
750 {0xd1, 0x21, 0x23, 0xde, 0x10, 0x8a, 0xa0, 0x10},
751 {0xc1, 0x21, 0x27, 0xca, 0xa2, 0x74, 0x00, 0x10},
752 {0xd1, 0x21, 0x2a, 0x88, 0x00, 0x88, 0x01, 0x10},
753 {0xc1, 0x21, 0x2e, 0x80, 0x00, 0x18, 0x00, 0x10},
754 {0xa1, 0x21, 0x21, 0x08, 0x00, 0x00, 0x00, 0x10},
755 {0xa1, 0x21, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
756 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10},
757 {0xb1, 0x21, 0x32, 0xc2, 0x08, 0x00, 0x00, 0x10},
758 {0xb1, 0x21, 0x4c, 0x00, 0x00, 0x00, 0x00, 0x10},
759 {0xd1, 0x21, 0x60, 0x05, 0x40, 0x12, 0x57, 0x10},
760 {0xa1, 0x21, 0x64, 0x73, 0x00, 0x00, 0x00, 0x10},
761 {0xd1, 0x21, 0x65, 0x00, 0x55, 0x01, 0xac, 0x10},
762 {0xa1, 0x21, 0x69, 0x38, 0x00, 0x00, 0x00, 0x10},
763 {0xd1, 0x21, 0x6f, 0x1f, 0x01, 0x00, 0x10, 0x10},
764 {0xd1, 0x21, 0x73, 0x50, 0x20, 0x02, 0x01, 0x10},
765 {0xd1, 0x21, 0x77, 0xf3, 0x90, 0x98, 0x98, 0x10},
766 {0xc1, 0x21, 0x7b, 0x00, 0x4c, 0xf7, 0x00, 0x10},
767 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
768 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
769 /* */
770 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
771 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
772 /*fixme: + 0x12, 0x04*/
773 /* {0xa1, 0x21, 0x75, 0x82, 0x00, 0x00, 0x00, 0x10}, * COMN
774 * set by setvflip */
775 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
776 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
777 {0xb1, 0x21, 0x01, 0x80, 0x80, 0x00, 0x00, 0x10},
778 /* */
779 /* {0xa1, 0x21, 0x2a, 0x88, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
780 /* {0xa1, 0x21, 0x2b, 0x34, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
781 /* */
782 {0xa1, 0x21, 0x10, 0x83, 0x00, 0x00, 0x00, 0x10},
783 /* {0xb1, 0x21, 0x01, 0x88, 0x70, 0x00, 0x00, 0x10}, */
784 {}
785 };
786
787 static const u8 ov7648_sensor_init[][8] = {
788 {0xa1, 0x21, 0x76, 0x00, 0x00, 0x00, 0x00, 0x10},
789 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset */
790 {0xdd, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
791 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
792 {0xd1, 0x21, 0x03, 0xa4, 0x30, 0x88, 0x00, 0x10},
793 {0xb1, 0x21, 0x11, 0x80, 0x08, 0x00, 0x00, 0x10},
794 {0xc1, 0x21, 0x13, 0xa0, 0x04, 0x84, 0x00, 0x10},
795 {0xd1, 0x21, 0x17, 0x1a, 0x02, 0xba, 0xf4, 0x10},
796 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
797 {0xd1, 0x21, 0x1f, 0x41, 0xc0, 0x80, 0x80, 0x10},
798 {0xd1, 0x21, 0x23, 0xde, 0xa0, 0x80, 0x32, 0x10},
799 {0xd1, 0x21, 0x27, 0xfe, 0xa0, 0x00, 0x91, 0x10},
800 {0xd1, 0x21, 0x2b, 0x00, 0x88, 0x85, 0x80, 0x10},
801 {0xc1, 0x21, 0x2f, 0x9c, 0x00, 0xc4, 0x00, 0x10},
802 {0xd1, 0x21, 0x60, 0xa6, 0x60, 0x88, 0x12, 0x10},
803 {0xd1, 0x21, 0x64, 0x88, 0x00, 0x00, 0x94, 0x10},
804 {0xd1, 0x21, 0x68, 0x7a, 0x0c, 0x00, 0x00, 0x10},
805 {0xd1, 0x21, 0x6c, 0x11, 0x33, 0x22, 0x00, 0x10},
806 {0xd1, 0x21, 0x70, 0x11, 0x00, 0x10, 0x50, 0x10},
807 {0xd1, 0x21, 0x74, 0x20, 0x06, 0x00, 0xb5, 0x10},
808 {0xd1, 0x21, 0x78, 0x8a, 0x00, 0x00, 0x00, 0x10},
809 {0xb1, 0x21, 0x7c, 0x00, 0x43, 0x00, 0x00, 0x10},
810
811 {0xd1, 0x21, 0x21, 0x86, 0x00, 0xde, 0xa0, 0x10},
812 /* {0xd1, 0x21, 0x25, 0x80, 0x32, 0xfe, 0xa0, 0x10}, jfm done */
813 /* {0xd1, 0x21, 0x29, 0x00, 0x91, 0x00, 0x88, 0x10}, jfm done */
814 /* {0xb1, 0x21, 0x2d, 0x85, 0x00, 0x00, 0x00, 0x10}, set by setfreq */
815 {}
816 };
817 static const u8 ov7648_sensor_param1[][8] = {
818 /* {0xa1, 0x21, 0x12, 0x08, 0x00, 0x00, 0x00, 0x10}, jfm done */
819 /* {0xa1, 0x21, 0x75, 0x06, 0x00, 0x00, 0x00, 0x10}, * COMN
820 * set by setvflip */
821 {0xa1, 0x21, 0x19, 0x02, 0x00, 0x00, 0x00, 0x10},
822 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
823 /* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
824 /* {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10}, * GAIN - def */
825 /* {0xb1, 0x21, 0x01, 0x6c, 0x6c, 0x00, 0x00, 0x10}, * B R - def: 80 */
826 /*...*/
827 {0xa1, 0x21, 0x11, 0x81, 0x00, 0x00, 0x00, 0x10}, /* CLKRC */
828 /* {0xa1, 0x21, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
829 /* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
830 /* {0xa1, 0x21, 0x2a, 0x91, 0x00, 0x00, 0x00, 0x10}, jfm done */
831 /* {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
832 /* {0xb1, 0x21, 0x01, 0x64, 0x84, 0x00, 0x00, 0x10}, * B R - def: 80 */
833
834 {}
835 };
836
837 static const u8 ov7660_sensor_init[][8] = {
838 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset SCCB */
839 {0xdd, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
840 {0xa1, 0x21, 0x12, 0x05, 0x00, 0x00, 0x00, 0x10},
841 /* Outformat = rawRGB */
842 {0xa1, 0x21, 0x13, 0xb8, 0x00, 0x00, 0x00, 0x10}, /* init COM8 */
843 {0xd1, 0x21, 0x00, 0x01, 0x74, 0x92, 0x00, 0x10},
844 /* GAIN BLUE RED VREF */
845 {0xd1, 0x21, 0x04, 0x00, 0x7d, 0x62, 0x00, 0x10},
846 /* COM 1 BAVE GEAVE AECHH */
847 {0xb1, 0x21, 0x08, 0x83, 0x01, 0x00, 0x00, 0x10}, /* RAVE COM2 */
848 {0xd1, 0x21, 0x0c, 0x00, 0x08, 0x04, 0x4f, 0x10}, /* COM 3 4 5 6 */
849 {0xd1, 0x21, 0x10, 0x7f, 0x40, 0x05, 0xff, 0x10},
850 /* AECH CLKRC COM7 COM8 */
851 {0xc1, 0x21, 0x14, 0x2c, 0x00, 0x02, 0x00, 0x10}, /* COM9 COM10 */
852 {0xd1, 0x21, 0x17, 0x10, 0x60, 0x02, 0x7b, 0x10},
853 /* HSTART HSTOP VSTRT VSTOP */
854 {0xa1, 0x21, 0x1b, 0x02, 0x00, 0x00, 0x00, 0x10}, /* PSHFT */
855 {0xb1, 0x21, 0x1e, 0x01, 0x0e, 0x00, 0x00, 0x10}, /* MVFP LAEC */
856 {0xd1, 0x21, 0x20, 0x07, 0x07, 0x07, 0x07, 0x10},
857 /* BOS GBOS GROS ROS (BGGR offset) */
858 /* {0xd1, 0x21, 0x24, 0x68, 0x58, 0xd4, 0x80, 0x10}, */
859 {0xd1, 0x21, 0x24, 0x78, 0x68, 0xd4, 0x80, 0x10},
860 /* AEW AEB VPT BBIAS */
861 {0xd1, 0x21, 0x28, 0x80, 0x30, 0x00, 0x00, 0x10},
862 /* GbBIAS RSVD EXHCH EXHCL */
863 {0xd1, 0x21, 0x2c, 0x80, 0x00, 0x00, 0x62, 0x10},
864 /* RBIAS ADVFL ASDVFH YAVE */
865 {0xc1, 0x21, 0x30, 0x08, 0x30, 0xb4, 0x00, 0x10},
866 /* HSYST HSYEN HREF */
867 {0xd1, 0x21, 0x33, 0x00, 0x07, 0x84, 0x00, 0x10}, /* reserved */
868 {0xd1, 0x21, 0x37, 0x0c, 0x02, 0x43, 0x00, 0x10},
869 /* ADC ACOM OFON TSLB */
870 {0xd1, 0x21, 0x3b, 0x02, 0x6c, 0x19, 0x0e, 0x10},
871 /* COM11 COM12 COM13 COM14 */
872 {0xd1, 0x21, 0x3f, 0x41, 0xc1, 0x22, 0x08, 0x10},
873 /* EDGE COM15 COM16 COM17 */
874 {0xd1, 0x21, 0x43, 0xf0, 0x10, 0x78, 0xa8, 0x10}, /* reserved */
875 {0xd1, 0x21, 0x47, 0x60, 0x80, 0x00, 0x00, 0x10}, /* reserved */
876 {0xd1, 0x21, 0x4b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* reserved */
877 {0xd1, 0x21, 0x4f, 0x46, 0x36, 0x0f, 0x17, 0x10}, /* MTX 1 2 3 4 */
878 {0xd1, 0x21, 0x53, 0x7f, 0x96, 0x40, 0x40, 0x10}, /* MTX 5 6 7 8 */
879 {0xb1, 0x21, 0x57, 0x40, 0x0f, 0x00, 0x00, 0x10}, /* MTX9 MTXS */
880 {0xd1, 0x21, 0x59, 0xba, 0x9a, 0x22, 0xb9, 0x10}, /* reserved */
881 {0xd1, 0x21, 0x5d, 0x9b, 0x10, 0xf0, 0x05, 0x10}, /* reserved */
882 {0xa1, 0x21, 0x61, 0x60, 0x00, 0x00, 0x00, 0x10}, /* reserved */
883 {0xd1, 0x21, 0x62, 0x00, 0x00, 0x50, 0x30, 0x10},
884 /* LCC1 LCC2 LCC3 LCC4 */
885 {0xa1, 0x21, 0x66, 0x00, 0x00, 0x00, 0x00, 0x10}, /* LCC5 */
886 {0xd1, 0x21, 0x67, 0x80, 0x7a, 0x90, 0x80, 0x10}, /* MANU */
887 {0xa1, 0x21, 0x6b, 0x0a, 0x00, 0x00, 0x00, 0x10},
888 /* band gap reference [0:3] DBLV */
889 {0xd1, 0x21, 0x6c, 0x30, 0x48, 0x80, 0x74, 0x10}, /* gamma curve */
890 {0xd1, 0x21, 0x70, 0x64, 0x60, 0x5c, 0x58, 0x10}, /* gamma curve */
891 {0xd1, 0x21, 0x74, 0x54, 0x4c, 0x40, 0x38, 0x10}, /* gamma curve */
892 {0xd1, 0x21, 0x78, 0x34, 0x30, 0x2f, 0x2b, 0x10}, /* gamma curve */
893 {0xd1, 0x21, 0x7c, 0x03, 0x07, 0x17, 0x34, 0x10}, /* gamma curve */
894 {0xd1, 0x21, 0x80, 0x41, 0x4d, 0x58, 0x63, 0x10}, /* gamma curve */
895 {0xd1, 0x21, 0x84, 0x6e, 0x77, 0x87, 0x95, 0x10}, /* gamma curve */
896 {0xc1, 0x21, 0x88, 0xaf, 0xc7, 0xdf, 0x00, 0x10}, /* gamma curve */
897 {0xc1, 0x21, 0x8b, 0x99, 0x99, 0xcf, 0x00, 0x10}, /* reserved */
898 {0xb1, 0x21, 0x92, 0x00, 0x00, 0x00, 0x00, 0x10}, /* DM_LNL/H */
899 /* not in all ms-win traces*/
900 {0xa1, 0x21, 0xa1, 0x00, 0x00, 0x00, 0x00, 0x10},
901 {}
902 };
903 static const u8 ov7660_sensor_param1[][8] = {
904 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10}, /* MVFP */
905 /* bits[3..0]reserved */
906 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10},
907 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
908 /* VREF vertical frame ctrl */
909 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
910 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10}, /* AECH 0x20 */
911 {0xa1, 0x21, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFL */
912 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFH */
913 {0xa1, 0x21, 0x00, 0x1f, 0x00, 0x00, 0x00, 0x10}, /* GAIN */
914 /* {0xb1, 0x21, 0x01, 0x78, 0x78, 0x00, 0x00, 0x10}, * BLUE */
915 /****** (some exchanges in the win trace) ******/
916 /*fixme:param2*/
917 {0xa1, 0x21, 0x93, 0x00, 0x00, 0x00, 0x00, 0x10},/* dummy line hight */
918 {0xa1, 0x21, 0x92, 0x25, 0x00, 0x00, 0x00, 0x10}, /* dummy line low */
919 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCH */
920 {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCL */
921 /* {0xa1, 0x21, 0x02, 0x90, 0x00, 0x00, 0x00, 0x10}, * RED */
922 /****** (some exchanges in the win trace) ******/
923 /******!! startsensor KO if changed !!****/
924 /*fixme: param3*/
925 {0xa1, 0x21, 0x93, 0x01, 0x00, 0x00, 0x00, 0x10},
926 {0xa1, 0x21, 0x92, 0xff, 0x00, 0x00, 0x00, 0x10},
927 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10},
928 {0xa1, 0x21, 0x2b, 0xc3, 0x00, 0x00, 0x00, 0x10},
929 {}
930 };
931
932 static const u8 po1030_sensor_init[][8] = {
933 /* the sensor registers are described in m5602/m5602_po1030.h */
934 {0xa1, 0x6e, 0x3f, 0x20, 0x00, 0x00, 0x00, 0x10}, /* sensor reset */
935 {0xdd, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
936 {0xa1, 0x6e, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x10},
937 {0xa1, 0x6e, 0x3e, 0x00, 0x00, 0x00, 0x00, 0x10},
938 {0xd1, 0x6e, 0x04, 0x02, 0xb1, 0x02, 0x39, 0x10},
939 {0xd1, 0x6e, 0x08, 0x00, 0x01, 0x00, 0x00, 0x10},
940 {0xd1, 0x6e, 0x0c, 0x02, 0x7f, 0x01, 0xe0, 0x10},
941 {0xd1, 0x6e, 0x12, 0x03, 0x02, 0x00, 0x03, 0x10},
942 {0xd1, 0x6e, 0x16, 0x85, 0x40, 0x4a, 0x40, 0x10}, /* r/g1/b/g2 gains */
943 {0xc1, 0x6e, 0x1a, 0x00, 0x80, 0x00, 0x00, 0x10},
944 {0xd1, 0x6e, 0x1d, 0x08, 0x03, 0x00, 0x00, 0x10},
945 {0xd1, 0x6e, 0x23, 0x00, 0xb0, 0x00, 0x94, 0x10},
946 {0xd1, 0x6e, 0x27, 0x58, 0x00, 0x00, 0x00, 0x10},
947 {0xb1, 0x6e, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10},
948 {0xd1, 0x6e, 0x2d, 0x14, 0x35, 0x61, 0x84, 0x10}, /* gamma corr */
949 {0xd1, 0x6e, 0x31, 0xa2, 0xbd, 0xd8, 0xff, 0x10},
950 {0xd1, 0x6e, 0x35, 0x06, 0x1e, 0x12, 0x02, 0x10}, /* color matrix */
951 {0xd1, 0x6e, 0x39, 0xaa, 0x53, 0x37, 0xd5, 0x10},
952 {0xa1, 0x6e, 0x3d, 0xf2, 0x00, 0x00, 0x00, 0x10},
953 {0xd1, 0x6e, 0x3e, 0x00, 0x00, 0x80, 0x03, 0x10},
954 {0xd1, 0x6e, 0x42, 0x03, 0x00, 0x00, 0x00, 0x10},
955 {0xc1, 0x6e, 0x46, 0x00, 0x80, 0x80, 0x00, 0x10},
956 {0xd1, 0x6e, 0x4b, 0x02, 0xef, 0x08, 0xcd, 0x10},
957 {0xd1, 0x6e, 0x4f, 0x00, 0xd0, 0x00, 0xa0, 0x10},
958 {0xd1, 0x6e, 0x53, 0x01, 0xaa, 0x01, 0x40, 0x10},
959 {0xd1, 0x6e, 0x5a, 0x50, 0x04, 0x30, 0x03, 0x10}, /* raw rgb bayer */
960 {0xa1, 0x6e, 0x5e, 0x00, 0x00, 0x00, 0x00, 0x10},
961 {0xd1, 0x6e, 0x5f, 0x10, 0x40, 0xff, 0x00, 0x10},
962
963 {0xd1, 0x6e, 0x63, 0x40, 0x40, 0x00, 0x00, 0x10},
964 {0xd1, 0x6e, 0x67, 0x00, 0x00, 0x00, 0x00, 0x10},
965 {0xd1, 0x6e, 0x6b, 0x00, 0x00, 0x00, 0x00, 0x10},
966 {0xd1, 0x6e, 0x6f, 0x00, 0x00, 0x00, 0x00, 0x10},
967 {0xc1, 0x6e, 0x73, 0x10, 0x80, 0xeb, 0x00, 0x10},
968 {}
969 };
970 static const u8 po1030_sensor_param1[][8] = {
971 /* from ms-win traces - these values change with auto gain/expo/wb.. */
972 {0xa1, 0x6e, 0x1e, 0x03, 0x00, 0x00, 0x00, 0x10},
973 {0xa1, 0x6e, 0x1e, 0x03, 0x00, 0x00, 0x00, 0x10},
974 /* mean values */
975 {0xc1, 0x6e, 0x1a, 0x02, 0xd4, 0xa4, 0x00, 0x10}, /* integlines */
976 {0xa1, 0x6e, 0x15, 0x04, 0x00, 0x00, 0x00, 0x10}, /* global gain */
977 {0xc1, 0x6e, 0x16, 0x40, 0x40, 0x40, 0x00, 0x10}, /* r/g1/b gains */
978
979 {0xa1, 0x6e, 0x1d, 0x08, 0x00, 0x00, 0x00, 0x10}, /* control1 */
980 {0xa1, 0x6e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x10}, /* frameheight */
981 {0xa1, 0x6e, 0x07, 0xd5, 0x00, 0x00, 0x00, 0x10},
982 /* {0xc1, 0x6e, 0x16, 0x49, 0x40, 0x45, 0x00, 0x10}, */
983 {}
984 };
985
986 static const u8 sp80708_sensor_init[][8] = {
987 {0xa1, 0x18, 0x06, 0xf9, 0x00, 0x00, 0x00, 0x10},
988 {0xa1, 0x18, 0x09, 0x1f, 0x00, 0x00, 0x00, 0x10},
989 {0xa1, 0x18, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
990 {0xa1, 0x18, 0x0d, 0xc0, 0x00, 0x00, 0x00, 0x10},
991 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
992 {0xa1, 0x18, 0x0f, 0x0f, 0x00, 0x00, 0x00, 0x10},
993 {0xa1, 0x18, 0x10, 0x40, 0x00, 0x00, 0x00, 0x10},
994 {0xa1, 0x18, 0x11, 0x4e, 0x00, 0x00, 0x00, 0x10},
995 {0xa1, 0x18, 0x12, 0x53, 0x00, 0x00, 0x00, 0x10},
996 {0xa1, 0x18, 0x15, 0x80, 0x00, 0x00, 0x00, 0x10},
997 {0xa1, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x10},
998 {0xa1, 0x18, 0x19, 0x18, 0x00, 0x00, 0x00, 0x10},
999 {0xa1, 0x18, 0x1a, 0x10, 0x00, 0x00, 0x00, 0x10},
1000 {0xa1, 0x18, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x10},
1001 {0xa1, 0x18, 0x1c, 0x28, 0x00, 0x00, 0x00, 0x10},
1002 {0xa1, 0x18, 0x1d, 0x02, 0x00, 0x00, 0x00, 0x10},
1003 {0xa1, 0x18, 0x1e, 0x10, 0x00, 0x00, 0x00, 0x10},
1004 {0xa1, 0x18, 0x26, 0x04, 0x00, 0x00, 0x00, 0x10},
1005 {0xa1, 0x18, 0x27, 0x1e, 0x00, 0x00, 0x00, 0x10},
1006 {0xa1, 0x18, 0x28, 0x5a, 0x00, 0x00, 0x00, 0x10},
1007 {0xa1, 0x18, 0x29, 0x28, 0x00, 0x00, 0x00, 0x10},
1008 {0xa1, 0x18, 0x2a, 0x78, 0x00, 0x00, 0x00, 0x10},
1009 {0xa1, 0x18, 0x2b, 0x01, 0x00, 0x00, 0x00, 0x10},
1010 {0xa1, 0x18, 0x2c, 0xf7, 0x00, 0x00, 0x00, 0x10},
1011 {0xa1, 0x18, 0x2d, 0x2d, 0x00, 0x00, 0x00, 0x10},
1012 {0xa1, 0x18, 0x2e, 0xd5, 0x00, 0x00, 0x00, 0x10},
1013 {0xa1, 0x18, 0x39, 0x42, 0x00, 0x00, 0x00, 0x10},
1014 {0xa1, 0x18, 0x3a, 0x67, 0x00, 0x00, 0x00, 0x10},
1015 {0xa1, 0x18, 0x3b, 0x87, 0x00, 0x00, 0x00, 0x10},
1016 {0xa1, 0x18, 0x3c, 0xa3, 0x00, 0x00, 0x00, 0x10},
1017 {0xa1, 0x18, 0x3d, 0xb0, 0x00, 0x00, 0x00, 0x10},
1018 {0xa1, 0x18, 0x3e, 0xbc, 0x00, 0x00, 0x00, 0x10},
1019 {0xa1, 0x18, 0x3f, 0xc8, 0x00, 0x00, 0x00, 0x10},
1020 {0xa1, 0x18, 0x40, 0xd4, 0x00, 0x00, 0x00, 0x10},
1021 {0xa1, 0x18, 0x41, 0xdf, 0x00, 0x00, 0x00, 0x10},
1022 {0xa1, 0x18, 0x42, 0xea, 0x00, 0x00, 0x00, 0x10},
1023 {0xa1, 0x18, 0x43, 0xf5, 0x00, 0x00, 0x00, 0x10},
1024 {0xa1, 0x18, 0x45, 0x80, 0x00, 0x00, 0x00, 0x10},
1025 {0xa1, 0x18, 0x46, 0x60, 0x00, 0x00, 0x00, 0x10},
1026 {0xa1, 0x18, 0x47, 0x50, 0x00, 0x00, 0x00, 0x10},
1027 {0xa1, 0x18, 0x48, 0x30, 0x00, 0x00, 0x00, 0x10},
1028 {0xa1, 0x18, 0x49, 0x01, 0x00, 0x00, 0x00, 0x10},
1029 {0xa1, 0x18, 0x4d, 0xae, 0x00, 0x00, 0x00, 0x10},
1030 {0xa1, 0x18, 0x4e, 0x03, 0x00, 0x00, 0x00, 0x10},
1031 {0xa1, 0x18, 0x4f, 0x66, 0x00, 0x00, 0x00, 0x10},
1032 {0xa1, 0x18, 0x50, 0x1c, 0x00, 0x00, 0x00, 0x10},
1033 {0xa1, 0x18, 0x44, 0x10, 0x00, 0x00, 0x00, 0x10},
1034 {0xa1, 0x18, 0x4a, 0x30, 0x00, 0x00, 0x00, 0x10},
1035 {0xa1, 0x18, 0x51, 0x80, 0x00, 0x00, 0x00, 0x10},
1036 {0xa1, 0x18, 0x52, 0x80, 0x00, 0x00, 0x00, 0x10},
1037 {0xa1, 0x18, 0x53, 0x80, 0x00, 0x00, 0x00, 0x10},
1038 {0xa1, 0x18, 0x54, 0x80, 0x00, 0x00, 0x00, 0x10},
1039 {0xa1, 0x18, 0x55, 0x80, 0x00, 0x00, 0x00, 0x10},
1040 {0xa1, 0x18, 0x56, 0x80, 0x00, 0x00, 0x00, 0x10},
1041 {0xa1, 0x18, 0x57, 0xe0, 0x00, 0x00, 0x00, 0x10},
1042 {0xa1, 0x18, 0x58, 0xc0, 0x00, 0x00, 0x00, 0x10},
1043 {0xa1, 0x18, 0x59, 0xab, 0x00, 0x00, 0x00, 0x10},
1044 {0xa1, 0x18, 0x5a, 0xa0, 0x00, 0x00, 0x00, 0x10},
1045 {0xa1, 0x18, 0x5b, 0x99, 0x00, 0x00, 0x00, 0x10},
1046 {0xa1, 0x18, 0x5c, 0x90, 0x00, 0x00, 0x00, 0x10},
1047 {0xa1, 0x18, 0x5e, 0x24, 0x00, 0x00, 0x00, 0x10},
1048 {0xa1, 0x18, 0x5f, 0x00, 0x00, 0x00, 0x00, 0x10},
1049 {0xa1, 0x18, 0x60, 0x00, 0x00, 0x00, 0x00, 0x10},
1050 {0xa1, 0x18, 0x61, 0x73, 0x00, 0x00, 0x00, 0x10},
1051 {0xa1, 0x18, 0x63, 0x42, 0x00, 0x00, 0x00, 0x10},
1052 {0xa1, 0x18, 0x64, 0x42, 0x00, 0x00, 0x00, 0x10},
1053 {0xa1, 0x18, 0x65, 0x42, 0x00, 0x00, 0x00, 0x10},
1054 {0xa1, 0x18, 0x66, 0x24, 0x00, 0x00, 0x00, 0x10},
1055 {0xa1, 0x18, 0x67, 0x24, 0x00, 0x00, 0x00, 0x10},
1056 {0xa1, 0x18, 0x68, 0x08, 0x00, 0x00, 0x00, 0x10},
1057 {0xa1, 0x18, 0x2f, 0xc9, 0x00, 0x00, 0x00, 0x10},
1058 {}
1059 };
1060 static const u8 sp80708_sensor_param1[][8] = {
1061 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
1062 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
1063 {0xa1, 0x18, 0x03, 0x01, 0x00, 0x00, 0x00, 0x10},
1064 {0xa1, 0x18, 0x04, 0xa4, 0x00, 0x00, 0x00, 0x10},
1065 {0xa1, 0x18, 0x14, 0x3f, 0x00, 0x00, 0x00, 0x10},
1066 {0xa1, 0x18, 0x5d, 0x80, 0x00, 0x00, 0x00, 0x10},
1067 {0xb1, 0x18, 0x11, 0x40, 0x40, 0x00, 0x00, 0x10},
1068 {}
1069 };
1070
1071 static const u8 (*sensor_init[11])[8] = {
1072 adcm1700_sensor_init, /* ADCM1700 0 */
1073 hv7131r_sensor_init, /* HV7131R 1 */
1074 mi0360_sensor_init, /* MI0360 2 */
1075 mo4000_sensor_init, /* MO4000 3 */
1076 mt9v111_sensor_init, /* MT9V111 4 */
1077 om6802_sensor_init, /* OM6802 5 */
1078 ov7630_sensor_init, /* OV7630 6 */
1079 ov7648_sensor_init, /* OV7648 7 */
1080 ov7660_sensor_init, /* OV7660 8 */
1081 po1030_sensor_init, /* PO1030 9 */
1082 sp80708_sensor_init, /* SP80708 10 */
1083 };
1084
1085 /* read <len> bytes to gspca_dev->usb_buf */
1086 static void reg_r(struct gspca_dev *gspca_dev,
1087 u16 value, int len)
1088 {
1089 #ifdef GSPCA_DEBUG
1090 if (len > USB_BUF_SZ) {
1091 err("reg_r: buffer overflow");
1092 return;
1093 }
1094 #endif
1095 usb_control_msg(gspca_dev->dev,
1096 usb_rcvctrlpipe(gspca_dev->dev, 0),
1097 0,
1098 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1099 value, 0,
1100 gspca_dev->usb_buf, len,
1101 500);
1102 PDEBUG(D_USBI, "reg_r [%02x] -> %02x", value, gspca_dev->usb_buf[0]);
1103 }
1104
1105 static void reg_w1(struct gspca_dev *gspca_dev,
1106 u16 value,
1107 u8 data)
1108 {
1109 PDEBUG(D_USBO, "reg_w1 [%04x] = %02x", value, data);
1110 gspca_dev->usb_buf[0] = data;
1111 usb_control_msg(gspca_dev->dev,
1112 usb_sndctrlpipe(gspca_dev->dev, 0),
1113 0x08,
1114 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1115 value,
1116 0,
1117 gspca_dev->usb_buf, 1,
1118 500);
1119 }
1120 static void reg_w(struct gspca_dev *gspca_dev,
1121 u16 value,
1122 const u8 *buffer,
1123 int len)
1124 {
1125 PDEBUG(D_USBO, "reg_w [%04x] = %02x %02x ..",
1126 value, buffer[0], buffer[1]);
1127 #ifdef GSPCA_DEBUG
1128 if (len > USB_BUF_SZ) {
1129 err("reg_w: buffer overflow");
1130 return;
1131 }
1132 #endif
1133 memcpy(gspca_dev->usb_buf, buffer, len);
1134 usb_control_msg(gspca_dev->dev,
1135 usb_sndctrlpipe(gspca_dev->dev, 0),
1136 0x08,
1137 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1138 value, 0,
1139 gspca_dev->usb_buf, len,
1140 500);
1141 }
1142
1143 /* I2C write 1 byte */
1144 static void i2c_w1(struct gspca_dev *gspca_dev, u8 reg, u8 val)
1145 {
1146 struct sd *sd = (struct sd *) gspca_dev;
1147
1148 PDEBUG(D_USBO, "i2c_w2 [%02x] = %02x", reg, val);
1149 switch (sd->sensor) {
1150 case SENSOR_ADCM1700:
1151 case SENSOR_OM6802: /* i2c command = a0 (100 kHz) */
1152 gspca_dev->usb_buf[0] = 0x80 | (2 << 4);
1153 break;
1154 default: /* i2c command = a1 (400 kHz) */
1155 gspca_dev->usb_buf[0] = 0x81 | (2 << 4);
1156 break;
1157 }
1158 gspca_dev->usb_buf[1] = sd->i2c_addr;
1159 gspca_dev->usb_buf[2] = reg;
1160 gspca_dev->usb_buf[3] = val;
1161 gspca_dev->usb_buf[4] = 0;
1162 gspca_dev->usb_buf[5] = 0;
1163 gspca_dev->usb_buf[6] = 0;
1164 gspca_dev->usb_buf[7] = 0x10;
1165 usb_control_msg(gspca_dev->dev,
1166 usb_sndctrlpipe(gspca_dev->dev, 0),
1167 0x08,
1168 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1169 0x08, /* value = i2c */
1170 0,
1171 gspca_dev->usb_buf, 8,
1172 500);
1173 }
1174
1175 /* I2C write 8 bytes */
1176 static void i2c_w8(struct gspca_dev *gspca_dev,
1177 const u8 *buffer)
1178 {
1179 memcpy(gspca_dev->usb_buf, buffer, 8);
1180 usb_control_msg(gspca_dev->dev,
1181 usb_sndctrlpipe(gspca_dev->dev, 0),
1182 0x08,
1183 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1184 0x08, 0, /* value, index */
1185 gspca_dev->usb_buf, 8,
1186 500);
1187 msleep(2);
1188 }
1189
1190 /* sensor read 'len' (1..5) bytes in gspca_dev->usb_buf */
1191 static void i2c_r(struct gspca_dev *gspca_dev, u8 reg, int len)
1192 {
1193 struct sd *sd = (struct sd *) gspca_dev;
1194 u8 mode[8];
1195
1196 switch (sd->sensor) {
1197 case SENSOR_ADCM1700:
1198 case SENSOR_OM6802: /* i2c command = 90 (100 kHz) */
1199 mode[0] = 0x80 | 0x10;
1200 break;
1201 default: /* i2c command = 91 (400 kHz) */
1202 mode[0] = 0x81 | 0x10;
1203 break;
1204 }
1205 mode[1] = sd->i2c_addr;
1206 mode[2] = reg;
1207 mode[3] = 0;
1208 mode[4] = 0;
1209 mode[5] = 0;
1210 mode[6] = 0;
1211 mode[7] = 0x10;
1212 i2c_w8(gspca_dev, mode);
1213 msleep(2);
1214 mode[0] = (mode[0] & 0x81) | (len << 4) | 0x02;
1215 mode[2] = 0;
1216 i2c_w8(gspca_dev, mode);
1217 msleep(2);
1218 reg_r(gspca_dev, 0x0a, 5);
1219 }
1220
1221 static void i2c_w_seq(struct gspca_dev *gspca_dev,
1222 const u8 (*data)[8])
1223 {
1224 while ((*data)[0] != 0) {
1225 if ((*data)[0] != 0xdd)
1226 i2c_w8(gspca_dev, *data);
1227 else
1228 msleep((*data)[1]);
1229 data++;
1230 }
1231 }
1232
1233 static void hv7131r_probe(struct gspca_dev *gspca_dev)
1234 {
1235 i2c_w1(gspca_dev, 0x02, 0); /* sensor wakeup */
1236 msleep(10);
1237 reg_w1(gspca_dev, 0x02, 0x66); /* Gpio on */
1238 msleep(10);
1239 i2c_r(gspca_dev, 0, 5); /* read sensor id */
1240 if (gspca_dev->usb_buf[0] == 0x02
1241 && gspca_dev->usb_buf[1] == 0x09
1242 && gspca_dev->usb_buf[2] == 0x01
1243 && gspca_dev->usb_buf[3] == 0x00
1244 && gspca_dev->usb_buf[4] == 0x00) {
1245 PDEBUG(D_PROBE, "Sensor sn9c102P HV7131R found");
1246 return;
1247 }
1248 PDEBUG(D_PROBE, "Sensor 0x%02x 0x%02x 0x%02x - sn9c102P not found",
1249 gspca_dev->usb_buf[0], gspca_dev->usb_buf[1],
1250 gspca_dev->usb_buf[2]);
1251 }
1252
1253 static void mi0360_probe(struct gspca_dev *gspca_dev)
1254 {
1255 struct sd *sd = (struct sd *) gspca_dev;
1256 int i, j;
1257 u16 val = 0;
1258 static const u8 probe_tb[][4][8] = {
1259 { /* mi0360 */
1260 {0xb0, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
1261 {0x90, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1262 {0xa2, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1263 {0xb0, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10}
1264 },
1265 { /* mt9v111 */
1266 {0xb0, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10},
1267 {0x90, 0x5c, 0x36, 0x00, 0x00, 0x00, 0x00, 0x10},
1268 {0xa2, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1269 {}
1270 },
1271 };
1272
1273 for (i = 0; i < ARRAY_SIZE(probe_tb); i++) {
1274 reg_w1(gspca_dev, 0x17, 0x62);
1275 reg_w1(gspca_dev, 0x01, 0x08);
1276 for (j = 0; j < 3; j++)
1277 i2c_w8(gspca_dev, probe_tb[i][j]);
1278 msleep(2);
1279 reg_r(gspca_dev, 0x0a, 5);
1280 val = (gspca_dev->usb_buf[3] << 8) | gspca_dev->usb_buf[4];
1281 if (probe_tb[i][3][0] != 0)
1282 i2c_w8(gspca_dev, probe_tb[i][3]);
1283 reg_w1(gspca_dev, 0x01, 0x29);
1284 reg_w1(gspca_dev, 0x17, 0x42);
1285 if (val != 0xffff)
1286 break;
1287 }
1288 switch (val) {
1289 case 0x823a:
1290 PDEBUG(D_PROBE, "Sensor mt9v111");
1291 sd->sensor = SENSOR_MT9V111;
1292 break;
1293 case 0x8243:
1294 PDEBUG(D_PROBE, "Sensor mi0360");
1295 break;
1296 default:
1297 PDEBUG(D_PROBE, "Unknown sensor %04x - forced to mi0360", val);
1298 break;
1299 }
1300 }
1301
1302 static void ov7648_probe(struct gspca_dev *gspca_dev)
1303 {
1304 struct sd *sd = (struct sd *) gspca_dev;
1305
1306 /* check ov76xx */
1307 reg_w1(gspca_dev, 0x17, 0x62);
1308 reg_w1(gspca_dev, 0x01, 0x08);
1309 sd->i2c_addr = 0x21;
1310 i2c_r(gspca_dev, 0x0a, 2);
1311 if (gspca_dev->usb_buf[3] == 0x76) { /* ov76xx */
1312 PDEBUG(D_PROBE, "Sensor ov%02x%02x",
1313 gspca_dev->usb_buf[3], gspca_dev->usb_buf[4]);
1314 return;
1315 }
1316
1317 /* reset */
1318 reg_w1(gspca_dev, 0x01, 0x29);
1319 reg_w1(gspca_dev, 0x17, 0x42);
1320
1321 /* check po1030 */
1322 reg_w1(gspca_dev, 0x17, 0x62);
1323 reg_w1(gspca_dev, 0x01, 0x08);
1324 sd->i2c_addr = 0x6e;
1325 i2c_r(gspca_dev, 0x00, 2);
1326 if (gspca_dev->usb_buf[3] == 0x10 /* po1030 */
1327 && gspca_dev->usb_buf[4] == 0x30) {
1328 PDEBUG(D_PROBE, "Sensor po1030");
1329 sd->sensor = SENSOR_PO1030;
1330 return;
1331 }
1332
1333 PDEBUG(D_PROBE, "Unknown sensor %02x%02x",
1334 gspca_dev->usb_buf[3], gspca_dev->usb_buf[4]);
1335 }
1336
1337 static void bridge_init(struct gspca_dev *gspca_dev,
1338 const u8 *sn9c1xx)
1339 {
1340 struct sd *sd = (struct sd *) gspca_dev;
1341 const u8 *reg9a;
1342 static const u8 reg9a_def[] =
1343 {0x00, 0x40, 0x20, 0x00, 0x00, 0x00};
1344 static const u8 reg9a_spec[] =
1345 {0x00, 0x40, 0x38, 0x30, 0x00, 0x20};
1346 static const u8 regd4[] = {0x60, 0x00, 0x00};
1347
1348 /* sensor clock already enabled in sd_init */
1349 /* reg_w1(gspca_dev, 0xf1, 0x00); */
1350 reg_w1(gspca_dev, 0x01, sn9c1xx[1]);
1351
1352 /* configure gpio */
1353 reg_w(gspca_dev, 0x01, &sn9c1xx[1], 2);
1354 reg_w(gspca_dev, 0x08, &sn9c1xx[8], 2);
1355 reg_w(gspca_dev, 0x17, &sn9c1xx[0x17], 5);
1356 switch (sd->sensor) {
1357 case SENSOR_OV7660:
1358 case SENSOR_PO1030:
1359 case SENSOR_SP80708:
1360 reg9a = reg9a_spec;
1361 break;
1362 default:
1363 reg9a = reg9a_def;
1364 break;
1365 }
1366 reg_w(gspca_dev, 0x9a, reg9a, 6);
1367
1368 reg_w(gspca_dev, 0xd4, regd4, sizeof regd4);
1369
1370 reg_w(gspca_dev, 0x03, &sn9c1xx[3], 0x0f);
1371
1372 switch (sd->sensor) {
1373 case SENSOR_ADCM1700:
1374 reg_w1(gspca_dev, 0x01, 0x43);
1375 reg_w1(gspca_dev, 0x17, 0x62);
1376 reg_w1(gspca_dev, 0x01, 0x42);
1377 reg_w1(gspca_dev, 0x01, 0x42);
1378 break;
1379 case SENSOR_MT9V111:
1380 reg_w1(gspca_dev, 0x01, 0x61);
1381 reg_w1(gspca_dev, 0x17, 0x61);
1382 reg_w1(gspca_dev, 0x01, 0x60);
1383 reg_w1(gspca_dev, 0x01, 0x40);
1384 break;
1385 case SENSOR_OM6802:
1386 msleep(10);
1387 reg_w1(gspca_dev, 0x02, 0x73);
1388 reg_w1(gspca_dev, 0x17, 0x60);
1389 reg_w1(gspca_dev, 0x01, 0x22);
1390 msleep(100);
1391 reg_w1(gspca_dev, 0x01, 0x62);
1392 reg_w1(gspca_dev, 0x17, 0x64);
1393 reg_w1(gspca_dev, 0x17, 0x64);
1394 reg_w1(gspca_dev, 0x01, 0x42);
1395 msleep(10);
1396 reg_w1(gspca_dev, 0x01, 0x42);
1397 i2c_w8(gspca_dev, om6802_init0[0]);
1398 i2c_w8(gspca_dev, om6802_init0[1]);
1399 msleep(15);
1400 reg_w1(gspca_dev, 0x02, 0x71);
1401 msleep(150);
1402 break;
1403 case SENSOR_OV7630:
1404 reg_w1(gspca_dev, 0x01, 0x61);
1405 reg_w1(gspca_dev, 0x17, 0xe2);
1406 reg_w1(gspca_dev, 0x01, 0x60);
1407 reg_w1(gspca_dev, 0x01, 0x40);
1408 break;
1409 case SENSOR_OV7648:
1410 reg_w1(gspca_dev, 0x01, 0x63);
1411 reg_w1(gspca_dev, 0x17, 0x20);
1412 reg_w1(gspca_dev, 0x01, 0x62);
1413 reg_w1(gspca_dev, 0x01, 0x42);
1414 break;
1415 case SENSOR_PO1030:
1416 reg_w1(gspca_dev, 0x01, 0x61);
1417 reg_w1(gspca_dev, 0x17, 0x20);
1418 reg_w1(gspca_dev, 0x01, 0x60);
1419 reg_w1(gspca_dev, 0x01, 0x40);
1420 break;
1421 case SENSOR_OV7660:
1422 /* fall thru */
1423 case SENSOR_SP80708:
1424 reg_w1(gspca_dev, 0x01, 0x63);
1425 reg_w1(gspca_dev, 0x17, 0x20);
1426 reg_w1(gspca_dev, 0x01, 0x62);
1427 reg_w1(gspca_dev, 0x01, 0x42);
1428 msleep(100);
1429 reg_w1(gspca_dev, 0x02, 0x62);
1430 break;
1431 default:
1432 /* case SENSOR_HV7131R: */
1433 /* case SENSOR_MI0360: */
1434 /* case SENSOR_MO4000: */
1435 reg_w1(gspca_dev, 0x01, 0x43);
1436 reg_w1(gspca_dev, 0x17, 0x61);
1437 reg_w1(gspca_dev, 0x01, 0x42);
1438 if (sd->sensor == SENSOR_HV7131R
1439 && sd->bridge == BRIDGE_SN9C102P)
1440 hv7131r_probe(gspca_dev);
1441 break;
1442 }
1443 }
1444
1445 /* this function is called at probe time */
1446 static int sd_config(struct gspca_dev *gspca_dev,
1447 const struct usb_device_id *id)
1448 {
1449 struct sd *sd = (struct sd *) gspca_dev;
1450 struct cam *cam;
1451
1452 sd->bridge = id->driver_info >> 16;
1453 sd->sensor = id->driver_info;
1454
1455 cam = &gspca_dev->cam;
1456 if (sd->sensor == SENSOR_ADCM1700) {
1457 cam->cam_mode = cif_mode;
1458 cam->nmodes = ARRAY_SIZE(cif_mode);
1459 } else {
1460 cam->cam_mode = vga_mode;
1461 cam->nmodes = ARRAY_SIZE(vga_mode);
1462 }
1463 cam->npkt = 24; /* 24 packets per ISOC message */
1464
1465 sd->brightness = BRIGHTNESS_DEF;
1466 sd->contrast = CONTRAST_DEF;
1467 sd->colors = COLOR_DEF;
1468 sd->blue = BLUE_BALANCE_DEF;
1469 sd->red = RED_BALANCE_DEF;
1470 sd->gamma = GAMMA_DEF;
1471 sd->autogain = AUTOGAIN_DEF;
1472 sd->ag_cnt = -1;
1473 sd->vflip = VFLIP_DEF;
1474 switch (sd->sensor) {
1475 case SENSOR_OM6802:
1476 sd->sharpness = 0x10;
1477 break;
1478 default:
1479 sd->sharpness = SHARPNESS_DEF;
1480 break;
1481 }
1482 sd->infrared = INFRARED_DEF;
1483 sd->freq = FREQ_DEF;
1484 sd->quality = QUALITY_DEF;
1485 sd->jpegqual = 80;
1486
1487 return 0;
1488 }
1489
1490 /* this function is called at probe and resume time */
1491 static int sd_init(struct gspca_dev *gspca_dev)
1492 {
1493 struct sd *sd = (struct sd *) gspca_dev;
1494 const u8 *sn9c1xx;
1495 u8 regGpio[] = { 0x29, 0x74 };
1496 u8 regF1;
1497
1498 /* setup a selector by bridge */
1499 reg_w1(gspca_dev, 0xf1, 0x01);
1500 reg_r(gspca_dev, 0x00, 1);
1501 reg_w1(gspca_dev, 0xf1, gspca_dev->usb_buf[0]);
1502 reg_r(gspca_dev, 0x00, 1); /* get sonix chip id */
1503 regF1 = gspca_dev->usb_buf[0];
1504 PDEBUG(D_PROBE, "Sonix chip id: %02x", regF1);
1505 switch (sd->bridge) {
1506 case BRIDGE_SN9C102P:
1507 if (regF1 != 0x11)
1508 return -ENODEV;
1509 reg_w1(gspca_dev, 0x02, regGpio[1]);
1510 break;
1511 case BRIDGE_SN9C105:
1512 if (regF1 != 0x11)
1513 return -ENODEV;
1514 if (sd->sensor == SENSOR_MI0360)
1515 mi0360_probe(gspca_dev);
1516 reg_w(gspca_dev, 0x01, regGpio, 2);
1517 break;
1518 case BRIDGE_SN9C120:
1519 if (regF1 != 0x12)
1520 return -ENODEV;
1521 switch (sd->sensor) {
1522 case SENSOR_MI0360:
1523 mi0360_probe(gspca_dev);
1524 break;
1525 case SENSOR_OV7648:
1526 ov7648_probe(gspca_dev);
1527 break;
1528 }
1529 regGpio[1] = 0x70;
1530 reg_w(gspca_dev, 0x01, regGpio, 2);
1531 break;
1532 default:
1533 /* case BRIDGE_SN9C110: */
1534 /* case BRIDGE_SN9C325: */
1535 if (regF1 != 0x12)
1536 return -ENODEV;
1537 reg_w1(gspca_dev, 0x02, 0x62);
1538 break;
1539 }
1540
1541 /* Note we do not disable the sensor clock here (power saving mode),
1542 as that also disables the button on the cam. */
1543 reg_w1(gspca_dev, 0xf1, 0x00);
1544
1545 /* set the i2c address */
1546 sn9c1xx = sn_tb[sd->sensor];
1547 sd->i2c_addr = sn9c1xx[9];
1548
1549 gspca_dev->ctrl_dis = ctrl_dis[sd->sensor];
1550
1551 return 0;
1552 }
1553
1554 static u32 setexposure(struct gspca_dev *gspca_dev,
1555 u32 expo)
1556 {
1557 struct sd *sd = (struct sd *) gspca_dev;
1558
1559 switch (sd->sensor) {
1560 case SENSOR_HV7131R: {
1561 u8 Expodoit[] =
1562 { 0xc1, 0x11, 0x25, 0x00, 0x00, 0x00, 0x00, 0x16 };
1563
1564 Expodoit[3] = expo >> 16;
1565 Expodoit[4] = expo >> 8;
1566 Expodoit[5] = expo;
1567 i2c_w8(gspca_dev, Expodoit);
1568 break;
1569 }
1570 case SENSOR_MI0360: {
1571 u8 expoMi[] = /* exposure 0x0635 -> 4 fp/s 0x10 */
1572 { 0xb1, 0x5d, 0x09, 0x00, 0x00, 0x00, 0x00, 0x16 };
1573 static const u8 doit[] = /* update sensor */
1574 { 0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10 };
1575 static const u8 sensorgo[] = /* sensor on */
1576 { 0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10 };
1577
1578 if (expo > 0x0635)
1579 expo = 0x0635;
1580 else if (expo < 0x0001)
1581 expo = 0x0001;
1582 expoMi[3] = expo >> 8;
1583 expoMi[4] = expo;
1584 i2c_w8(gspca_dev, expoMi);
1585 i2c_w8(gspca_dev, doit);
1586 i2c_w8(gspca_dev, sensorgo);
1587 break;
1588 }
1589 case SENSOR_MO4000: {
1590 u8 expoMof[] =
1591 { 0xa1, 0x21, 0x0f, 0x00, 0x00, 0x00, 0x00, 0x10 };
1592 u8 expoMo10[] =
1593 { 0xa1, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10 };
1594 static const u8 gainMo[] =
1595 { 0xa1, 0x21, 0x00, 0x10, 0x00, 0x00, 0x00, 0x1d };
1596
1597 if (expo > 0x1fff)
1598 expo = 0x1fff;
1599 else if (expo < 0x0001)
1600 expo = 0x0001;
1601 expoMof[3] = (expo & 0x03fc) >> 2;
1602 i2c_w8(gspca_dev, expoMof);
1603 expoMo10[3] = ((expo & 0x1c00) >> 10)
1604 | ((expo & 0x0003) << 4);
1605 i2c_w8(gspca_dev, expoMo10);
1606 i2c_w8(gspca_dev, gainMo);
1607 PDEBUG(D_FRAM, "set exposure %d",
1608 ((expoMo10[3] & 0x07) << 10)
1609 | (expoMof[3] << 2)
1610 | ((expoMo10[3] & 0x30) >> 4));
1611 break;
1612 }
1613 case SENSOR_MT9V111: {
1614 u8 expo_c1[] =
1615 { 0xb1, 0x5c, 0x09, 0x00, 0x00, 0x00, 0x00, 0x10 };
1616
1617 if (expo > 0x0280)
1618 expo = 0x0280;
1619 else if (expo < 0x0040)
1620 expo = 0x0040;
1621 expo_c1[3] = expo >> 8;
1622 expo_c1[4] = expo;
1623 i2c_w8(gspca_dev, expo_c1);
1624 break;
1625 }
1626 case SENSOR_OM6802: {
1627 u8 gainOm[] =
1628 { 0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10 };
1629 /* preset AGC - works when AutoExpo = off */
1630
1631 if (expo > 0x03ff)
1632 expo = 0x03ff;
1633 if (expo < 0x0001)
1634 expo = 0x0001;
1635 gainOm[3] = expo >> 2;
1636 i2c_w8(gspca_dev, gainOm);
1637 reg_w1(gspca_dev, 0x96, expo >> 5);
1638 PDEBUG(D_FRAM, "set exposure %d", gainOm[3]);
1639 break;
1640 }
1641 }
1642 return expo;
1643 }
1644
1645 static void setbrightness(struct gspca_dev *gspca_dev)
1646 {
1647 struct sd *sd = (struct sd *) gspca_dev;
1648 unsigned int expo;
1649 u8 k2;
1650
1651 k2 = ((int) sd->brightness - 0x8000) >> 10;
1652 switch (sd->sensor) {
1653 case SENSOR_ADCM1700:
1654 if (k2 > 0x1f)
1655 k2 = 0; /* only positive Y offset */
1656 break;
1657 case SENSOR_HV7131R:
1658 expo = sd->brightness << 4;
1659 if (expo > 0x002dc6c0)
1660 expo = 0x002dc6c0;
1661 else if (expo < 0x02a0)
1662 expo = 0x02a0;
1663 sd->exposure = setexposure(gspca_dev, expo);
1664 break;
1665 case SENSOR_MI0360:
1666 case SENSOR_MO4000:
1667 expo = sd->brightness >> 4;
1668 sd->exposure = setexposure(gspca_dev, expo);
1669 break;
1670 case SENSOR_MT9V111:
1671 expo = sd->brightness >> 8;
1672 sd->exposure = setexposure(gspca_dev, expo);
1673 return; /* don't set the Y offset */
1674 case SENSOR_OM6802:
1675 expo = sd->brightness >> 6;
1676 sd->exposure = setexposure(gspca_dev, expo);
1677 k2 = sd->brightness >> 11;
1678 break;
1679 }
1680
1681 reg_w1(gspca_dev, 0x96, k2); /* color matrix Y offset */
1682 }
1683
1684 static void setcontrast(struct gspca_dev *gspca_dev)
1685 {
1686 struct sd *sd = (struct sd *) gspca_dev;
1687 u8 k2;
1688 u8 contrast[6];
1689
1690 k2 = sd->contrast * 0x30 / (CONTRAST_MAX + 1) + 0x10; /* 10..40 */
1691 contrast[0] = (k2 + 1) / 2; /* red */
1692 contrast[1] = 0;
1693 contrast[2] = k2; /* green */
1694 contrast[3] = 0;
1695 contrast[4] = (k2 + 1) / 5; /* blue */
1696 contrast[5] = 0;
1697 reg_w(gspca_dev, 0x84, contrast, sizeof contrast);
1698 }
1699
1700 static void setcolors(struct gspca_dev *gspca_dev)
1701 {
1702 struct sd *sd = (struct sd *) gspca_dev;
1703 int i, v;
1704 u8 reg8a[12]; /* U & V gains */
1705 static s16 uv[6] = { /* same as reg84 in signed decimal */
1706 -24, -38, 64, /* UR UG UB */
1707 62, -51, -9 /* VR VG VB */
1708 };
1709
1710 for (i = 0; i < 6; i++) {
1711 v = uv[i] * sd->colors / COLOR_DEF;
1712 reg8a[i * 2] = v;
1713 reg8a[i * 2 + 1] = (v >> 8) & 0x0f;
1714 }
1715 reg_w(gspca_dev, 0x8a, reg8a, sizeof reg8a);
1716 }
1717
1718 static void setredblue(struct gspca_dev *gspca_dev)
1719 {
1720 struct sd *sd = (struct sd *) gspca_dev;
1721
1722 reg_w1(gspca_dev, 0x05, sd->red);
1723 /* reg_w1(gspca_dev, 0x07, 32); */
1724 reg_w1(gspca_dev, 0x06, sd->blue);
1725 }
1726
1727 static void setgamma(struct gspca_dev *gspca_dev)
1728 {
1729 struct sd *sd = (struct sd *) gspca_dev;
1730 int i;
1731 u8 gamma[17];
1732 const u8 *gamma_base;
1733 static const u8 delta[17] = {
1734 0x00, 0x14, 0x1c, 0x1c, 0x1c, 0x1c, 0x1b, 0x1a,
1735 0x18, 0x13, 0x10, 0x0e, 0x08, 0x07, 0x04, 0x02, 0x00
1736 };
1737
1738 switch (sd->sensor) {
1739 case SENSOR_ADCM1700:
1740 gamma_base = gamma_spec_0;
1741 break;
1742 case SENSOR_HV7131R:
1743 case SENSOR_MT9V111:
1744 gamma_base = gamma_spec_1;
1745 break;
1746 case SENSOR_SP80708:
1747 gamma_base = gamma_spec_2;
1748 break;
1749 default:
1750 gamma_base = gamma_def;
1751 break;
1752 }
1753
1754 for (i = 0; i < sizeof gamma; i++)
1755 gamma[i] = gamma_base[i]
1756 + delta[i] * (sd->gamma - GAMMA_DEF) / 32;
1757 reg_w(gspca_dev, 0x20, gamma, sizeof gamma);
1758 }
1759
1760 static void setautogain(struct gspca_dev *gspca_dev)
1761 {
1762 struct sd *sd = (struct sd *) gspca_dev;
1763
1764 if (gspca_dev->ctrl_dis & (1 << AUTOGAIN_IDX))
1765 return;
1766 switch (sd->sensor) {
1767 case SENSOR_OV7630:
1768 case SENSOR_OV7648: {
1769 u8 comb;
1770
1771 if (sd->sensor == SENSOR_OV7630)
1772 comb = 0xc0;
1773 else
1774 comb = 0xa0;
1775 if (sd->autogain)
1776 comb |= 0x03;
1777 i2c_w1(&sd->gspca_dev, 0x13, comb);
1778 return;
1779 }
1780 }
1781 if (sd->autogain)
1782 sd->ag_cnt = AG_CNT_START;
1783 else
1784 sd->ag_cnt = -1;
1785 }
1786
1787 /* hv7131r/ov7630/ov7648 only */
1788 static void setvflip(struct sd *sd)
1789 {
1790 u8 comn;
1791
1792 if (sd->gspca_dev.ctrl_dis & (1 << VFLIP_IDX))
1793 return;
1794 switch (sd->sensor) {
1795 case SENSOR_HV7131R:
1796 comn = 0x18; /* clkdiv = 1, ablcen = 1 */
1797 if (sd->vflip)
1798 comn |= 0x01;
1799 i2c_w1(&sd->gspca_dev, 0x01, comn); /* sctra */
1800 break;
1801 case SENSOR_OV7630:
1802 comn = 0x02;
1803 if (!sd->vflip)
1804 comn |= 0x80;
1805 i2c_w1(&sd->gspca_dev, 0x75, comn);
1806 break;
1807 default:
1808 /* case SENSOR_OV7648: */
1809 comn = 0x06;
1810 if (sd->vflip)
1811 comn |= 0x80;
1812 i2c_w1(&sd->gspca_dev, 0x75, comn);
1813 break;
1814 }
1815 }
1816
1817 static void setsharpness(struct sd *sd)
1818 {
1819 reg_w1(&sd->gspca_dev, 0x99, sd->sharpness);
1820 }
1821
1822 static void setinfrared(struct sd *sd)
1823 {
1824 if (sd->gspca_dev.ctrl_dis & (1 << INFRARED_IDX))
1825 return;
1826 /*fixme: different sequence for StarCam Clip and StarCam 370i */
1827 /* Clip */
1828 i2c_w1(&sd->gspca_dev, 0x02, /* gpio */
1829 sd->infrared ? 0x66 : 0x64);
1830 }
1831
1832 static void setfreq(struct gspca_dev *gspca_dev)
1833 {
1834 struct sd *sd = (struct sd *) gspca_dev;
1835
1836 if (gspca_dev->ctrl_dis & (1 << FREQ_IDX))
1837 return;
1838 if (sd->sensor == SENSOR_OV7660) {
1839 u8 com8;
1840
1841 com8 = 0xdf; /* auto gain/wb/expo */
1842 switch (sd->freq) {
1843 case 0: /* Banding filter disabled */
1844 i2c_w1(gspca_dev, 0x13, com8 | 0x20);
1845 break;
1846 case 1: /* 50 hz */
1847 i2c_w1(gspca_dev, 0x13, com8);
1848 i2c_w1(gspca_dev, 0x3b, 0x0a);
1849 break;
1850 case 2: /* 60 hz */
1851 i2c_w1(gspca_dev, 0x13, com8);
1852 i2c_w1(gspca_dev, 0x3b, 0x02);
1853 break;
1854 }
1855 } else {
1856 u8 reg2a = 0, reg2b = 0, reg2d = 0;
1857
1858 /* Get reg2a / reg2d base values */
1859 switch (sd->sensor) {
1860 case SENSOR_OV7630:
1861 reg2a = 0x08;
1862 reg2d = 0x01;
1863 break;
1864 case SENSOR_OV7648:
1865 reg2a = 0x11;
1866 reg2d = 0x81;
1867 break;
1868 }
1869
1870 switch (sd->freq) {
1871 case 0: /* Banding filter disabled */
1872 break;
1873 case 1: /* 50 hz (filter on and framerate adj) */
1874 reg2a |= 0x80;
1875 reg2b = 0xac;
1876 reg2d |= 0x04;
1877 break;
1878 case 2: /* 60 hz (filter on, no framerate adj) */
1879 reg2a |= 0x80;
1880 reg2d |= 0x04;
1881 break;
1882 }
1883 i2c_w1(gspca_dev, 0x2a, reg2a);
1884 i2c_w1(gspca_dev, 0x2b, reg2b);
1885 i2c_w1(gspca_dev, 0x2d, reg2d);
1886 }
1887 }
1888
1889 static void setjpegqual(struct gspca_dev *gspca_dev)
1890 {
1891 struct sd *sd = (struct sd *) gspca_dev;
1892 int i, sc;
1893
1894 if (sd->jpegqual < 50)
1895 sc = 5000 / sd->jpegqual;
1896 else
1897 sc = 200 - sd->jpegqual * 2;
1898 #if USB_BUF_SZ < 64
1899 #error "No room enough in usb_buf for quantization table"
1900 #endif
1901 for (i = 0; i < 64; i++)
1902 gspca_dev->usb_buf[i] =
1903 (jpeg_head[JPEG_QT0_OFFSET + i] * sc + 50) / 100;
1904 usb_control_msg(gspca_dev->dev,
1905 usb_sndctrlpipe(gspca_dev->dev, 0),
1906 0x08,
1907 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1908 0x0100, 0,
1909 gspca_dev->usb_buf, 64,
1910 500);
1911 for (i = 0; i < 64; i++)
1912 gspca_dev->usb_buf[i] =
1913 (jpeg_head[JPEG_QT1_OFFSET + i] * sc + 50) / 100;
1914 usb_control_msg(gspca_dev->dev,
1915 usb_sndctrlpipe(gspca_dev->dev, 0),
1916 0x08,
1917 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
1918 0x0140, 0,
1919 gspca_dev->usb_buf, 64,
1920 500);
1921
1922 sd->reg18 ^= 0x40;
1923 reg_w1(gspca_dev, 0x18, sd->reg18);
1924 }
1925
1926 /* -- start the camera -- */
1927 static int sd_start(struct gspca_dev *gspca_dev)
1928 {
1929 struct sd *sd = (struct sd *) gspca_dev;
1930 int i;
1931 u8 reg1, reg2, reg17;
1932 const u8 *sn9c1xx;
1933 const u8 (*init)[8];
1934 int mode;
1935 static const u8 C0[] = { 0x2d, 0x2d, 0x3a, 0x05, 0x04, 0x3f };
1936 static const u8 CA[] = { 0x28, 0xd8, 0x14, 0xec };
1937 static const u8 CA_adcm1700[] =
1938 { 0x14, 0xec, 0x0a, 0xf6 };
1939 static const u8 CE[] = { 0x32, 0xdd, 0x2d, 0xdd }; /* MI0360 */
1940 static const u8 CE_ov76xx[] =
1941 { 0x32, 0xdd, 0x32, 0xdd };
1942
1943 /* create the JPEG header */
1944 sd->jpeg_hdr = kmalloc(JPEG_HDR_SZ, GFP_KERNEL);
1945 if (!sd->jpeg_hdr)
1946 return -ENOMEM;
1947 jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width,
1948 0x21); /* JPEG 422 */
1949 jpeg_set_qual(sd->jpeg_hdr, sd->quality);
1950
1951 /* initialize the bridge */
1952 sn9c1xx = sn_tb[sd->sensor];
1953 bridge_init(gspca_dev, sn9c1xx);
1954
1955 /* initialize the sensor */
1956 i2c_w_seq(gspca_dev, sensor_init[sd->sensor]);
1957
1958 switch (sd->sensor) {
1959 case SENSOR_ADCM1700:
1960 reg2 = 0x60;
1961 break;
1962 case SENSOR_OM6802:
1963 reg2 = 0x71;
1964 break;
1965 case SENSOR_SP80708:
1966 reg2 = 0x62;
1967 break;
1968 default:
1969 reg2 = 0x40;
1970 break;
1971 }
1972 reg_w1(gspca_dev, 0x02, reg2);
1973 reg_w1(gspca_dev, 0x02, reg2);
1974
1975 reg_w1(gspca_dev, 0x15, sn9c1xx[0x15]);
1976 reg_w1(gspca_dev, 0x16, sn9c1xx[0x16]);
1977 reg_w1(gspca_dev, 0x12, sn9c1xx[0x12]);
1978 reg_w1(gspca_dev, 0x13, sn9c1xx[0x13]);
1979 reg_w1(gspca_dev, 0x18, sn9c1xx[0x18]);
1980 if (sd->sensor == SENSOR_ADCM1700) {
1981 reg_w1(gspca_dev, 0xd2, 0x3a); /* AE_H_SIZE = 116 */
1982 reg_w1(gspca_dev, 0xd3, 0x30); /* AE_V_SIZE = 96 */
1983 } else {
1984 reg_w1(gspca_dev, 0xd2, 0x6a); /* AE_H_SIZE = 212 */
1985 reg_w1(gspca_dev, 0xd3, 0x50); /* AE_V_SIZE = 160 */
1986 }
1987 reg_w1(gspca_dev, 0xc6, 0x00);
1988 reg_w1(gspca_dev, 0xc7, 0x00);
1989 if (sd->sensor == SENSOR_ADCM1700) {
1990 reg_w1(gspca_dev, 0xc8, 0x2c); /* AW_H_STOP = 352 */
1991 reg_w1(gspca_dev, 0xc9, 0x24); /* AW_V_STOP = 288 */
1992 } else {
1993 reg_w1(gspca_dev, 0xc8, 0x50); /* AW_H_STOP = 640 */
1994 reg_w1(gspca_dev, 0xc9, 0x3c); /* AW_V_STOP = 480 */
1995 }
1996 reg_w1(gspca_dev, 0x18, sn9c1xx[0x18]);
1997 switch (sd->sensor) {
1998 case SENSOR_MT9V111:
1999 reg17 = 0xe0;
2000 break;
2001 case SENSOR_ADCM1700:
2002 case SENSOR_OV7630:
2003 reg17 = 0xe2;
2004 break;
2005 case SENSOR_OV7648:
2006 reg17 = 0x20;
2007 break;
2008 case SENSOR_OV7660:
2009 reg17 = 0xa0;
2010 break;
2011 case SENSOR_PO1030:
2012 reg17 = 0xa0;
2013 break;
2014 default:
2015 reg17 = 0x60;
2016 break;
2017 }
2018 reg_w1(gspca_dev, 0x17, reg17);
2019
2020 reg_w1(gspca_dev, 0x05, 0x00); /* red */
2021 reg_w1(gspca_dev, 0x07, 0x00); /* green */
2022 reg_w1(gspca_dev, 0x06, 0x00); /* blue */
2023 reg_w1(gspca_dev, 0x14, sn9c1xx[0x14]);
2024
2025 setgamma(gspca_dev);
2026
2027 /*fixme: 8 times with all zeroes and 1 or 2 times with normal values */
2028 for (i = 0; i < 8; i++)
2029 reg_w(gspca_dev, 0x84, reg84, sizeof reg84);
2030 switch (sd->sensor) {
2031 case SENSOR_ADCM1700:
2032 case SENSOR_OV7660:
2033 case SENSOR_SP80708:
2034 reg_w1(gspca_dev, 0x9a, 0x05);
2035 break;
2036 case SENSOR_MT9V111:
2037 reg_w1(gspca_dev, 0x9a, 0x07);
2038 break;
2039 case SENSOR_OV7648:
2040 reg_w1(gspca_dev, 0x9a, 0x0a);
2041 break;
2042 default:
2043 reg_w1(gspca_dev, 0x9a, 0x08);
2044 break;
2045 }
2046 setsharpness(sd);
2047
2048 reg_w(gspca_dev, 0x84, reg84, sizeof reg84);
2049 reg_w1(gspca_dev, 0x05, 0x20); /* red */
2050 reg_w1(gspca_dev, 0x07, 0x20); /* green */
2051 reg_w1(gspca_dev, 0x06, 0x20); /* blue */
2052
2053 init = NULL;
2054 mode = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
2055 if (mode)
2056 reg1 = 0x46; /* 320x240: clk 48Mhz, video trf enable */
2057 else
2058 reg1 = 0x06; /* 640x480: clk 24Mhz, video trf enable */
2059 reg17 = 0x61; /* 0x:20: enable sensor clock */
2060 switch (sd->sensor) {
2061 case SENSOR_ADCM1700:
2062 init = adcm1700_sensor_param1;
2063 reg1 = 0x46;
2064 reg17 = 0xe2;
2065 break;
2066 case SENSOR_MO4000:
2067 if (mode) {
2068 /* reg1 = 0x46; * 320 clk 48Mhz 60fp/s */
2069 reg1 = 0x06; /* clk 24Mz */
2070 } else {
2071 reg17 = 0x22; /* 640 MCKSIZE */
2072 /* reg1 = 0x06; * 640 clk 24Mz (done) */
2073 }
2074 break;
2075 case SENSOR_MT9V111:
2076 init = mt9v111_sensor_param1;
2077 if (mode) {
2078 reg1 = 0x04; /* 320 clk 48Mhz */
2079 } else {
2080 /* reg1 = 0x06; * 640 clk 24Mz (done) */
2081 reg17 = 0xc2;
2082 }
2083 break;
2084 case SENSOR_OM6802:
2085 init = om6802_sensor_param1;
2086 reg17 = 0x64; /* 640 MCKSIZE */
2087 break;
2088 case SENSOR_OV7630:
2089 reg17 = 0xe2;
2090 reg1 = 0x44;
2091 break;
2092 case SENSOR_OV7648:
2093 init = ov7648_sensor_param1;
2094 reg17 = 0x21;
2095 /* reg1 = 0x42; * 42 - 46? */
2096 break;
2097 case SENSOR_OV7660:
2098 init = ov7660_sensor_param1;
2099 if (sd->bridge == BRIDGE_SN9C120) {
2100 if (mode) { /* 320x240 - 160x120 */
2101 reg17 = 0xa2;
2102 reg1 = 0x44; /* 48 Mhz, video trf eneble */
2103 }
2104 } else {
2105 reg17 = 0x22;
2106 reg1 = 0x06; /* 24 Mhz, video trf eneble
2107 * inverse power down */
2108 }
2109 break;
2110 case SENSOR_PO1030:
2111 init = po1030_sensor_param1;
2112 reg17 = 0xa2;
2113 reg1 = 0x44;
2114 break;
2115 default:
2116 /* case SENSOR_SP80708: */
2117 init = sp80708_sensor_param1;
2118 if (mode) {
2119 /*?? reg1 = 0x04; * 320 clk 48Mhz */
2120 } else {
2121 reg1 = 0x46; /* 640 clk 48Mz */
2122 reg17 = 0xa2;
2123 }
2124 break;
2125 }
2126
2127 /* more sensor initialization - param1 */
2128 if (init != NULL) {
2129 i2c_w_seq(gspca_dev, init);
2130 /* init = NULL; */
2131 }
2132
2133 reg_w(gspca_dev, 0xc0, C0, 6);
2134 if (sd->sensor == SENSOR_ADCM1700)
2135 reg_w(gspca_dev, 0xca, CA_adcm1700, 4);
2136 else
2137 reg_w(gspca_dev, 0xca, CA, 4);
2138 switch (sd->sensor) {
2139 case SENSOR_ADCM1700:
2140 case SENSOR_OV7630:
2141 case SENSOR_OV7648:
2142 case SENSOR_OV7660:
2143 reg_w(gspca_dev, 0xce, CE_ov76xx, 4);
2144 break;
2145 default:
2146 reg_w(gspca_dev, 0xce, CE, 4);
2147 /* ?? {0x1e, 0xdd, 0x2d, 0xe7} */
2148 break;
2149 }
2150
2151
2152 /* here change size mode 0 -> VGA; 1 -> CIF */
2153 sd->reg18 = sn9c1xx[0x18] | (mode << 4) | 0x40;
2154 reg_w1(gspca_dev, 0x18, sd->reg18);
2155 setjpegqual(gspca_dev);
2156
2157 reg_w1(gspca_dev, 0x17, reg17);
2158 reg_w1(gspca_dev, 0x01, reg1);
2159
2160 setvflip(sd);
2161 setbrightness(gspca_dev);
2162 setcontrast(gspca_dev);
2163 setautogain(gspca_dev);
2164 setfreq(gspca_dev);
2165 return 0;
2166 }
2167
2168 static void sd_stopN(struct gspca_dev *gspca_dev)
2169 {
2170 struct sd *sd = (struct sd *) gspca_dev;
2171 static const u8 stophv7131[] =
2172 { 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10 };
2173 static const u8 stopmi0360[] =
2174 { 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10 };
2175 static const u8 stopov7648[] =
2176 { 0xa1, 0x21, 0x76, 0x20, 0x00, 0x00, 0x00, 0x10 };
2177 u8 data;
2178 const u8 *sn9c1xx;
2179
2180 data = 0x0b;
2181 switch (sd->sensor) {
2182 case SENSOR_HV7131R:
2183 i2c_w8(gspca_dev, stophv7131);
2184 data = 0x2b;
2185 break;
2186 case SENSOR_MI0360:
2187 i2c_w8(gspca_dev, stopmi0360);
2188 data = 0x29;
2189 break;
2190 case SENSOR_OV7648:
2191 i2c_w8(gspca_dev, stopov7648);
2192 /* fall thru */
2193 case SENSOR_MT9V111:
2194 case SENSOR_OV7630:
2195 case SENSOR_PO1030:
2196 data = 0x29;
2197 break;
2198 }
2199 sn9c1xx = sn_tb[sd->sensor];
2200 reg_w1(gspca_dev, 0x01, sn9c1xx[1]);
2201 reg_w1(gspca_dev, 0x17, sn9c1xx[0x17]);
2202 reg_w1(gspca_dev, 0x01, sn9c1xx[1]);
2203 reg_w1(gspca_dev, 0x01, data);
2204 /* Don't disable sensor clock as that disables the button on the cam */
2205 /* reg_w1(gspca_dev, 0xf1, 0x01); */
2206 }
2207
2208 static void sd_stop0(struct gspca_dev *gspca_dev)
2209 {
2210 struct sd *sd = (struct sd *) gspca_dev;
2211
2212 kfree(sd->jpeg_hdr);
2213 }
2214
2215 static void do_autogain(struct gspca_dev *gspca_dev)
2216 {
2217 struct sd *sd = (struct sd *) gspca_dev;
2218 int delta;
2219 int expotimes;
2220 u8 luma_mean = 130;
2221 u8 luma_delta = 20;
2222
2223 /* Thanks S., without your advice, autobright should not work :) */
2224 if (sd->ag_cnt < 0)
2225 return;
2226 if (--sd->ag_cnt >= 0)
2227 return;
2228 sd->ag_cnt = AG_CNT_START;
2229
2230 delta = atomic_read(&sd->avg_lum);
2231 PDEBUG(D_FRAM, "mean lum %d", delta);
2232 if (delta < luma_mean - luma_delta ||
2233 delta > luma_mean + luma_delta) {
2234 switch (sd->sensor) {
2235 case SENSOR_HV7131R:
2236 expotimes = sd->exposure >> 8;
2237 expotimes += (luma_mean - delta) >> 4;
2238 if (expotimes < 0)
2239 expotimes = 0;
2240 sd->exposure = setexposure(gspca_dev,
2241 (unsigned int) (expotimes << 8));
2242 break;
2243 case SENSOR_OM6802:
2244 expotimes = sd->exposure;
2245 expotimes += (luma_mean - delta) >> 2;
2246 if (expotimes < 0)
2247 expotimes = 0;
2248 sd->exposure = setexposure(gspca_dev,
2249 (unsigned int) expotimes);
2250 setredblue(gspca_dev);
2251 break;
2252 default:
2253 /* case SENSOR_MO4000: */
2254 /* case SENSOR_MI0360: */
2255 /* case SENSOR_MT9V111: */
2256 expotimes = sd->exposure;
2257 expotimes += (luma_mean - delta) >> 6;
2258 if (expotimes < 0)
2259 expotimes = 0;
2260 sd->exposure = setexposure(gspca_dev,
2261 (unsigned int) expotimes);
2262 setredblue(gspca_dev);
2263 break;
2264 }
2265 }
2266 }
2267
2268 /* scan the URB packets */
2269 /* This function is run at interrupt level. */
2270 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
2271 u8 *data, /* isoc packet */
2272 int len) /* iso packet length */
2273 {
2274 struct sd *sd = (struct sd *) gspca_dev;
2275 int sof, avg_lum;
2276
2277 sof = len - 64;
2278 if (sof >= 0 && data[sof] == 0xff && data[sof + 1] == 0xd9) {
2279
2280 /* end of frame */
2281 gspca_frame_add(gspca_dev, LAST_PACKET,
2282 data, sof + 2);
2283 if (sd->ag_cnt < 0)
2284 return;
2285 /* w1 w2 w3 */
2286 /* w4 w5 w6 */
2287 /* w7 w8 */
2288 /* w4 */
2289 avg_lum = ((data[sof + 29] << 8) | data[sof + 30]) >> 6;
2290 /* w6 */
2291 avg_lum += ((data[sof + 33] << 8) | data[sof + 34]) >> 6;
2292 /* w2 */
2293 avg_lum += ((data[sof + 25] << 8) | data[sof + 26]) >> 6;
2294 /* w8 */
2295 avg_lum += ((data[sof + 37] << 8) | data[sof + 38]) >> 6;
2296 /* w5 */
2297 avg_lum += ((data[sof + 31] << 8) | data[sof + 32]) >> 4;
2298 avg_lum >>= 4;
2299 atomic_set(&sd->avg_lum, avg_lum);
2300 return;
2301 }
2302 if (gspca_dev->last_packet_type == LAST_PACKET) {
2303
2304 /* put the JPEG 422 header */
2305 gspca_frame_add(gspca_dev, FIRST_PACKET,
2306 sd->jpeg_hdr, JPEG_HDR_SZ);
2307 }
2308 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
2309 }
2310
2311 static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
2312 {
2313 struct sd *sd = (struct sd *) gspca_dev;
2314
2315 sd->brightness = val;
2316 if (gspca_dev->streaming)
2317 setbrightness(gspca_dev);
2318 return 0;
2319 }
2320
2321 static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val)
2322 {
2323 struct sd *sd = (struct sd *) gspca_dev;
2324
2325 *val = sd->brightness;
2326 return 0;
2327 }
2328
2329 static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
2330 {
2331 struct sd *sd = (struct sd *) gspca_dev;
2332
2333 sd->contrast = val;
2334 if (gspca_dev->streaming)
2335 setcontrast(gspca_dev);
2336 return 0;
2337 }
2338
2339 static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
2340 {
2341 struct sd *sd = (struct sd *) gspca_dev;
2342
2343 *val = sd->contrast;
2344 return 0;
2345 }
2346
2347 static int sd_setcolors(struct gspca_dev *gspca_dev, __s32 val)
2348 {
2349 struct sd *sd = (struct sd *) gspca_dev;
2350
2351 sd->colors = val;
2352 if (gspca_dev->streaming)
2353 setcolors(gspca_dev);
2354 return 0;
2355 }
2356
2357 static int sd_getcolors(struct gspca_dev *gspca_dev, __s32 *val)
2358 {
2359 struct sd *sd = (struct sd *) gspca_dev;
2360
2361 *val = sd->colors;
2362 return 0;
2363 }
2364
2365 static int sd_setblue_balance(struct gspca_dev *gspca_dev, __s32 val)
2366 {
2367 struct sd *sd = (struct sd *) gspca_dev;
2368
2369 sd->blue = val;
2370 if (gspca_dev->streaming)
2371 setredblue(gspca_dev);
2372 return 0;
2373 }
2374
2375 static int sd_getblue_balance(struct gspca_dev *gspca_dev, __s32 *val)
2376 {
2377 struct sd *sd = (struct sd *) gspca_dev;
2378
2379 *val = sd->blue;
2380 return 0;
2381 }
2382
2383 static int sd_setred_balance(struct gspca_dev *gspca_dev, __s32 val)
2384 {
2385 struct sd *sd = (struct sd *) gspca_dev;
2386
2387 sd->red = val;
2388 if (gspca_dev->streaming)
2389 setredblue(gspca_dev);
2390 return 0;
2391 }
2392
2393 static int sd_getred_balance(struct gspca_dev *gspca_dev, __s32 *val)
2394 {
2395 struct sd *sd = (struct sd *) gspca_dev;
2396
2397 *val = sd->red;
2398 return 0;
2399 }
2400
2401 static int sd_setgamma(struct gspca_dev *gspca_dev, __s32 val)
2402 {
2403 struct sd *sd = (struct sd *) gspca_dev;
2404
2405 sd->gamma = val;
2406 if (gspca_dev->streaming)
2407 setgamma(gspca_dev);
2408 return 0;
2409 }
2410
2411 static int sd_getgamma(struct gspca_dev *gspca_dev, __s32 *val)
2412 {
2413 struct sd *sd = (struct sd *) gspca_dev;
2414
2415 *val = sd->gamma;
2416 return 0;
2417 }
2418
2419 static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val)
2420 {
2421 struct sd *sd = (struct sd *) gspca_dev;
2422
2423 sd->autogain = val;
2424 if (gspca_dev->streaming)
2425 setautogain(gspca_dev);
2426 return 0;
2427 }
2428
2429 static int sd_getautogain(struct gspca_dev *gspca_dev, __s32 *val)
2430 {
2431 struct sd *sd = (struct sd *) gspca_dev;
2432
2433 *val = sd->autogain;
2434 return 0;
2435 }
2436
2437 static int sd_setsharpness(struct gspca_dev *gspca_dev, __s32 val)
2438 {
2439 struct sd *sd = (struct sd *) gspca_dev;
2440
2441 sd->sharpness = val;
2442 if (gspca_dev->streaming)
2443 setsharpness(sd);
2444 return 0;
2445 }
2446
2447 static int sd_getsharpness(struct gspca_dev *gspca_dev, __s32 *val)
2448 {
2449 struct sd *sd = (struct sd *) gspca_dev;
2450
2451 *val = sd->sharpness;
2452 return 0;
2453 }
2454
2455 static int sd_setvflip(struct gspca_dev *gspca_dev, __s32 val)
2456 {
2457 struct sd *sd = (struct sd *) gspca_dev;
2458
2459 sd->vflip = val;
2460 if (gspca_dev->streaming)
2461 setvflip(sd);
2462 return 0;
2463 }
2464
2465 static int sd_getvflip(struct gspca_dev *gspca_dev, __s32 *val)
2466 {
2467 struct sd *sd = (struct sd *) gspca_dev;
2468
2469 *val = sd->vflip;
2470 return 0;
2471 }
2472
2473 static int sd_setinfrared(struct gspca_dev *gspca_dev, __s32 val)
2474 {
2475 struct sd *sd = (struct sd *) gspca_dev;
2476
2477 sd->infrared = val;
2478 if (gspca_dev->streaming)
2479 setinfrared(sd);
2480 return 0;
2481 }
2482
2483 static int sd_getinfrared(struct gspca_dev *gspca_dev, __s32 *val)
2484 {
2485 struct sd *sd = (struct sd *) gspca_dev;
2486
2487 *val = sd->infrared;
2488 return 0;
2489 }
2490
2491 static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val)
2492 {
2493 struct sd *sd = (struct sd *) gspca_dev;
2494
2495 sd->freq = val;
2496 if (gspca_dev->streaming)
2497 setfreq(gspca_dev);
2498 return 0;
2499 }
2500
2501 static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val)
2502 {
2503 struct sd *sd = (struct sd *) gspca_dev;
2504
2505 *val = sd->freq;
2506 return 0;
2507 }
2508
2509 static int sd_set_jcomp(struct gspca_dev *gspca_dev,
2510 struct v4l2_jpegcompression *jcomp)
2511 {
2512 struct sd *sd = (struct sd *) gspca_dev;
2513
2514 if (jcomp->quality < QUALITY_MIN)
2515 sd->quality = QUALITY_MIN;
2516 else if (jcomp->quality > QUALITY_MAX)
2517 sd->quality = QUALITY_MAX;
2518 else
2519 sd->quality = jcomp->quality;
2520 if (gspca_dev->streaming)
2521 jpeg_set_qual(sd->jpeg_hdr, sd->quality);
2522 return 0;
2523 }
2524
2525 static int sd_get_jcomp(struct gspca_dev *gspca_dev,
2526 struct v4l2_jpegcompression *jcomp)
2527 {
2528 struct sd *sd = (struct sd *) gspca_dev;
2529
2530 memset(jcomp, 0, sizeof *jcomp);
2531 jcomp->quality = sd->quality;
2532 jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT
2533 | V4L2_JPEG_MARKER_DQT;
2534 return 0;
2535 }
2536
2537 static int sd_querymenu(struct gspca_dev *gspca_dev,
2538 struct v4l2_querymenu *menu)
2539 {
2540 switch (menu->id) {
2541 case V4L2_CID_POWER_LINE_FREQUENCY:
2542 switch (menu->index) {
2543 case 0: /* V4L2_CID_POWER_LINE_FREQUENCY_DISABLED */
2544 strcpy((char *) menu->name, "NoFliker");
2545 return 0;
2546 case 1: /* V4L2_CID_POWER_LINE_FREQUENCY_50HZ */
2547 strcpy((char *) menu->name, "50 Hz");
2548 return 0;
2549 case 2: /* V4L2_CID_POWER_LINE_FREQUENCY_60HZ */
2550 strcpy((char *) menu->name, "60 Hz");
2551 return 0;
2552 }
2553 break;
2554 }
2555 return -EINVAL;
2556 }
2557
2558 #ifdef CONFIG_INPUT
2559 static int sd_int_pkt_scan(struct gspca_dev *gspca_dev,
2560 u8 *data, /* interrupt packet data */
2561 int len) /* interrupt packet length */
2562 {
2563 int ret = -EINVAL;
2564
2565 if (len == 1 && data[0] == 1) {
2566 input_report_key(gspca_dev->input_dev, KEY_CAMERA, 1);
2567 input_sync(gspca_dev->input_dev);
2568 input_report_key(gspca_dev->input_dev, KEY_CAMERA, 0);
2569 input_sync(gspca_dev->input_dev);
2570 ret = 0;
2571 }
2572
2573 return ret;
2574 }
2575 #endif
2576
2577 /* sub-driver description */
2578 static const struct sd_desc sd_desc = {
2579 .name = MODULE_NAME,
2580 .ctrls = sd_ctrls,
2581 .nctrls = ARRAY_SIZE(sd_ctrls),
2582 .config = sd_config,
2583 .init = sd_init,
2584 .start = sd_start,
2585 .stopN = sd_stopN,
2586 .stop0 = sd_stop0,
2587 .pkt_scan = sd_pkt_scan,
2588 .dq_callback = do_autogain,
2589 .get_jcomp = sd_get_jcomp,
2590 .set_jcomp = sd_set_jcomp,
2591 .querymenu = sd_querymenu,
2592 #ifdef CONFIG_INPUT
2593 .int_pkt_scan = sd_int_pkt_scan,
2594 #endif
2595 };
2596
2597 /* -- module initialisation -- */
2598 #define BS(bridge, sensor) \
2599 .driver_info = (BRIDGE_ ## bridge << 16) \
2600 | SENSOR_ ## sensor
2601 static const __devinitdata struct usb_device_id device_table[] = {
2602 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2603 {USB_DEVICE(0x0458, 0x7025), BS(SN9C120, MI0360)},
2604 {USB_DEVICE(0x0458, 0x702e), BS(SN9C120, OV7660)},
2605 #endif
2606 {USB_DEVICE(0x045e, 0x00f5), BS(SN9C105, OV7660)},
2607 {USB_DEVICE(0x045e, 0x00f7), BS(SN9C105, OV7660)},
2608 {USB_DEVICE(0x0471, 0x0327), BS(SN9C105, MI0360)},
2609 {USB_DEVICE(0x0471, 0x0328), BS(SN9C105, MI0360)},
2610 {USB_DEVICE(0x0471, 0x0330), BS(SN9C105, MI0360)},
2611 {USB_DEVICE(0x06f8, 0x3004), BS(SN9C105, OV7660)},
2612 {USB_DEVICE(0x06f8, 0x3008), BS(SN9C105, OV7660)},
2613 /* {USB_DEVICE(0x0c45, 0x603a), BS(SN9C102P, OV7648)}, */
2614 {USB_DEVICE(0x0c45, 0x6040), BS(SN9C102P, HV7131R)},
2615 /* {USB_DEVICE(0x0c45, 0x607a), BS(SN9C102P, OV7648)}, */
2616 /* {USB_DEVICE(0x0c45, 0x607b), BS(SN9C102P, OV7660)}, */
2617 {USB_DEVICE(0x0c45, 0x607c), BS(SN9C102P, HV7131R)},
2618 /* {USB_DEVICE(0x0c45, 0x607e), BS(SN9C102P, OV7630)}, */
2619 {USB_DEVICE(0x0c45, 0x60c0), BS(SN9C105, MI0360)},
2620 /* {USB_DEVICE(0x0c45, 0x60c2), BS(SN9C105, P1030xC)}, */
2621 /* {USB_DEVICE(0x0c45, 0x60c8), BS(SN9C105, OM6802)}, */
2622 /* {USB_DEVICE(0x0c45, 0x60cc), BS(SN9C105, HV7131GP)}, */
2623 {USB_DEVICE(0x0c45, 0x60ec), BS(SN9C105, MO4000)},
2624 /* {USB_DEVICE(0x0c45, 0x60ef), BS(SN9C105, ICM105C)}, */
2625 /* {USB_DEVICE(0x0c45, 0x60fa), BS(SN9C105, OV7648)}, */
2626 {USB_DEVICE(0x0c45, 0x60fb), BS(SN9C105, OV7660)},
2627 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2628 {USB_DEVICE(0x0c45, 0x60fc), BS(SN9C105, HV7131R)},
2629 {USB_DEVICE(0x0c45, 0x60fe), BS(SN9C105, OV7630)},
2630 #endif
2631 {USB_DEVICE(0x0c45, 0x6100), BS(SN9C120, MI0360)}, /*sn9c128*/
2632 /* {USB_DEVICE(0x0c45, 0x6102), BS(SN9C120, P1030xC)}, */
2633 /* {USB_DEVICE(0x0c45, 0x6108), BS(SN9C120, OM6802)}, */
2634 {USB_DEVICE(0x0c45, 0x610a), BS(SN9C120, OV7648)}, /*sn9c128*/
2635 {USB_DEVICE(0x0c45, 0x610b), BS(SN9C120, OV7660)}, /*sn9c128*/
2636 {USB_DEVICE(0x0c45, 0x610c), BS(SN9C120, HV7131R)}, /*sn9c128*/
2637 {USB_DEVICE(0x0c45, 0x610e), BS(SN9C120, OV7630)}, /*sn9c128*/
2638 /* {USB_DEVICE(0x0c45, 0x610f), BS(SN9C120, S5K53BEB)}, */
2639 /* {USB_DEVICE(0x0c45, 0x6122), BS(SN9C110, ICM105C)}, */
2640 /* {USB_DEVICE(0x0c45, 0x6123), BS(SN9C110, SanyoCCD)}, */
2641 {USB_DEVICE(0x0c45, 0x6128), BS(SN9C120, OM6802)}, /*sn9c325?*/
2642 /*bw600.inf:*/
2643 {USB_DEVICE(0x0c45, 0x612a), BS(SN9C120, OV7648)}, /*sn9c325?*/
2644 {USB_DEVICE(0x0c45, 0x612c), BS(SN9C110, MO4000)},
2645 {USB_DEVICE(0x0c45, 0x612e), BS(SN9C110, OV7630)},
2646 /* {USB_DEVICE(0x0c45, 0x612f), BS(SN9C110, ICM105C)}, */
2647 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2648 {USB_DEVICE(0x0c45, 0x6130), BS(SN9C120, MI0360)},
2649 #endif
2650 /* {USB_DEVICE(0x0c45, 0x6132), BS(SN9C120, OV7670)}, */
2651 {USB_DEVICE(0x0c45, 0x6138), BS(SN9C120, MO4000)},
2652 {USB_DEVICE(0x0c45, 0x613a), BS(SN9C120, OV7648)},
2653 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2654 {USB_DEVICE(0x0c45, 0x613b), BS(SN9C120, OV7660)},
2655 #endif
2656 {USB_DEVICE(0x0c45, 0x613c), BS(SN9C120, HV7131R)},
2657 {USB_DEVICE(0x0c45, 0x613e), BS(SN9C120, OV7630)},
2658 /* {USB_DEVICE(0x0c45, 0x6142), BS(SN9C120, PO2030N)}, *sn9c120b*/
2659 {USB_DEVICE(0x0c45, 0x6143), BS(SN9C120, SP80708)}, /*sn9c120b*/
2660 {USB_DEVICE(0x0c45, 0x6148), BS(SN9C120, OM6802)}, /*sn9c120b*/
2661 {USB_DEVICE(0x0c45, 0x614a), BS(SN9C120, ADCM1700)}, /*sn9c120b*/
2662 {}
2663 };
2664 MODULE_DEVICE_TABLE(usb, device_table);
2665
2666 /* -- device connect -- */
2667 static int sd_probe(struct usb_interface *intf,
2668 const struct usb_device_id *id)
2669 {
2670 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
2671 THIS_MODULE);
2672 }
2673
2674 static struct usb_driver sd_driver = {
2675 .name = MODULE_NAME,
2676 .id_table = device_table,
2677 .probe = sd_probe,
2678 .disconnect = gspca_disconnect,
2679 #ifdef CONFIG_PM
2680 .suspend = gspca_suspend,
2681 .resume = gspca_resume,
2682 #endif
2683 };
2684
2685 /* -- module insert / remove -- */
2686 static int __init sd_mod_init(void)
2687 {
2688 int ret;
2689 ret = usb_register(&sd_driver);
2690 if (ret < 0)
2691 return ret;
2692 info("registered");
2693 return 0;
2694 }
2695 static void __exit sd_mod_exit(void)
2696 {
2697 usb_deregister(&sd_driver);
2698 info("deregistered");
2699 }
2700
2701 module_init(sd_mod_init);
2702 module_exit(sd_mod_exit);