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