83d5773d4629efda315fd96899541aa5f00f1155
[linux-flexiantxendom0-3.2.10.git] / drivers / media / video / gspca / sonixj.c
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);