2 * Sonix sn9c102p sn9c105 sn9c120 (jpeg) library
3 * Copyright (C) 2005 Michel Xhaard mxhaard@magic.fr
5 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
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
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.
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
22 #define MODULE_NAME "sonixj"
27 #define V4L2_CID_INFRARED (V4L2_CID_PRIVATE_BASE + 0)
29 MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
30 MODULE_DESCRIPTION("GSPCA/SONIX JPEG USB Camera Driver");
31 MODULE_LICENSE("GPL");
33 /* specific webcam descriptor */
35 struct gspca_dev gspca_dev
; /* !! must be the first item */
47 u8 vflip
; /* ov7630/ov7648 only */
48 u8 infrared
; /* mt9v111 only */
49 u8 freq
; /* ov76xx only */
50 u8 quality
; /* image quality */
51 #define QUALITY_MIN 60
52 #define QUALITY_MAX 95
53 #define QUALITY_DEF 80
54 u8 jpegqual
; /* webcam quality */
59 #define AG_CNT_START 13
62 #define BRIDGE_SN9C102P 0
63 #define BRIDGE_SN9C105 1
64 #define BRIDGE_SN9C110 2
65 #define BRIDGE_SN9C120 3
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
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 static int sd_setfreq(struct gspca_dev
*gspca_dev
, __s32 val
);
101 static int sd_getfreq(struct gspca_dev
*gspca_dev
, __s32
*val
);
103 static struct ctrl sd_ctrls
[] = {
104 #define BRIGHTNESS_IDX 0
107 .id
= V4L2_CID_BRIGHTNESS
,
108 .type
= V4L2_CTRL_TYPE_INTEGER
,
109 .name
= "Brightness",
111 #define BRIGHTNESS_MAX 0xffff
112 .maximum
= BRIGHTNESS_MAX
,
114 #define BRIGHTNESS_DEF 0x8000
115 .default_value
= BRIGHTNESS_DEF
,
117 .set
= sd_setbrightness
,
118 .get
= sd_getbrightness
,
120 #define CONTRAST_IDX 1
123 .id
= V4L2_CID_CONTRAST
,
124 .type
= V4L2_CTRL_TYPE_INTEGER
,
127 #define CONTRAST_MAX 127
128 .maximum
= CONTRAST_MAX
,
130 #define CONTRAST_DEF 63
131 .default_value
= CONTRAST_DEF
,
133 .set
= sd_setcontrast
,
134 .get
= sd_getcontrast
,
139 .id
= V4L2_CID_SATURATION
,
140 .type
= V4L2_CTRL_TYPE_INTEGER
,
146 .default_value
= COLOR_DEF
,
151 #define BLUE_BALANCE_IDX 3
154 .id
= V4L2_CID_BLUE_BALANCE
,
155 .type
= V4L2_CTRL_TYPE_INTEGER
,
156 .name
= "Blue Balance",
160 #define BLUE_BALANCE_DEF 32
161 .default_value
= BLUE_BALANCE_DEF
,
163 .set
= sd_setblue_balance
,
164 .get
= sd_getblue_balance
,
166 #define RED_BALANCE_IDX 4
169 .id
= V4L2_CID_RED_BALANCE
,
170 .type
= V4L2_CTRL_TYPE_INTEGER
,
171 .name
= "Red Balance",
175 #define RED_BALANCE_DEF 32
176 .default_value
= RED_BALANCE_DEF
,
178 .set
= sd_setred_balance
,
179 .get
= sd_getred_balance
,
184 .id
= V4L2_CID_GAMMA
,
185 .type
= V4L2_CTRL_TYPE_INTEGER
,
191 .default_value
= GAMMA_DEF
,
196 #define AUTOGAIN_IDX 6
199 .id
= V4L2_CID_AUTOGAIN
,
200 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
205 #define AUTOGAIN_DEF 1
206 .default_value
= AUTOGAIN_DEF
,
208 .set
= sd_setautogain
,
209 .get
= sd_getautogain
,
211 /* ov7630/ov7648 only */
215 .id
= V4L2_CID_VFLIP
,
216 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
221 #define VFLIP_DEF 0 /* vflip def = 1 for ov7630 */
222 .default_value
= VFLIP_DEF
,
228 #define INFRARED_IDX 8
231 .id
= V4L2_CID_INFRARED
,
232 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
237 #define INFRARED_DEF 0
238 .default_value
= INFRARED_DEF
,
240 .set
= sd_setinfrared
,
241 .get
= sd_getinfrared
,
243 /* ov7630/ov7648/ov7660 only */
247 .id
= V4L2_CID_POWER_LINE_FREQUENCY
,
248 .type
= V4L2_CTRL_TYPE_MENU
,
249 .name
= "Light frequency filter",
251 .maximum
= 2, /* 0: 0, 1: 50Hz, 2:60Hz */
254 .default_value
= FREQ_DEF
,
261 /* table of the disabled controls */
262 static __u32 ctrl_dis
[] = {
263 (1 << INFRARED_IDX
) | (1 << VFLIP_IDX
) | (1 << FREQ_IDX
),
264 /* SENSOR_HV7131R 0 */
265 (1 << INFRARED_IDX
) | (1 << VFLIP_IDX
) | (1 << FREQ_IDX
),
266 /* SENSOR_MI0360 1 */
267 (1 << INFRARED_IDX
) | (1 << VFLIP_IDX
) | (1 << FREQ_IDX
),
268 /* SENSOR_MO4000 2 */
269 (1 << VFLIP_IDX
) | (1 << FREQ_IDX
),
270 /* SENSOR_MT9V111 3 */
271 (1 << INFRARED_IDX
) | (1 << VFLIP_IDX
) | (1 << FREQ_IDX
),
272 /* SENSOR_OM6802 4 */
274 /* SENSOR_OV7630 5 */
276 /* SENSOR_OV7648 6 */
277 (1 << AUTOGAIN_IDX
) | (1 << INFRARED_IDX
) | (1 << VFLIP_IDX
),
278 /* SENSOR_OV7660 7 */
279 (1 << AUTOGAIN_IDX
) | (1 << INFRARED_IDX
) | (1 << VFLIP_IDX
) |
280 (1 << FREQ_IDX
), /* SENSOR_SP80708 8 */
283 static const struct v4l2_pix_format vga_mode
[] = {
284 {160, 120, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
286 .sizeimage
= 160 * 120 * 4 / 8 + 590,
287 .colorspace
= V4L2_COLORSPACE_JPEG
,
289 {320, 240, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
291 .sizeimage
= 320 * 240 * 3 / 8 + 590,
292 .colorspace
= V4L2_COLORSPACE_JPEG
,
294 {640, 480, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
296 /* Note 3 / 8 is not large enough, not even 5 / 8 is ?! */
297 .sizeimage
= 640 * 480 * 3 / 4 + 590,
298 .colorspace
= V4L2_COLORSPACE_JPEG
,
302 /*Data from sn9c102p+hv7131r */
303 static const u8 sn_hv7131
[0x1c] = {
304 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
305 0x00, 0x03, 0x64, 0x00, 0x1a, 0x20, 0x20, 0x20,
306 /* reg8 reg9 rega regb regc regd rege regf */
307 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10,
308 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
309 0x03, 0x00, 0x00, 0x01, 0x03, 0x28, 0x1e, 0x41,
310 /* reg18 reg19 reg1a reg1b */
311 0x0a, 0x00, 0x00, 0x00
314 static const u8 sn_mi0360
[0x1c] = {
315 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
316 0x00, 0x61, 0x44, 0x00, 0x1a, 0x20, 0x20, 0x20,
317 /* reg8 reg9 rega regb regc regd rege regf */
318 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10,
319 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
320 0x03, 0x00, 0x00, 0x02, 0x0a, 0x28, 0x1e, 0x61,
321 /* reg18 reg19 reg1a reg1b */
322 0x06, 0x00, 0x00, 0x00
325 static const u8 sn_mo4000
[0x1c] = {
326 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
327 0x00, 0x23, 0x60, 0x00, 0x1a, 0x00, 0x20, 0x18,
328 /* reg8 reg9 rega regb regc regd rege regf */
329 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
330 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
331 0x03, 0x00, 0x0b, 0x0f, 0x14, 0x28, 0x1e, 0x40,
332 /* reg18 reg19 reg1a reg1b */
333 0x08, 0x00, 0x00, 0x00
336 static const u8 sn_mt9v111
[0x1c] = {
337 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
338 0x00, 0x61, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
339 /* reg8 reg9 rega regb regc regd rege regf */
340 0x81, 0x5c, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00,
341 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
342 0x03, 0x00, 0x00, 0x02, 0x1c, 0x28, 0x1e, 0x40,
343 /* reg18 reg19 reg1a reg1b */
344 0x06, 0x00, 0x00, 0x00
347 static const u8 sn_om6802
[0x1c] = {
348 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
349 0x00, 0x23, 0x72, 0x00, 0x1a, 0x34, 0x27, 0x20,
350 /* reg8 reg9 rega regb regc regd rege regf */
351 0x80, 0x34, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
352 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
353 0x03, 0x00, 0x51, 0x01, 0x00, 0x28, 0x1e, 0x40,
354 /* reg18 reg19 reg1a reg1b */
355 0x05, 0x00, 0x00, 0x00
358 static const u8 sn_ov7630
[0x1c] = {
359 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
360 0x00, 0x21, 0x40, 0x00, 0x1a, 0x20, 0x1f, 0x20,
361 /* reg8 reg9 rega regb regc regd rege regf */
362 0xa1, 0x21, 0x76, 0x21, 0x00, 0x00, 0x00, 0x10,
363 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
364 0x03, 0x00, 0x04, 0x01, 0x0a, 0x28, 0x1e, 0xc2,
365 /* reg18 reg19 reg1a reg1b */
366 0x0b, 0x00, 0x00, 0x00
369 static const u8 sn_ov7648
[0x1c] = {
370 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
371 0x00, 0x63, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
372 /* reg8 reg9 rega regb regc regd rege regf */
373 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10,
374 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
375 0x03, 0x00, 0x00, 0x01, 0x00, 0x28, 0x1e, 0x00,
376 /* reg18 reg19 reg1a reg1b */
377 0x0b, 0x00, 0x00, 0x00
380 static const u8 sn_ov7660
[0x1c] = {
381 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
382 0x00, 0x61, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
383 /* reg8 reg9 rega regb regc regd rege regf */
384 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
385 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
386 0x03, 0x00, 0x01, 0x01, 0x08, 0x28, 0x1e, 0x20,
387 /* reg18 reg19 reg1a reg1b */
388 0x07, 0x00, 0x00, 0x00
391 static const u8 sn_sp80708
[0x1c] = {
392 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
393 0x00, 0x63, 0x60, 0x00, 0x1a, 0x20, 0x20, 0x20,
394 /* reg8 reg9 rega regb regc regd rege regf */
395 0x81, 0x18, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00,
396 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
397 0x03, 0x00, 0x00, 0x03, 0x04, 0x28, 0x1e, 0x00,
398 /* reg18 reg19 reg1a reg1b */
399 0x07, 0x00, 0x00, 0x00
402 /* sequence specific to the sensors - !! index = SENSOR_xxx */
403 static const u8
*sn_tb
[] = {
415 /* default gamma table */
416 static const u8 gamma_def
[17] = {
417 0x00, 0x2d, 0x46, 0x5a, 0x6c, 0x7c, 0x8b, 0x99,
418 0xa6, 0xb2, 0xbf, 0xca, 0xd5, 0xe0, 0xeb, 0xf5, 0xff
420 /* gamma for sensors HV7131R and MT9V111 */
421 static const u8 gamma_spec_1
[17] = {
422 0x08, 0x3a, 0x52, 0x65, 0x75, 0x83, 0x91, 0x9d,
423 0xa9, 0xb4, 0xbe, 0xc8, 0xd2, 0xdb, 0xe4, 0xed, 0xf5
425 /* gamma for sensor SP80708 */
426 static const u8 gamma_spec_2
[17] = {
427 0x0a, 0x2d, 0x4e, 0x68, 0x7d, 0x8f, 0x9f, 0xab,
428 0xb7, 0xc2, 0xcc, 0xd3, 0xd8, 0xde, 0xe2, 0xe5, 0xe6
431 /* color matrix and offsets */
432 static const u8 reg84
[] = {
433 0x14, 0x00, 0x27, 0x00, 0x07, 0x00, /* YR YG YB gains */
434 0xe8, 0x0f, 0xda, 0x0f, 0x40, 0x00, /* UR UG UB */
435 0x3e, 0x00, 0xcd, 0x0f, 0xf7, 0x0f, /* VR VG VB */
436 0x00, 0x00, 0x00 /* YUV offsets */
438 static const u8 hv7131r_sensor_init
[][8] = {
439 {0xc1, 0x11, 0x01, 0x08, 0x01, 0x00, 0x00, 0x10},
440 {0xb1, 0x11, 0x34, 0x17, 0x7f, 0x00, 0x00, 0x10},
441 {0xd1, 0x11, 0x40, 0xff, 0x7f, 0x7f, 0x7f, 0x10},
442 /* {0x91, 0x11, 0x44, 0x00, 0x00, 0x00, 0x00, 0x10}, */
443 {0xd1, 0x11, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
444 {0xd1, 0x11, 0x14, 0x01, 0xe2, 0x02, 0x82, 0x10},
445 /* {0x91, 0x11, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10}, */
447 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
448 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
449 {0xc1, 0x11, 0x25, 0x00, 0x61, 0xa8, 0x00, 0x10},
450 {0xa1, 0x11, 0x30, 0x22, 0x00, 0x00, 0x00, 0x10},
451 {0xc1, 0x11, 0x31, 0x20, 0x2e, 0x20, 0x00, 0x10},
452 {0xc1, 0x11, 0x25, 0x00, 0xc3, 0x50, 0x00, 0x10},
453 {0xa1, 0x11, 0x30, 0x07, 0x00, 0x00, 0x00, 0x10}, /* gain14 */
454 {0xc1, 0x11, 0x31, 0x10, 0x10, 0x10, 0x00, 0x10}, /* r g b 101a10 */
456 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
457 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
458 {0xa1, 0x11, 0x21, 0xD0, 0x00, 0x00, 0x00, 0x10},
459 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
460 {0xa1, 0x11, 0x23, 0x09, 0x00, 0x00, 0x00, 0x10},
462 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
463 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
464 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
465 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
466 {0xa1, 0x11, 0x23, 0x10, 0x00, 0x00, 0x00, 0x10},
469 static const u8 mi0360_sensor_init
[][8] = {
470 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
471 {0xb1, 0x5d, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10},
472 {0xb1, 0x5d, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
473 {0xd1, 0x5d, 0x01, 0x00, 0x08, 0x00, 0x16, 0x10},
474 {0xd1, 0x5d, 0x03, 0x01, 0xe2, 0x02, 0x82, 0x10},
475 {0xd1, 0x5d, 0x05, 0x00, 0x09, 0x00, 0x53, 0x10},
476 {0xb1, 0x5d, 0x0d, 0x00, 0x02, 0x00, 0x00, 0x10},
477 {0xd1, 0x5d, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
478 {0xd1, 0x5d, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10},
479 {0xd1, 0x5d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
480 {0xd1, 0x5d, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
481 {0xd1, 0x5d, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
482 {0xd1, 0x5d, 0x14, 0x00, 0x00, 0x00, 0x00, 0x10},
483 {0xd1, 0x5d, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10},
484 {0xd1, 0x5d, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10},
485 {0xd1, 0x5d, 0x1a, 0x00, 0x00, 0x00, 0x00, 0x10},
486 {0xd1, 0x5d, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x10},
487 {0xb1, 0x5d, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
488 {0xd1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
489 {0xd1, 0x5d, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
490 {0xd1, 0x5d, 0x24, 0x00, 0x00, 0x00, 0x00, 0x10},
491 {0xd1, 0x5d, 0x26, 0x00, 0x00, 0x00, 0x24, 0x10},
492 {0xd1, 0x5d, 0x2f, 0xf7, 0xB0, 0x00, 0x04, 0x10},
493 {0xd1, 0x5d, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10},
494 {0xd1, 0x5d, 0x33, 0x00, 0x00, 0x01, 0x00, 0x10},
495 {0xb1, 0x5d, 0x3d, 0x06, 0x8f, 0x00, 0x00, 0x10},
496 {0xd1, 0x5d, 0x40, 0x01, 0xe0, 0x00, 0xd1, 0x10},
497 {0xb1, 0x5d, 0x44, 0x00, 0x82, 0x00, 0x00, 0x10},
498 {0xd1, 0x5d, 0x58, 0x00, 0x78, 0x00, 0x43, 0x10},
499 {0xd1, 0x5d, 0x5a, 0x00, 0x00, 0x00, 0x00, 0x10},
500 {0xd1, 0x5d, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x10},
501 {0xd1, 0x5d, 0x5e, 0x00, 0x00, 0xa3, 0x1d, 0x10},
502 {0xb1, 0x5d, 0x62, 0x04, 0x11, 0x00, 0x00, 0x10},
504 {0xb1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
505 {0xb1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
506 {0xb1, 0x5d, 0x09, 0x00, 0x64, 0x00, 0x00, 0x10},
507 {0xd1, 0x5d, 0x2b, 0x00, 0xa0, 0x00, 0xb0, 0x10},
508 {0xd1, 0x5d, 0x2d, 0x00, 0xa0, 0x00, 0xa0, 0x10},
510 {0xb1, 0x5d, 0x0a, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor clck ?2 */
511 {0xb1, 0x5d, 0x06, 0x00, 0x30, 0x00, 0x00, 0x10},
512 {0xb1, 0x5d, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10},
513 {0xb1, 0x5d, 0x09, 0x02, 0x35, 0x00, 0x00, 0x10}, /* exposure 2 */
515 {0xd1, 0x5d, 0x2b, 0x00, 0xb9, 0x00, 0xe3, 0x10},
516 {0xd1, 0x5d, 0x2d, 0x00, 0x5f, 0x00, 0xb9, 0x10}, /* 42 */
517 /* {0xb1, 0x5d, 0x35, 0x00, 0x67, 0x00, 0x00, 0x10}, * gain orig */
518 /* {0xb1, 0x5d, 0x35, 0x00, 0x20, 0x00, 0x00, 0x10}, * gain */
519 {0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10}, /* update */
520 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor on */
523 static const u8 mo4000_sensor_init
[][8] = {
524 {0xa1, 0x21, 0x01, 0x02, 0x00, 0x00, 0x00, 0x10},
525 {0xa1, 0x21, 0x02, 0x00, 0x00, 0x00, 0x00, 0x10},
526 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
527 {0xa1, 0x21, 0x04, 0x00, 0x00, 0x00, 0x00, 0x10},
528 {0xa1, 0x21, 0x05, 0x00, 0x00, 0x00, 0x00, 0x10},
529 {0xa1, 0x21, 0x05, 0x04, 0x00, 0x00, 0x00, 0x10},
530 {0xa1, 0x21, 0x06, 0x80, 0x00, 0x00, 0x00, 0x10},
531 {0xa1, 0x21, 0x06, 0x81, 0x00, 0x00, 0x00, 0x10},
532 {0xa1, 0x21, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
533 {0xa1, 0x21, 0x11, 0x00, 0x00, 0x00, 0x00, 0x10},
534 {0xa1, 0x21, 0x11, 0x20, 0x00, 0x00, 0x00, 0x10},
535 {0xa1, 0x21, 0x11, 0x30, 0x00, 0x00, 0x00, 0x10},
536 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
537 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
538 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
539 {0xa1, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
540 {0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10},
541 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10},
542 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
543 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
546 static const u8 mt9v111_sensor_init
[][8] = {
547 {0xb1, 0x5c, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10}, /* reset? */
549 {0xb1, 0x5c, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
550 {0xb1, 0x5c, 0x01, 0x00, 0x01, 0x00, 0x00, 0x10}, /* IFP select */
551 {0xb1, 0x5c, 0x08, 0x04, 0x80, 0x00, 0x00, 0x10}, /* output fmt ctrl */
552 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10}, /* op mode ctrl */
553 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10},
554 {0xb1, 0x5c, 0x03, 0x01, 0xe1, 0x00, 0x00, 0x10},
555 {0xb1, 0x5c, 0x04, 0x02, 0x81, 0x00, 0x00, 0x10},
556 {0xb1, 0x5c, 0x05, 0x00, 0x04, 0x00, 0x00, 0x10},
557 {0xb1, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10}, /* sensor select */
558 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10},
559 {0xb1, 0x5c, 0x03, 0x01, 0xe6, 0x00, 0x00, 0x10},
560 {0xb1, 0x5c, 0x04, 0x02, 0x86, 0x00, 0x00, 0x10},
561 {0xb1, 0x5c, 0x05, 0x00, 0x04, 0x00, 0x00, 0x10},
562 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10},
563 {0xb1, 0x5c, 0x08, 0x00, 0x08, 0x00, 0x00, 0x10}, /* row start */
564 {0xb1, 0x5c, 0x0e, 0x00, 0x08, 0x00, 0x00, 0x10},
565 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10}, /* col start */
566 {0xb1, 0x5c, 0x03, 0x01, 0xe7, 0x00, 0x00, 0x10}, /* window height */
567 {0xb1, 0x5c, 0x04, 0x02, 0x87, 0x00, 0x00, 0x10}, /* window width */
568 {0xb1, 0x5c, 0x07, 0x30, 0x02, 0x00, 0x00, 0x10}, /* output ctrl */
569 {0xb1, 0x5c, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10}, /* shutter delay */
570 {0xb1, 0x5c, 0x12, 0x00, 0xb0, 0x00, 0x00, 0x10}, /* zoom col start */
571 {0xb1, 0x5c, 0x13, 0x00, 0x7c, 0x00, 0x00, 0x10}, /* zoom row start */
572 {0xb1, 0x5c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* digital zoom */
573 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10}, /* read mode */
574 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
576 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
577 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
578 {0xb1, 0x5c, 0x09, 0x01, 0x2c, 0x00, 0x00, 0x10},
579 {0xd1, 0x5c, 0x2b, 0x00, 0x33, 0x00, 0xa0, 0x10}, /* green1 gain */
580 {0xd1, 0x5c, 0x2d, 0x00, 0xa0, 0x00, 0x33, 0x10}, /* red gain */
582 {0xb1, 0x5c, 0x06, 0x00, 0x1e, 0x00, 0x00, 0x10}, /* vert blanking */
583 {0xb1, 0x5c, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10}, /* horiz blanking */
584 {0xd1, 0x5c, 0x2c, 0x00, 0xad, 0x00, 0xad, 0x10}, /* blue gain */
585 {0xb1, 0x5c, 0x35, 0x01, 0xc0, 0x00, 0x00, 0x10}, /* global gain */
588 static const u8 om6802_sensor_init
[][8] = {
589 {0xa0, 0x34, 0x90, 0x05, 0x00, 0x00, 0x00, 0x10},
590 {0xa0, 0x34, 0x49, 0x85, 0x00, 0x00, 0x00, 0x10},
591 {0xa0, 0x34, 0x5a, 0xc0, 0x00, 0x00, 0x00, 0x10},
592 {0xa0, 0x34, 0xdd, 0x18, 0x00, 0x00, 0x00, 0x10},
593 /* {0xa0, 0x34, 0xfb, 0x11, 0x00, 0x00, 0x00, 0x10}, */
594 {0xa0, 0x34, 0xf0, 0x04, 0x00, 0x00, 0x00, 0x10},
595 /* white balance & auto-exposure */
596 /* {0xa0, 0x34, 0xf1, 0x02, 0x00, 0x00, 0x00, 0x10},
598 /* {0xa0, 0x34, 0xfe, 0x5b, 0x00, 0x00, 0x00, 0x10},
599 * max AGC value in AE */
600 /* {0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10},
602 /* {0xa0, 0x34, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x10},
603 * preset brightness */
604 /* {0xa0, 0x34, 0xe7, 0x00, 0x00, 0x00, 0x00, 0x10},
606 /* {0xa0, 0x34, 0xe8, 0x31, 0x00, 0x00, 0x00, 0x10},
608 {0xa0, 0x34, 0xe9, 0x0f, 0x00, 0x00, 0x00, 0x10},
609 /* luminance mode (0x4f = AE) */
610 {0xa0, 0x34, 0xe4, 0xff, 0x00, 0x00, 0x00, 0x10},
612 /* {0xa0, 0x34, 0xef, 0x00, 0x00, 0x00, 0x00, 0x10},
614 /* {0xa0, 0x34, 0xfb, 0xee, 0x00, 0x00, 0x00, 0x10}, */
616 /* {0xa0, 0x34, 0x71, 0x84, 0x00, 0x00, 0x00, 0x10}, */
617 /* {0xa0, 0x34, 0x72, 0x05, 0x00, 0x00, 0x00, 0x10}, */
618 /* {0xa0, 0x34, 0x68, 0x80, 0x00, 0x00, 0x00, 0x10}, */
619 /* {0xa0, 0x34, 0x69, 0x01, 0x00, 0x00, 0x00, 0x10}, */
622 static const u8 ov7630_sensor_init
[][8] = {
623 {0xa1, 0x21, 0x76, 0x01, 0x00, 0x00, 0x00, 0x10},
624 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
625 /* win: delay 20ms */
626 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
627 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
628 /* win: delay 20ms */
629 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
630 /* win: i2c_r from 00 to 80 */
631 {0xd1, 0x21, 0x03, 0x80, 0x10, 0x20, 0x80, 0x10},
632 {0xb1, 0x21, 0x0c, 0x20, 0x20, 0x00, 0x00, 0x10},
633 /* HDG: 0x11 was 0x00 change to 0x01 for better exposure (15 fps instead of 30)
634 0x13 was 0xc0 change to 0xc3 for auto gain and exposure */
635 {0xd1, 0x21, 0x11, 0x01, 0x48, 0xc3, 0x00, 0x10},
636 {0xb1, 0x21, 0x15, 0x80, 0x03, 0x00, 0x00, 0x10},
637 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
638 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
639 {0xd1, 0x21, 0x1f, 0x00, 0x80, 0x80, 0x80, 0x10},
640 {0xd1, 0x21, 0x23, 0xde, 0x10, 0x8a, 0xa0, 0x10},
641 {0xc1, 0x21, 0x27, 0xca, 0xa2, 0x74, 0x00, 0x10},
642 {0xd1, 0x21, 0x2a, 0x88, 0x00, 0x88, 0x01, 0x10},
643 {0xc1, 0x21, 0x2e, 0x80, 0x00, 0x18, 0x00, 0x10},
644 {0xa1, 0x21, 0x21, 0x08, 0x00, 0x00, 0x00, 0x10},
645 {0xa1, 0x21, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
646 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10},
647 {0xb1, 0x21, 0x32, 0xc2, 0x08, 0x00, 0x00, 0x10},
648 {0xb1, 0x21, 0x4c, 0x00, 0x00, 0x00, 0x00, 0x10},
649 {0xd1, 0x21, 0x60, 0x05, 0x40, 0x12, 0x57, 0x10},
650 {0xa1, 0x21, 0x64, 0x73, 0x00, 0x00, 0x00, 0x10},
651 {0xd1, 0x21, 0x65, 0x00, 0x55, 0x01, 0xac, 0x10},
652 {0xa1, 0x21, 0x69, 0x38, 0x00, 0x00, 0x00, 0x10},
653 {0xd1, 0x21, 0x6f, 0x1f, 0x01, 0x00, 0x10, 0x10},
654 {0xd1, 0x21, 0x73, 0x50, 0x20, 0x02, 0x01, 0x10},
655 {0xd1, 0x21, 0x77, 0xf3, 0x90, 0x98, 0x98, 0x10},
656 {0xc1, 0x21, 0x7b, 0x00, 0x4c, 0xf7, 0x00, 0x10},
657 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
658 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
660 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
661 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
662 /*fixme: + 0x12, 0x04*/
663 /* {0xa1, 0x21, 0x75, 0x82, 0x00, 0x00, 0x00, 0x10}, * COMN
665 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
666 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
667 {0xb1, 0x21, 0x01, 0x80, 0x80, 0x00, 0x00, 0x10},
669 /* {0xa1, 0x21, 0x2a, 0x88, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
670 /* {0xa1, 0x21, 0x2b, 0x34, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
672 {0xa1, 0x21, 0x10, 0x83, 0x00, 0x00, 0x00, 0x10},
673 /* {0xb1, 0x21, 0x01, 0x88, 0x70, 0x00, 0x00, 0x10}, */
677 static const u8 ov7648_sensor_init
[][8] = {
678 {0xa1, 0x21, 0x76, 0x00, 0x00, 0x00, 0x00, 0x10},
679 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset */
680 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
681 {0xd1, 0x21, 0x03, 0xa4, 0x30, 0x88, 0x00, 0x10},
682 {0xb1, 0x21, 0x11, 0x80, 0x08, 0x00, 0x00, 0x10},
683 {0xc1, 0x21, 0x13, 0xa0, 0x04, 0x84, 0x00, 0x10},
684 {0xd1, 0x21, 0x17, 0x1a, 0x02, 0xba, 0xf4, 0x10},
685 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
686 {0xd1, 0x21, 0x1f, 0x41, 0xc0, 0x80, 0x80, 0x10},
687 {0xd1, 0x21, 0x23, 0xde, 0xa0, 0x80, 0x32, 0x10},
688 {0xd1, 0x21, 0x27, 0xfe, 0xa0, 0x00, 0x91, 0x10},
689 {0xd1, 0x21, 0x2b, 0x00, 0x88, 0x85, 0x80, 0x10},
690 {0xc1, 0x21, 0x2f, 0x9c, 0x00, 0xc4, 0x00, 0x10},
691 {0xd1, 0x21, 0x60, 0xa6, 0x60, 0x88, 0x12, 0x10},
692 {0xd1, 0x21, 0x64, 0x88, 0x00, 0x00, 0x94, 0x10},
693 {0xd1, 0x21, 0x68, 0x7a, 0x0c, 0x00, 0x00, 0x10},
694 {0xd1, 0x21, 0x6c, 0x11, 0x33, 0x22, 0x00, 0x10},
695 {0xd1, 0x21, 0x70, 0x11, 0x00, 0x10, 0x50, 0x10},
696 {0xd1, 0x21, 0x74, 0x20, 0x06, 0x00, 0xb5, 0x10},
697 {0xd1, 0x21, 0x78, 0x8a, 0x00, 0x00, 0x00, 0x10},
698 {0xb1, 0x21, 0x7c, 0x00, 0x43, 0x00, 0x00, 0x10},
700 {0xd1, 0x21, 0x21, 0x86, 0x00, 0xde, 0xa0, 0x10},
701 /* {0xd1, 0x21, 0x25, 0x80, 0x32, 0xfe, 0xa0, 0x10}, jfm done */
702 /* {0xd1, 0x21, 0x29, 0x00, 0x91, 0x00, 0x88, 0x10}, jfm done */
703 /* {0xb1, 0x21, 0x2d, 0x85, 0x00, 0x00, 0x00, 0x10}, set by setfreq */
705 /* {0xa1, 0x21, 0x12, 0x08, 0x00, 0x00, 0x00, 0x10}, jfm done */
706 /* {0xa1, 0x21, 0x75, 0x06, 0x00, 0x00, 0x00, 0x10}, * COMN
708 {0xa1, 0x21, 0x19, 0x02, 0x00, 0x00, 0x00, 0x10},
709 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
710 /* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
711 /* {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10}, * GAIN - def */
712 /* {0xb1, 0x21, 0x01, 0x6c, 0x6c, 0x00, 0x00, 0x10}, * B R - def: 80 */
714 {0xa1, 0x21, 0x11, 0x81, 0x00, 0x00, 0x00, 0x10}, /* CLKRC */
715 /* {0xa1, 0x21, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
716 /* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
717 /* {0xa1, 0x21, 0x2a, 0x91, 0x00, 0x00, 0x00, 0x10}, jfm done */
718 /* {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
719 /* {0xb1, 0x21, 0x01, 0x64, 0x84, 0x00, 0x00, 0x10}, * B R - def: 80 */
724 static const u8 ov7660_sensor_init
[][8] = {
725 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset SCCB */
727 {0xa1, 0x21, 0x12, 0x05, 0x00, 0x00, 0x00, 0x10},
728 /* Outformat = rawRGB */
729 {0xa1, 0x21, 0x13, 0xb8, 0x00, 0x00, 0x00, 0x10}, /* init COM8 */
730 {0xd1, 0x21, 0x00, 0x01, 0x74, 0x74, 0x00, 0x10},
731 /* GAIN BLUE RED VREF */
732 {0xd1, 0x21, 0x04, 0x00, 0x7d, 0x62, 0x00, 0x10},
733 /* COM 1 BAVE GEAVE AECHH */
734 {0xb1, 0x21, 0x08, 0x83, 0x01, 0x00, 0x00, 0x10}, /* RAVE COM2 */
735 {0xd1, 0x21, 0x0c, 0x00, 0x08, 0x04, 0x4f, 0x10}, /* COM 3 4 5 6 */
736 {0xd1, 0x21, 0x10, 0x7f, 0x40, 0x05, 0xff, 0x10},
737 /* AECH CLKRC COM7 COM8 */
738 {0xc1, 0x21, 0x14, 0x2c, 0x00, 0x02, 0x00, 0x10}, /* COM9 COM10 */
739 {0xd1, 0x21, 0x17, 0x10, 0x60, 0x02, 0x7b, 0x10},
740 /* HSTART HSTOP VSTRT VSTOP */
741 {0xa1, 0x21, 0x1b, 0x02, 0x00, 0x00, 0x00, 0x10}, /* PSHFT */
742 {0xb1, 0x21, 0x1e, 0x01, 0x0e, 0x00, 0x00, 0x10}, /* MVFP LAEC */
743 {0xd1, 0x21, 0x20, 0x07, 0x07, 0x07, 0x07, 0x10},
744 /* BOS GBOS GROS ROS (BGGR offset) */
745 /* {0xd1, 0x21, 0x24, 0x68, 0x58, 0xd4, 0x80, 0x10}, */
746 {0xd1, 0x21, 0x24, 0x78, 0x68, 0xd4, 0x80, 0x10},
747 /* AEW AEB VPT BBIAS */
748 {0xd1, 0x21, 0x28, 0x80, 0x30, 0x00, 0x00, 0x10},
749 /* GbBIAS RSVD EXHCH EXHCL */
750 {0xd1, 0x21, 0x2c, 0x80, 0x00, 0x00, 0x62, 0x10},
751 /* RBIAS ADVFL ASDVFH YAVE */
752 {0xc1, 0x21, 0x30, 0x08, 0x30, 0xb4, 0x00, 0x10},
753 /* HSYST HSYEN HREF */
754 {0xd1, 0x21, 0x33, 0x00, 0x07, 0x84, 0x00, 0x10}, /* reserved */
755 {0xd1, 0x21, 0x37, 0x0c, 0x02, 0x43, 0x00, 0x10},
756 /* ADC ACOM OFON TSLB */
757 {0xd1, 0x21, 0x3b, 0x02, 0x6c, 0x19, 0x0e, 0x10},
758 /* COM11 COM12 COM13 COM14 */
759 {0xd1, 0x21, 0x3f, 0x41, 0xc1, 0x22, 0x08, 0x10},
760 /* EDGE COM15 COM16 COM17 */
761 {0xd1, 0x21, 0x43, 0xf0, 0x10, 0x78, 0xa8, 0x10}, /* reserved */
762 {0xd1, 0x21, 0x47, 0x60, 0x80, 0x00, 0x00, 0x10}, /* reserved */
763 {0xd1, 0x21, 0x4b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* reserved */
764 {0xd1, 0x21, 0x4f, 0x46, 0x36, 0x0f, 0x17, 0x10}, /* MTX 1 2 3 4 */
765 {0xd1, 0x21, 0x53, 0x7f, 0x96, 0x40, 0x40, 0x10}, /* MTX 5 6 7 8 */
766 {0xb1, 0x21, 0x57, 0x40, 0x0f, 0x00, 0x00, 0x10}, /* MTX9 MTXS */
767 {0xd1, 0x21, 0x59, 0xba, 0x9a, 0x22, 0xb9, 0x10}, /* reserved */
768 {0xd1, 0x21, 0x5d, 0x9b, 0x10, 0xf0, 0x05, 0x10}, /* reserved */
769 {0xa1, 0x21, 0x61, 0x60, 0x00, 0x00, 0x00, 0x10}, /* reserved */
770 {0xd1, 0x21, 0x62, 0x00, 0x00, 0x50, 0x30, 0x10},
771 /* LCC1 LCC2 LCC3 LCC4 */
772 {0xa1, 0x21, 0x66, 0x00, 0x00, 0x00, 0x00, 0x10}, /* LCC5 */
773 {0xd1, 0x21, 0x67, 0x80, 0x7a, 0x90, 0x80, 0x10}, /* MANU */
774 {0xa1, 0x21, 0x6b, 0x0a, 0x00, 0x00, 0x00, 0x10},
775 /* band gap reference [0:3] DBLV */
776 {0xd1, 0x21, 0x6c, 0x30, 0x48, 0x80, 0x74, 0x10}, /* gamma curve */
777 {0xd1, 0x21, 0x70, 0x64, 0x60, 0x5c, 0x58, 0x10}, /* gamma curve */
778 {0xd1, 0x21, 0x74, 0x54, 0x4c, 0x40, 0x38, 0x10}, /* gamma curve */
779 {0xd1, 0x21, 0x78, 0x34, 0x30, 0x2f, 0x2b, 0x10}, /* gamma curve */
780 {0xd1, 0x21, 0x7c, 0x03, 0x07, 0x17, 0x34, 0x10}, /* gamma curve */
781 {0xd1, 0x21, 0x80, 0x41, 0x4d, 0x58, 0x63, 0x10}, /* gamma curve */
782 {0xd1, 0x21, 0x84, 0x6e, 0x77, 0x87, 0x95, 0x10}, /* gamma curve */
783 {0xc1, 0x21, 0x88, 0xaf, 0xc7, 0xdf, 0x00, 0x10}, /* gamma curve */
784 {0xc1, 0x21, 0x8b, 0x99, 0x99, 0xcf, 0x00, 0x10}, /* reserved */
785 {0xb1, 0x21, 0x92, 0x00, 0x00, 0x00, 0x00, 0x10}, /* DM_LNL/H */
786 {0xb1, 0x21, 0xa1, 0x00, 0x00, 0x00, 0x00, 0x10},
787 /****** (some exchanges in the win trace) ******/
788 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10}, /* MVFP */
789 /* bits[3..0]reserved */
790 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10},
791 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
792 /* VREF vertical frame ctrl */
793 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
794 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10}, /* AECH 0x20 */
795 {0xa1, 0x21, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFL */
796 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFH */
797 {0xa1, 0x21, 0x00, 0x1f, 0x00, 0x00, 0x00, 0x10}, /* GAIN */
798 /* {0xb1, 0x21, 0x01, 0x78, 0x78, 0x00, 0x00, 0x10}, * BLUE */
799 /****** (some exchanges in the win trace) ******/
800 {0xa1, 0x21, 0x93, 0x00, 0x00, 0x00, 0x00, 0x10},/* dummy line hight */
801 {0xa1, 0x21, 0x92, 0x25, 0x00, 0x00, 0x00, 0x10}, /* dummy line low */
802 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCH */
803 {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCL */
804 /* {0xa1, 0x21, 0x02, 0x90, 0x00, 0x00, 0x00, 0x10}, * RED */
805 /****** (some exchanges in the win trace) ******/
806 /******!! startsensor KO if changed !!****/
807 {0xa1, 0x21, 0x93, 0x01, 0x00, 0x00, 0x00, 0x10},
808 {0xa1, 0x21, 0x92, 0xff, 0x00, 0x00, 0x00, 0x10},
809 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10},
810 {0xa1, 0x21, 0x2b, 0xc3, 0x00, 0x00, 0x00, 0x10},
814 static const u8 sp80708_sensor_init
[][8] = {
815 {0xa1, 0x18, 0x06, 0xf9, 0x00, 0x00, 0x00, 0x10},
816 {0xa1, 0x18, 0x09, 0x1f, 0x00, 0x00, 0x00, 0x10},
817 {0xa1, 0x18, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
818 {0xa1, 0x18, 0x0d, 0xc0, 0x00, 0x00, 0x00, 0x10},
819 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
820 {0xa1, 0x18, 0x0f, 0x0f, 0x00, 0x00, 0x00, 0x10},
821 {0xa1, 0x18, 0x10, 0x40, 0x00, 0x00, 0x00, 0x10},
822 {0xa1, 0x18, 0x11, 0x4e, 0x00, 0x00, 0x00, 0x10},
823 {0xa1, 0x18, 0x12, 0x53, 0x00, 0x00, 0x00, 0x10},
824 {0xa1, 0x18, 0x15, 0x80, 0x00, 0x00, 0x00, 0x10},
825 {0xa1, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x10},
826 {0xa1, 0x18, 0x19, 0x18, 0x00, 0x00, 0x00, 0x10},
827 {0xa1, 0x18, 0x1a, 0x10, 0x00, 0x00, 0x00, 0x10},
828 {0xa1, 0x18, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x10},
829 {0xa1, 0x18, 0x1c, 0x28, 0x00, 0x00, 0x00, 0x10},
830 {0xa1, 0x18, 0x1d, 0x02, 0x00, 0x00, 0x00, 0x10},
831 {0xa1, 0x18, 0x1e, 0x10, 0x00, 0x00, 0x00, 0x10},
832 {0xa1, 0x18, 0x26, 0x04, 0x00, 0x00, 0x00, 0x10},
833 {0xa1, 0x18, 0x27, 0x1e, 0x00, 0x00, 0x00, 0x10},
834 {0xa1, 0x18, 0x28, 0x5a, 0x00, 0x00, 0x00, 0x10},
835 {0xa1, 0x18, 0x29, 0x28, 0x00, 0x00, 0x00, 0x10},
836 {0xa1, 0x18, 0x2a, 0x78, 0x00, 0x00, 0x00, 0x10},
837 {0xa1, 0x18, 0x2b, 0x01, 0x00, 0x00, 0x00, 0x10},
838 {0xa1, 0x18, 0x2c, 0xf7, 0x00, 0x00, 0x00, 0x10},
839 {0xa1, 0x18, 0x2d, 0x2d, 0x00, 0x00, 0x00, 0x10},
840 {0xa1, 0x18, 0x2e, 0xd5, 0x00, 0x00, 0x00, 0x10},
841 {0xa1, 0x18, 0x39, 0x42, 0x00, 0x00, 0x00, 0x10},
842 {0xa1, 0x18, 0x3a, 0x67, 0x00, 0x00, 0x00, 0x10},
843 {0xa1, 0x18, 0x3b, 0x87, 0x00, 0x00, 0x00, 0x10},
844 {0xa1, 0x18, 0x3c, 0xa3, 0x00, 0x00, 0x00, 0x10},
845 {0xa1, 0x18, 0x3d, 0xb0, 0x00, 0x00, 0x00, 0x10},
846 {0xa1, 0x18, 0x3e, 0xbc, 0x00, 0x00, 0x00, 0x10},
847 {0xa1, 0x18, 0x3f, 0xc8, 0x00, 0x00, 0x00, 0x10},
848 {0xa1, 0x18, 0x40, 0xd4, 0x00, 0x00, 0x00, 0x10},
849 {0xa1, 0x18, 0x41, 0xdf, 0x00, 0x00, 0x00, 0x10},
850 {0xa1, 0x18, 0x42, 0xea, 0x00, 0x00, 0x00, 0x10},
851 {0xa1, 0x18, 0x43, 0xf5, 0x00, 0x00, 0x00, 0x10},
852 {0xa1, 0x18, 0x45, 0x80, 0x00, 0x00, 0x00, 0x10},
853 {0xa1, 0x18, 0x46, 0x60, 0x00, 0x00, 0x00, 0x10},
854 {0xa1, 0x18, 0x47, 0x50, 0x00, 0x00, 0x00, 0x10},
855 {0xa1, 0x18, 0x48, 0x30, 0x00, 0x00, 0x00, 0x10},
856 {0xa1, 0x18, 0x49, 0x01, 0x00, 0x00, 0x00, 0x10},
857 {0xa1, 0x18, 0x4d, 0xae, 0x00, 0x00, 0x00, 0x10},
858 {0xa1, 0x18, 0x4e, 0x03, 0x00, 0x00, 0x00, 0x10},
859 {0xa1, 0x18, 0x4f, 0x66, 0x00, 0x00, 0x00, 0x10},
860 {0xa1, 0x18, 0x50, 0x1c, 0x00, 0x00, 0x00, 0x10},
861 {0xa1, 0x18, 0x44, 0x10, 0x00, 0x00, 0x00, 0x10},
862 {0xa1, 0x18, 0x4a, 0x30, 0x00, 0x00, 0x00, 0x10},
863 {0xa1, 0x18, 0x51, 0x80, 0x00, 0x00, 0x00, 0x10},
864 {0xa1, 0x18, 0x52, 0x80, 0x00, 0x00, 0x00, 0x10},
865 {0xa1, 0x18, 0x53, 0x80, 0x00, 0x00, 0x00, 0x10},
866 {0xa1, 0x18, 0x54, 0x80, 0x00, 0x00, 0x00, 0x10},
867 {0xa1, 0x18, 0x55, 0x80, 0x00, 0x00, 0x00, 0x10},
868 {0xa1, 0x18, 0x56, 0x80, 0x00, 0x00, 0x00, 0x10},
869 {0xa1, 0x18, 0x57, 0xe0, 0x00, 0x00, 0x00, 0x10},
870 {0xa1, 0x18, 0x58, 0xc0, 0x00, 0x00, 0x00, 0x10},
871 {0xa1, 0x18, 0x59, 0xab, 0x00, 0x00, 0x00, 0x10},
872 {0xa1, 0x18, 0x5a, 0xa0, 0x00, 0x00, 0x00, 0x10},
873 {0xa1, 0x18, 0x5b, 0x99, 0x00, 0x00, 0x00, 0x10},
874 {0xa1, 0x18, 0x5c, 0x90, 0x00, 0x00, 0x00, 0x10},
875 {0xa1, 0x18, 0x5e, 0x24, 0x00, 0x00, 0x00, 0x10},
876 {0xa1, 0x18, 0x5f, 0x00, 0x00, 0x00, 0x00, 0x10},
877 {0xa1, 0x18, 0x60, 0x00, 0x00, 0x00, 0x00, 0x10},
878 {0xa1, 0x18, 0x61, 0x73, 0x00, 0x00, 0x00, 0x10},
879 {0xa1, 0x18, 0x63, 0x42, 0x00, 0x00, 0x00, 0x10},
880 {0xa1, 0x18, 0x64, 0x42, 0x00, 0x00, 0x00, 0x10},
881 {0xa1, 0x18, 0x65, 0x42, 0x00, 0x00, 0x00, 0x10},
882 {0xa1, 0x18, 0x66, 0x24, 0x00, 0x00, 0x00, 0x10},
883 {0xa1, 0x18, 0x67, 0x24, 0x00, 0x00, 0x00, 0x10},
884 {0xa1, 0x18, 0x68, 0x08, 0x00, 0x00, 0x00, 0x10},
885 {0xa1, 0x18, 0x2f, 0xc9, 0x00, 0x00, 0x00, 0x10},
887 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
888 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
889 {0xa1, 0x18, 0x03, 0x01, 0x00, 0x00, 0x00, 0x10},
890 {0xa1, 0x18, 0x04, 0xa4, 0x00, 0x00, 0x00, 0x10},
891 {0xa1, 0x18, 0x14, 0x3f, 0x00, 0x00, 0x00, 0x10},
892 {0xa1, 0x18, 0x5d, 0x80, 0x00, 0x00, 0x00, 0x10},
893 {0xb1, 0x18, 0x11, 0x40, 0x40, 0x00, 0x00, 0x10},
897 /* read <len> bytes to gspca_dev->usb_buf */
898 static void reg_r(struct gspca_dev
*gspca_dev
,
902 if (len
> USB_BUF_SZ
) {
903 err("reg_r: buffer overflow");
907 usb_control_msg(gspca_dev
->dev
,
908 usb_rcvctrlpipe(gspca_dev
->dev
, 0),
910 USB_DIR_IN
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
912 gspca_dev
->usb_buf
, len
,
914 PDEBUG(D_USBI
, "reg_r [%02x] -> %02x", value
, gspca_dev
->usb_buf
[0]);
917 static void reg_w1(struct gspca_dev
*gspca_dev
,
921 PDEBUG(D_USBO
, "reg_w1 [%04x] = %02x", value
, data
);
922 gspca_dev
->usb_buf
[0] = data
;
923 usb_control_msg(gspca_dev
->dev
,
924 usb_sndctrlpipe(gspca_dev
->dev
, 0),
926 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
929 gspca_dev
->usb_buf
, 1,
932 static void reg_w(struct gspca_dev
*gspca_dev
,
937 PDEBUG(D_USBO
, "reg_w [%04x] = %02x %02x ..",
938 value
, buffer
[0], buffer
[1]);
940 if (len
> USB_BUF_SZ
) {
941 err("reg_w: buffer overflow");
945 memcpy(gspca_dev
->usb_buf
, buffer
, len
);
946 usb_control_msg(gspca_dev
->dev
,
947 usb_sndctrlpipe(gspca_dev
->dev
, 0),
949 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
951 gspca_dev
->usb_buf
, len
,
955 /* I2C write 1 byte */
956 static void i2c_w1(struct gspca_dev
*gspca_dev
, u8 reg
, u8 val
)
958 struct sd
*sd
= (struct sd
*) gspca_dev
;
960 PDEBUG(D_USBO
, "i2c_w2 [%02x] = %02x", reg
, val
);
961 gspca_dev
->usb_buf
[0] = 0x81 | (2 << 4); /* = a1 */
962 gspca_dev
->usb_buf
[1] = sd
->i2c_base
;
963 gspca_dev
->usb_buf
[2] = reg
;
964 gspca_dev
->usb_buf
[3] = val
;
965 gspca_dev
->usb_buf
[4] = 0;
966 gspca_dev
->usb_buf
[5] = 0;
967 gspca_dev
->usb_buf
[6] = 0;
968 gspca_dev
->usb_buf
[7] = 0x10;
969 usb_control_msg(gspca_dev
->dev
,
970 usb_sndctrlpipe(gspca_dev
->dev
, 0),
972 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
973 0x08, /* value = i2c */
975 gspca_dev
->usb_buf
, 8,
979 /* I2C write 8 bytes */
980 static void i2c_w8(struct gspca_dev
*gspca_dev
,
983 memcpy(gspca_dev
->usb_buf
, buffer
, 8);
984 usb_control_msg(gspca_dev
->dev
,
985 usb_sndctrlpipe(gspca_dev
->dev
, 0),
987 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
988 0x08, 0, /* value, index */
989 gspca_dev
->usb_buf
, 8,
994 /* read 5 bytes in gspca_dev->usb_buf */
995 static void i2c_r5(struct gspca_dev
*gspca_dev
, u8 reg
)
997 struct sd
*sd
= (struct sd
*) gspca_dev
;
1000 mode
[0] = 0x81 | 0x10;
1001 mode
[1] = sd
->i2c_base
;
1008 i2c_w8(gspca_dev
, mode
);
1010 mode
[0] = 0x81 | (5 << 4) | 0x02;
1012 i2c_w8(gspca_dev
, mode
);
1014 reg_r(gspca_dev
, 0x0a, 5);
1017 static int hv7131r_probe(struct gspca_dev
*gspca_dev
)
1019 i2c_w1(gspca_dev
, 0x02, 0); /* sensor wakeup */
1021 reg_w1(gspca_dev
, 0x02, 0x66); /* Gpio on */
1023 i2c_r5(gspca_dev
, 0); /* read sensor id */
1024 if (gspca_dev
->usb_buf
[0] == 0x02
1025 && gspca_dev
->usb_buf
[1] == 0x09
1026 && gspca_dev
->usb_buf
[2] == 0x01
1027 && gspca_dev
->usb_buf
[3] == 0x00
1028 && gspca_dev
->usb_buf
[4] == 0x00) {
1029 PDEBUG(D_PROBE
, "Find Sensor sn9c102P HV7131R");
1032 PDEBUG(D_PROBE
, "Find Sensor 0x%02x 0x%02x 0x%02x",
1033 gspca_dev
->usb_buf
[0], gspca_dev
->usb_buf
[1],
1034 gspca_dev
->usb_buf
[2]);
1035 PDEBUG(D_PROBE
, "Sensor sn9c102P Not found");
1039 static void mi0360_probe(struct gspca_dev
*gspca_dev
)
1041 struct sd
*sd
= (struct sd
*) gspca_dev
;
1044 static const u8 probe_tb
[][4][8] = {
1046 {0xb0, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
1047 {0x90, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1048 {0xa2, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1049 {0xb0, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10}
1052 {0xb0, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10},
1053 {0x90, 0x5c, 0x36, 0x00, 0x00, 0x00, 0x00, 0x10},
1054 {0xa2, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1059 for (i
= 0; i
< ARRAY_SIZE(probe_tb
); i
++) {
1060 reg_w1(gspca_dev
, 0x17, 0x62);
1061 reg_w1(gspca_dev
, 0x01, 0x08);
1062 for (j
= 0; j
< 3; j
++)
1063 i2c_w8(gspca_dev
, probe_tb
[i
][j
]);
1065 reg_r(gspca_dev
, 0x0a, 5);
1066 val
= (gspca_dev
->usb_buf
[3] << 8) | gspca_dev
->usb_buf
[4];
1067 if (probe_tb
[i
][3][0] != 0)
1068 i2c_w8(gspca_dev
, probe_tb
[i
][3]);
1069 reg_w1(gspca_dev
, 0x01, 0x29);
1070 reg_w1(gspca_dev
, 0x17, 0x42);
1076 PDEBUG(D_PROBE
, "Sensor mt9v111");
1077 sd
->sensor
= SENSOR_MT9V111
;
1078 sd
->i2c_base
= 0x5c;
1081 PDEBUG(D_PROBE
, "Sensor mi0360");
1084 PDEBUG(D_PROBE
, "Unknown sensor %04x - forced to mi0360", val
);
1089 static int configure_gpio(struct gspca_dev
*gspca_dev
,
1092 struct sd
*sd
= (struct sd
*) gspca_dev
;
1094 static const u8 reg9a_def
[] =
1095 {0x00, 0x40, 0x20, 0x00, 0x00, 0x00};
1096 static const u8 reg9a_spec
[] =
1097 {0x00, 0x40, 0x38, 0x30, 0x00, 0x20};
1098 static const u8 regd4
[] = {0x60, 0x00, 0x00};
1100 reg_w1(gspca_dev
, 0xf1, 0x00);
1101 reg_w1(gspca_dev
, 0x01, sn9c1xx
[1]);
1103 /* configure gpio */
1104 reg_w(gspca_dev
, 0x01, &sn9c1xx
[1], 2);
1105 reg_w(gspca_dev
, 0x08, &sn9c1xx
[8], 2);
1106 reg_w(gspca_dev
, 0x17, &sn9c1xx
[0x17], 5); /* jfm len was 3 */
1107 switch (sd
->sensor
) {
1109 case SENSOR_SP80708
:
1116 reg_w(gspca_dev
, 0x9a, reg9a
, 6);
1118 reg_w(gspca_dev
, 0xd4, regd4
, sizeof regd4
); /*fixme:jfm was 60 only*/
1120 reg_w(gspca_dev
, 0x03, &sn9c1xx
[3], 0x0f);
1122 switch (sd
->sensor
) {
1123 case SENSOR_MT9V111
:
1124 reg_w1(gspca_dev
, 0x01, 0x61);
1125 reg_w1(gspca_dev
, 0x17, 0x61);
1126 reg_w1(gspca_dev
, 0x01, 0x60);
1127 reg_w1(gspca_dev
, 0x01, 0x40);
1130 reg_w1(gspca_dev
, 0x02, 0x71);
1131 reg_w1(gspca_dev
, 0x01, 0x42);
1132 reg_w1(gspca_dev
, 0x17, 0x64);
1133 reg_w1(gspca_dev
, 0x01, 0x42);
1136 reg_w1(gspca_dev
, 0x01, 0x61);
1137 reg_w1(gspca_dev
, 0x17, 0xe2);
1138 reg_w1(gspca_dev
, 0x01, 0x60);
1139 reg_w1(gspca_dev
, 0x01, 0x40);
1142 reg_w1(gspca_dev
, 0x01, 0x63);
1143 reg_w1(gspca_dev
, 0x17, 0x20);
1144 reg_w1(gspca_dev
, 0x01, 0x62);
1145 reg_w1(gspca_dev
, 0x01, 0x42);
1148 reg_w1(gspca_dev
, 0x01, 0x61);
1149 reg_w1(gspca_dev
, 0x17, 0x20);
1150 reg_w1(gspca_dev
, 0x01, 0x60);
1151 reg_w1(gspca_dev
, 0x01, 0x40);
1153 case SENSOR_SP80708
:
1154 reg_w1(gspca_dev
, 0x01, 0x63);
1155 reg_w1(gspca_dev
, 0x17, 0x20);
1156 reg_w1(gspca_dev
, 0x01, 0x62);
1157 reg_w1(gspca_dev
, 0x01, 0x42);
1159 reg_w1(gspca_dev
, 0x02, 0x62);
1161 /* case SENSOR_HV7131R: */
1162 /* case SENSOR_MI0360: */
1163 /* case SENSOR_MO4000: */
1165 reg_w1(gspca_dev
, 0x01, 0x43);
1166 reg_w1(gspca_dev
, 0x17, 0x61);
1167 reg_w1(gspca_dev
, 0x01, 0x42);
1168 if (sd
->sensor
== SENSOR_HV7131R
) {
1169 if (hv7131r_probe(gspca_dev
) < 0)
1177 static void hv7131R_InitSensor(struct gspca_dev
*gspca_dev
)
1180 static const u8 SetSensorClk
[] = /* 0x08 Mclk */
1181 { 0xa1, 0x11, 0x01, 0x18, 0x00, 0x00, 0x00, 0x10 };
1183 while (hv7131r_sensor_init
[i
][0]) {
1184 i2c_w8(gspca_dev
, hv7131r_sensor_init
[i
]);
1187 i2c_w8(gspca_dev
, SetSensorClk
);
1190 static void mi0360_InitSensor(struct gspca_dev
*gspca_dev
)
1194 while (mi0360_sensor_init
[i
][0]) {
1195 i2c_w8(gspca_dev
, mi0360_sensor_init
[i
]);
1200 static void mo4000_InitSensor(struct gspca_dev
*gspca_dev
)
1204 while (mo4000_sensor_init
[i
][0]) {
1205 i2c_w8(gspca_dev
, mo4000_sensor_init
[i
]);
1210 static void mt9v111_InitSensor(struct gspca_dev
*gspca_dev
)
1214 i2c_w8(gspca_dev
, mt9v111_sensor_init
[i
]);
1217 while (mt9v111_sensor_init
[i
][0]) {
1218 i2c_w8(gspca_dev
, mt9v111_sensor_init
[i
]);
1223 static void om6802_InitSensor(struct gspca_dev
*gspca_dev
)
1227 while (om6802_sensor_init
[i
][0]) {
1228 i2c_w8(gspca_dev
, om6802_sensor_init
[i
]);
1233 static void ov7630_InitSensor(struct gspca_dev
*gspca_dev
)
1237 i2c_w8(gspca_dev
, ov7630_sensor_init
[i
]); /* 76 01 */
1239 i2c_w8(gspca_dev
, ov7630_sensor_init
[i
]); /* 12 c8 (RGB+SRST) */
1242 i2c_w8(gspca_dev
, ov7630_sensor_init
[i
]); /* 12 48 */
1244 i2c_w8(gspca_dev
, ov7630_sensor_init
[i
]); /* 12 c8 */
1247 i2c_w8(gspca_dev
, ov7630_sensor_init
[i
]); /* 12 48 */
1249 /*jfm:win i2c_r from 00 to 80*/
1251 while (ov7630_sensor_init
[i
][0]) {
1252 i2c_w8(gspca_dev
, ov7630_sensor_init
[i
]);
1257 static void ov7648_InitSensor(struct gspca_dev
*gspca_dev
)
1261 i2c_w8(gspca_dev
, ov7648_sensor_init
[i
]);
1263 /* win: dble reset */
1264 i2c_w8(gspca_dev
, ov7648_sensor_init
[i
]); /* reset */
1267 /* win: i2c reg read 00..7f */
1268 while (ov7648_sensor_init
[i
][0]) {
1269 i2c_w8(gspca_dev
, ov7648_sensor_init
[i
]);
1274 static void ov7660_InitSensor(struct gspca_dev
*gspca_dev
)
1278 i2c_w8(gspca_dev
, ov7660_sensor_init
[i
]); /* reset SCCB */
1281 while (ov7660_sensor_init
[i
][0]) {
1282 i2c_w8(gspca_dev
, ov7660_sensor_init
[i
]);
1287 static void sp80708_InitSensor(struct gspca_dev
*gspca_dev
)
1291 i2c_w8(gspca_dev
, sp80708_sensor_init
[i
]); /* reset SCCB */
1294 while (sp80708_sensor_init
[i
][0]) {
1295 i2c_w8(gspca_dev
, sp80708_sensor_init
[i
]);
1300 /* this function is called at probe time */
1301 static int sd_config(struct gspca_dev
*gspca_dev
,
1302 const struct usb_device_id
*id
)
1304 struct sd
*sd
= (struct sd
*) gspca_dev
;
1307 cam
= &gspca_dev
->cam
;
1308 cam
->cam_mode
= vga_mode
;
1309 cam
->nmodes
= ARRAY_SIZE(vga_mode
);
1310 cam
->npkt
= 24; /* 24 packets per ISOC message */
1312 sd
->bridge
= id
->driver_info
>> 16;
1313 sd
->sensor
= id
->driver_info
>> 8;
1314 sd
->i2c_base
= id
->driver_info
;
1316 sd
->brightness
= BRIGHTNESS_DEF
;
1317 sd
->contrast
= CONTRAST_DEF
;
1318 sd
->colors
= COLOR_DEF
;
1319 sd
->blue
= BLUE_BALANCE_DEF
;
1320 sd
->red
= RED_BALANCE_DEF
;
1321 sd
->gamma
= GAMMA_DEF
;
1322 sd
->autogain
= AUTOGAIN_DEF
;
1324 if (sd
->sensor
!= SENSOR_OV7630
)
1328 sd
->infrared
= INFRARED_DEF
;
1329 sd
->freq
= FREQ_DEF
;
1330 sd
->quality
= QUALITY_DEF
;
1333 gspca_dev
->ctrl_dis
= ctrl_dis
[sd
->sensor
];
1337 /* this function is called at probe and resume time */
1338 static int sd_init(struct gspca_dev
*gspca_dev
)
1340 struct sd
*sd
= (struct sd
*) gspca_dev
;
1341 u8 regGpio
[] = { 0x29, 0x74 };
1344 /* setup a selector by bridge */
1345 reg_w1(gspca_dev
, 0xf1, 0x01);
1346 reg_r(gspca_dev
, 0x00, 1);
1347 reg_w1(gspca_dev
, 0xf1, gspca_dev
->usb_buf
[0]);
1348 reg_r(gspca_dev
, 0x00, 1); /* get sonix chip id */
1349 regF1
= gspca_dev
->usb_buf
[0];
1350 PDEBUG(D_PROBE
, "Sonix chip id: %02x", regF1
);
1351 switch (sd
->bridge
) {
1352 case BRIDGE_SN9C102P
:
1355 reg_w1(gspca_dev
, 0x02, regGpio
[1]);
1357 case BRIDGE_SN9C105
:
1360 if (sd
->sensor
== SENSOR_MI0360
)
1361 mi0360_probe(gspca_dev
);
1362 reg_w(gspca_dev
, 0x01, regGpio
, 2);
1364 case BRIDGE_SN9C120
:
1367 if (sd
->sensor
== SENSOR_MI0360
)
1368 mi0360_probe(gspca_dev
);
1370 reg_w(gspca_dev
, 0x01, regGpio
, 2);
1373 /* case BRIDGE_SN9C110: */
1374 /* case BRIDGE_SN9C325: */
1377 reg_w1(gspca_dev
, 0x02, 0x62);
1381 reg_w1(gspca_dev
, 0xf1, 0x01);
1386 static u32
setexposure(struct gspca_dev
*gspca_dev
,
1389 struct sd
*sd
= (struct sd
*) gspca_dev
;
1391 switch (sd
->sensor
) {
1392 case SENSOR_HV7131R
: {
1394 { 0xc1, 0x11, 0x25, 0x07, 0x27, 0xc0, 0x00, 0x16 };
1396 Expodoit
[3] = expo
>> 16;
1397 Expodoit
[4] = expo
>> 8;
1399 i2c_w8(gspca_dev
, Expodoit
);
1402 case SENSOR_MI0360
: {
1403 u8 expoMi
[] = /* exposure 0x0635 -> 4 fp/s 0x10 */
1404 { 0xb1, 0x5d, 0x09, 0x06, 0x35, 0x00, 0x00, 0x16 };
1405 static const u8 doit
[] = /* update sensor */
1406 { 0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10 };
1407 static const u8 sensorgo
[] = /* sensor on */
1408 { 0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10 };
1412 else if (expo
< 0x0001)
1414 expoMi
[3] = expo
>> 8;
1416 i2c_w8(gspca_dev
, expoMi
);
1417 i2c_w8(gspca_dev
, doit
);
1418 i2c_w8(gspca_dev
, sensorgo
);
1421 case SENSOR_MO4000
: {
1423 { 0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10 };
1425 { 0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10 };
1426 static const u8 gainMo
[] =
1427 { 0xa1, 0x21, 0x00, 0x10, 0x00, 0x00, 0x00, 0x1d };
1431 else if (expo
< 0x0001)
1433 expoMof
[3] = (expo
& 0x03fc) >> 2;
1434 i2c_w8(gspca_dev
, expoMof
);
1435 expoMo10
[3] = ((expo
& 0x1c00) >> 10)
1436 | ((expo
& 0x0003) << 4);
1437 i2c_w8(gspca_dev
, expoMo10
);
1438 i2c_w8(gspca_dev
, gainMo
);
1439 PDEBUG(D_FRAM
, "set exposure %d",
1440 ((expoMo10
[3] & 0x07) << 10)
1442 | ((expoMo10
[3] & 0x30) >> 4));
1445 case SENSOR_MT9V111
: {
1447 { 0xb1, 0x5c, 0x09, 0x00, 0x00, 0x00, 0x00, 0x10 };
1451 else if (expo
< 0x0040)
1453 expo_c1
[3] = expo
>> 8;
1455 i2c_w8(gspca_dev
, expo_c1
);
1458 case SENSOR_OM6802
: {
1460 { 0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10 };
1466 gainOm
[3] = expo
>> 2;
1467 i2c_w8(gspca_dev
, gainOm
);
1468 reg_w1(gspca_dev
, 0x96, (expo
>> 5) & 0x1f);
1469 PDEBUG(D_FRAM
, "set exposure %d", gainOm
[3]);
1476 static void setbrightness(struct gspca_dev
*gspca_dev
)
1478 struct sd
*sd
= (struct sd
*) gspca_dev
;
1482 k2
= ((int) sd
->brightness
- 0x8000) >> 10;
1483 switch (sd
->sensor
) {
1484 case SENSOR_HV7131R
:
1485 expo
= sd
->brightness
<< 4;
1486 if (expo
> 0x002dc6c0)
1488 else if (expo
< 0x02a0)
1490 sd
->exposure
= setexposure(gspca_dev
, expo
);
1494 expo
= sd
->brightness
>> 4;
1495 sd
->exposure
= setexposure(gspca_dev
, expo
);
1497 case SENSOR_MT9V111
:
1498 expo
= sd
->brightness
>> 8;
1499 sd
->exposure
= setexposure(gspca_dev
, expo
);
1502 expo
= sd
->brightness
>> 6;
1503 sd
->exposure
= setexposure(gspca_dev
, expo
);
1504 k2
= sd
->brightness
>> 11;
1508 if (sd
->sensor
!= SENSOR_MT9V111
)
1509 reg_w1(gspca_dev
, 0x96, k2
); /* color matrix Y offset */
1512 static void setcontrast(struct gspca_dev
*gspca_dev
)
1514 struct sd
*sd
= (struct sd
*) gspca_dev
;
1518 k2
= sd
->contrast
* 0x30 / (CONTRAST_MAX
+ 1) + 0x10; /* 10..40 */
1519 contrast
[0] = (k2
+ 1) / 2; /* red */
1521 contrast
[2] = k2
; /* green */
1523 contrast
[4] = (k2
+ 1) / 5; /* blue */
1525 reg_w(gspca_dev
, 0x84, contrast
, sizeof contrast
);
1528 static void setcolors(struct gspca_dev
*gspca_dev
)
1530 struct sd
*sd
= (struct sd
*) gspca_dev
;
1532 u8 reg8a
[12]; /* U & V gains */
1533 static s16 uv
[6] = { /* same as reg84 in signed decimal */
1534 -24, -38, 64, /* UR UG UB */
1535 62, -51, -9 /* VR VG VB */
1537 for (i
= 0; i
< 6; i
++) {
1538 v
= uv
[i
] * sd
->colors
/ COLOR_DEF
;
1540 reg8a
[i
* 2 + 1] = (v
>> 8) & 0x0f;
1542 reg_w(gspca_dev
, 0x8a, reg8a
, sizeof reg8a
);
1545 static void setredblue(struct gspca_dev
*gspca_dev
)
1547 struct sd
*sd
= (struct sd
*) gspca_dev
;
1549 reg_w1(gspca_dev
, 0x05, sd
->red
);
1550 /* reg_w1(gspca_dev, 0x07, 32); */
1551 reg_w1(gspca_dev
, 0x06, sd
->blue
);
1554 static void setgamma(struct gspca_dev
*gspca_dev
)
1556 struct sd
*sd
= (struct sd
*) gspca_dev
;
1559 const u8
*gamma_base
;
1560 static const u8 delta
[17] = {
1561 0x00, 0x14, 0x1c, 0x1c, 0x1c, 0x1c, 0x1b, 0x1a,
1562 0x18, 0x13, 0x10, 0x0e, 0x08, 0x07, 0x04, 0x02, 0x00
1565 switch (sd
->sensor
) {
1566 case SENSOR_HV7131R
:
1567 case SENSOR_MT9V111
:
1568 gamma_base
= gamma_spec_1
;
1570 case SENSOR_SP80708
:
1571 gamma_base
= gamma_spec_2
;
1574 gamma_base
= gamma_def
;
1578 for (i
= 0; i
< sizeof gamma
; i
++)
1579 gamma
[i
] = gamma_base
[i
]
1580 + delta
[i
] * (sd
->gamma
- GAMMA_DEF
) / 32;
1581 reg_w(gspca_dev
, 0x20, gamma
, sizeof gamma
);
1584 static void setautogain(struct gspca_dev
*gspca_dev
)
1586 struct sd
*sd
= (struct sd
*) gspca_dev
;
1588 if (gspca_dev
->ctrl_dis
& (1 << AUTOGAIN_IDX
))
1590 switch (sd
->sensor
) {
1592 case SENSOR_OV7648
: {
1595 if (sd
->sensor
== SENSOR_OV7630
)
1601 i2c_w1(&sd
->gspca_dev
, 0x13, comb
);
1606 sd
->ag_cnt
= AG_CNT_START
;
1611 /* ov7630/ov7648 only */
1612 static void setvflip(struct sd
*sd
)
1616 if (sd
->sensor
== SENSOR_OV7630
)
1622 i2c_w1(&sd
->gspca_dev
, 0x75, comn
);
1625 static void setinfrared(struct sd
*sd
)
1627 /*fixme: different sequence for StarCam Clip and StarCam 370i */
1629 i2c_w1(&sd
->gspca_dev
, 0x02, /* gpio */
1630 sd
->infrared
? 0x66 : 0x64);
1633 static void setfreq(struct gspca_dev
*gspca_dev
)
1635 struct sd
*sd
= (struct sd
*) gspca_dev
;
1637 if (sd
->sensor
== SENSOR_OV7660
) {
1639 case 0: /* Banding filter disabled */
1640 i2c_w1(gspca_dev
, 0x13, 0xdf);
1643 i2c_w1(gspca_dev
, 0x13, 0xff);
1644 i2c_w1(gspca_dev
, 0x3b, 0x0a);
1647 i2c_w1(gspca_dev
, 0x13, 0xff);
1648 i2c_w1(gspca_dev
, 0x3b, 0x02);
1652 u8 reg2a
= 0, reg2b
= 0, reg2d
= 0;
1654 /* Get reg2a / reg2d base values */
1655 switch (sd
->sensor
) {
1667 case 0: /* Banding filter disabled */
1669 case 1: /* 50 hz (filter on and framerate adj) */
1674 case 2: /* 60 hz (filter on, no framerate adj) */
1679 i2c_w1(gspca_dev
, 0x2a, reg2a
);
1680 i2c_w1(gspca_dev
, 0x2b, reg2b
);
1681 i2c_w1(gspca_dev
, 0x2d, reg2d
);
1685 static void setjpegqual(struct gspca_dev
*gspca_dev
)
1687 struct sd
*sd
= (struct sd
*) gspca_dev
;
1690 if (sd
->jpegqual
< 50)
1691 sc
= 5000 / sd
->jpegqual
;
1693 sc
= 200 - sd
->jpegqual
* 2;
1695 #error "No room enough in usb_buf for quantization table"
1697 for (i
= 0; i
< 64; i
++)
1698 gspca_dev
->usb_buf
[i
] =
1699 (jpeg_head
[JPEG_QT0_OFFSET
+ i
] * sc
+ 50) / 100;
1700 usb_control_msg(gspca_dev
->dev
,
1701 usb_sndctrlpipe(gspca_dev
->dev
, 0),
1703 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1705 gspca_dev
->usb_buf
, 64,
1707 for (i
= 0; i
< 64; i
++)
1708 gspca_dev
->usb_buf
[i
] =
1709 (jpeg_head
[JPEG_QT1_OFFSET
+ i
] * sc
+ 50) / 100;
1710 usb_control_msg(gspca_dev
->dev
,
1711 usb_sndctrlpipe(gspca_dev
->dev
, 0),
1713 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1715 gspca_dev
->usb_buf
, 64,
1719 reg_w1(gspca_dev
, 0x18, sd
->reg18
);
1722 /* -- start the camera -- */
1723 static int sd_start(struct gspca_dev
*gspca_dev
)
1725 struct sd
*sd
= (struct sd
*) gspca_dev
;
1730 static const u8 C0
[] = { 0x2d, 0x2d, 0x3a, 0x05, 0x04, 0x3f };
1731 static const u8 CA
[] = { 0x28, 0xd8, 0x14, 0xec };
1732 static const u8 CE
[] = { 0x32, 0xdd, 0x2d, 0xdd }; /* MI0360 */
1733 static const u8 CE_ov76xx
[] =
1734 { 0x32, 0xdd, 0x32, 0xdd };
1736 /* create the JPEG header */
1737 sd
->jpeg_hdr
= kmalloc(JPEG_HDR_SZ
, GFP_KERNEL
);
1738 jpeg_define(sd
->jpeg_hdr
, gspca_dev
->height
, gspca_dev
->width
,
1739 0x21); /* JPEG 422 */
1740 jpeg_set_qual(sd
->jpeg_hdr
, sd
->quality
);
1742 sn9c1xx
= sn_tb
[(int) sd
->sensor
];
1743 configure_gpio(gspca_dev
, sn9c1xx
);
1745 reg_w1(gspca_dev
, 0x15, sn9c1xx
[0x15]);
1746 reg_w1(gspca_dev
, 0x16, sn9c1xx
[0x16]);
1747 reg_w1(gspca_dev
, 0x12, sn9c1xx
[0x12]);
1748 reg_w1(gspca_dev
, 0x13, sn9c1xx
[0x13]);
1749 reg_w1(gspca_dev
, 0x18, sn9c1xx
[0x18]);
1750 reg_w1(gspca_dev
, 0xd2, 0x6a); /* DC29 */
1751 reg_w1(gspca_dev
, 0xd3, 0x50);
1752 reg_w1(gspca_dev
, 0xc6, 0x00);
1753 reg_w1(gspca_dev
, 0xc7, 0x00);
1754 reg_w1(gspca_dev
, 0xc8, 0x50);
1755 reg_w1(gspca_dev
, 0xc9, 0x3c);
1756 reg_w1(gspca_dev
, 0x18, sn9c1xx
[0x18]);
1757 switch (sd
->sensor
) {
1758 case SENSOR_MT9V111
:
1774 reg_w1(gspca_dev
, 0x17, reg17
);
1775 /* set reg1 was here */
1776 reg_w1(gspca_dev
, 0x05, sn9c1xx
[5]); /* red */
1777 reg_w1(gspca_dev
, 0x07, sn9c1xx
[7]); /* green */
1778 reg_w1(gspca_dev
, 0x06, sn9c1xx
[6]); /* blue */
1779 reg_w1(gspca_dev
, 0x14, sn9c1xx
[0x14]);
1781 setgamma(gspca_dev
);
1783 for (i
= 0; i
< 8; i
++)
1784 reg_w(gspca_dev
, 0x84, reg84
, sizeof reg84
);
1785 switch (sd
->sensor
) {
1786 case SENSOR_MT9V111
:
1787 reg_w1(gspca_dev
, 0x9a, 0x07);
1788 reg_w1(gspca_dev
, 0x99, 0x59);
1791 reg_w1(gspca_dev
, 0x9a, 0x0a);
1792 reg_w1(gspca_dev
, 0x99, 0x60);
1795 reg_w1(gspca_dev
, 0x9a, 0x05);
1796 if (sd
->bridge
== BRIDGE_SN9C105
)
1797 reg_w1(gspca_dev
, 0x99, 0xff);
1799 reg_w1(gspca_dev
, 0x99, 0x5b);
1801 case SENSOR_SP80708
:
1802 reg_w1(gspca_dev
, 0x9a, 0x05);
1803 reg_w1(gspca_dev
, 0x99, 0x59);
1806 reg_w1(gspca_dev
, 0x9a, 0x08);
1807 reg_w1(gspca_dev
, 0x99, 0x59);
1811 mode
= gspca_dev
->cam
.cam_mode
[(int) gspca_dev
->curr_mode
].priv
;
1813 reg1
= 0x46; /* 320x240: clk 48Mhz, video trf enable */
1815 reg1
= 0x06; /* 640x480: clk 24Mhz, video trf enable */
1816 reg17
= 0x61; /* 0x:20: enable sensor clock */
1817 switch (sd
->sensor
) {
1818 case SENSOR_HV7131R
:
1819 hv7131R_InitSensor(gspca_dev
);
1822 mi0360_InitSensor(gspca_dev
);
1825 mo4000_InitSensor(gspca_dev
);
1827 /* reg1 = 0x46; * 320 clk 48Mhz 60fp/s */
1828 reg1
= 0x06; /* clk 24Mz */
1830 reg17
= 0x22; /* 640 MCKSIZE */
1831 /* reg1 = 0x06; * 640 clk 24Mz (done) */
1834 case SENSOR_MT9V111
:
1835 mt9v111_InitSensor(gspca_dev
);
1837 reg1
= 0x04; /* 320 clk 48Mhz */
1839 /* reg1 = 0x06; * 640 clk 24Mz (done) */
1844 om6802_InitSensor(gspca_dev
);
1845 reg17
= 0x64; /* 640 MCKSIZE */
1848 ov7630_InitSensor(gspca_dev
);
1854 ov7648_InitSensor(gspca_dev
);
1856 /* reg1 = 0x42; * 42 - 46? */
1859 ov7660_InitSensor(gspca_dev
);
1860 if (sd
->bridge
== BRIDGE_SN9C120
) {
1861 if (mode
) { /* 320x240 - 160x120 */
1863 reg1
= 0x44; /* 48 Mhz, video trf eneble */
1867 reg1
= 0x06; /* 24 Mhz, video trf eneble
1868 * inverse power down */
1872 /* case SENSOR_SP80708: */
1873 sp80708_InitSensor(gspca_dev
);
1875 /*?? reg1 = 0x04; * 320 clk 48Mhz */
1877 reg1
= 0x46; /* 640 clk 48Mz */
1882 reg_w(gspca_dev
, 0xc0, C0
, 6);
1883 reg_w(gspca_dev
, 0xca, CA
, 4);
1884 switch (sd
->sensor
) {
1888 reg_w(gspca_dev
, 0xce, CE_ov76xx
, 4);
1891 reg_w(gspca_dev
, 0xce, CE
, 4);
1892 /* ?? {0x1e, 0xdd, 0x2d, 0xe7} */
1896 /* here change size mode 0 -> VGA; 1 -> CIF */
1897 sd
->reg18
= sn9c1xx
[0x18] | (mode
<< 4) | 0x40;
1898 reg_w1(gspca_dev
, 0x18, sd
->reg18
);
1899 setjpegqual(gspca_dev
);
1901 reg_w1(gspca_dev
, 0x17, reg17
);
1902 reg_w1(gspca_dev
, 0x01, reg1
);
1903 switch (sd
->sensor
) {
1908 setbrightness(gspca_dev
);
1909 setcontrast(gspca_dev
);
1910 setautogain(gspca_dev
);
1915 static void sd_stopN(struct gspca_dev
*gspca_dev
)
1917 struct sd
*sd
= (struct sd
*) gspca_dev
;
1918 static const u8 stophv7131
[] =
1919 { 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10 };
1920 static const u8 stopmi0360
[] =
1921 { 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10 };
1922 static const u8 stopov7648
[] =
1923 { 0xa1, 0x21, 0x76, 0x20, 0x00, 0x00, 0x00, 0x10 };
1928 switch (sd
->sensor
) {
1929 case SENSOR_HV7131R
:
1930 i2c_w8(gspca_dev
, stophv7131
);
1934 i2c_w8(gspca_dev
, stopmi0360
);
1938 i2c_w8(gspca_dev
, stopov7648
);
1940 case SENSOR_MT9V111
:
1945 /* case SENSOR_MO4000: */
1946 /* case SENSOR_OV7660: */
1949 sn9c1xx
= sn_tb
[(int) sd
->sensor
];
1950 reg_w1(gspca_dev
, 0x01, sn9c1xx
[1]);
1951 reg_w1(gspca_dev
, 0x17, sn9c1xx
[0x17]);
1952 reg_w1(gspca_dev
, 0x01, sn9c1xx
[1]);
1953 reg_w1(gspca_dev
, 0x01, data
);
1954 reg_w1(gspca_dev
, 0xf1, 0x00);
1957 static void sd_stop0(struct gspca_dev
*gspca_dev
)
1959 struct sd
*sd
= (struct sd
*) gspca_dev
;
1961 kfree(sd
->jpeg_hdr
);
1964 static void do_autogain(struct gspca_dev
*gspca_dev
)
1966 struct sd
*sd
= (struct sd
*) gspca_dev
;
1972 /* Thanks S., without your advice, autobright should not work :) */
1975 if (--sd
->ag_cnt
>= 0)
1977 sd
->ag_cnt
= AG_CNT_START
;
1979 delta
= atomic_read(&sd
->avg_lum
);
1980 PDEBUG(D_FRAM
, "mean lum %d", delta
);
1981 if (delta
< luma_mean
- luma_delta
||
1982 delta
> luma_mean
+ luma_delta
) {
1983 switch (sd
->sensor
) {
1984 case SENSOR_HV7131R
:
1985 expotimes
= sd
->exposure
>> 8;
1986 expotimes
+= (luma_mean
- delta
) >> 4;
1989 sd
->exposure
= setexposure(gspca_dev
,
1990 (unsigned int) (expotimes
<< 8));
1993 /* case SENSOR_MO4000: */
1994 /* case SENSOR_MI0360: */
1995 /* case SENSOR_MT9V111: */
1996 /* case SENSOR_OM6802: */
1997 expotimes
= sd
->exposure
;
1998 expotimes
+= (luma_mean
- delta
) >> 6;
2001 sd
->exposure
= setexposure(gspca_dev
,
2002 (unsigned int) expotimes
);
2003 setredblue(gspca_dev
);
2009 /* scan the URB packets */
2010 /* This function is run at interrupt level. */
2011 static void sd_pkt_scan(struct gspca_dev
*gspca_dev
,
2012 struct gspca_frame
*frame
, /* target */
2013 u8
*data
, /* isoc packet */
2014 int len
) /* iso packet length */
2016 struct sd
*sd
= (struct sd
*) gspca_dev
;
2020 if (sof
>= 0 && data
[sof
] == 0xff && data
[sof
+ 1] == 0xd9) {
2023 gspca_frame_add(gspca_dev
, LAST_PACKET
,
2024 frame
, data
, sof
+ 2);
2031 avg_lum
= ((data
[sof
+ 29] << 8) | data
[sof
+ 30]) >> 6;
2033 avg_lum
+= ((data
[sof
+ 33] << 8) | data
[sof
+ 34]) >> 6;
2035 avg_lum
+= ((data
[sof
+ 25] << 8) | data
[sof
+ 26]) >> 6;
2037 avg_lum
+= ((data
[sof
+ 37] << 8) | data
[sof
+ 38]) >> 6;
2039 avg_lum
+= ((data
[sof
+ 31] << 8) | data
[sof
+ 32]) >> 4;
2041 atomic_set(&sd
->avg_lum
, avg_lum
);
2044 if (gspca_dev
->last_packet_type
== LAST_PACKET
) {
2046 /* put the JPEG 422 header */
2047 gspca_frame_add(gspca_dev
, FIRST_PACKET
, frame
,
2048 sd
->jpeg_hdr
, JPEG_HDR_SZ
);
2050 gspca_frame_add(gspca_dev
, INTER_PACKET
, frame
, data
, len
);
2053 static int sd_setbrightness(struct gspca_dev
*gspca_dev
, __s32 val
)
2055 struct sd
*sd
= (struct sd
*) gspca_dev
;
2057 sd
->brightness
= val
;
2058 if (gspca_dev
->streaming
)
2059 setbrightness(gspca_dev
);
2063 static int sd_getbrightness(struct gspca_dev
*gspca_dev
, __s32
*val
)
2065 struct sd
*sd
= (struct sd
*) gspca_dev
;
2067 *val
= sd
->brightness
;
2071 static int sd_setcontrast(struct gspca_dev
*gspca_dev
, __s32 val
)
2073 struct sd
*sd
= (struct sd
*) gspca_dev
;
2076 if (gspca_dev
->streaming
)
2077 setcontrast(gspca_dev
);
2081 static int sd_getcontrast(struct gspca_dev
*gspca_dev
, __s32
*val
)
2083 struct sd
*sd
= (struct sd
*) gspca_dev
;
2085 *val
= sd
->contrast
;
2089 static int sd_setcolors(struct gspca_dev
*gspca_dev
, __s32 val
)
2091 struct sd
*sd
= (struct sd
*) gspca_dev
;
2094 if (gspca_dev
->streaming
)
2095 setcolors(gspca_dev
);
2099 static int sd_getcolors(struct gspca_dev
*gspca_dev
, __s32
*val
)
2101 struct sd
*sd
= (struct sd
*) gspca_dev
;
2107 static int sd_setblue_balance(struct gspca_dev
*gspca_dev
, __s32 val
)
2109 struct sd
*sd
= (struct sd
*) gspca_dev
;
2112 if (gspca_dev
->streaming
)
2113 setredblue(gspca_dev
);
2117 static int sd_getblue_balance(struct gspca_dev
*gspca_dev
, __s32
*val
)
2119 struct sd
*sd
= (struct sd
*) gspca_dev
;
2125 static int sd_setred_balance(struct gspca_dev
*gspca_dev
, __s32 val
)
2127 struct sd
*sd
= (struct sd
*) gspca_dev
;
2130 if (gspca_dev
->streaming
)
2131 setredblue(gspca_dev
);
2135 static int sd_getred_balance(struct gspca_dev
*gspca_dev
, __s32
*val
)
2137 struct sd
*sd
= (struct sd
*) gspca_dev
;
2143 static int sd_setgamma(struct gspca_dev
*gspca_dev
, __s32 val
)
2145 struct sd
*sd
= (struct sd
*) gspca_dev
;
2148 if (gspca_dev
->streaming
)
2149 setgamma(gspca_dev
);
2153 static int sd_getgamma(struct gspca_dev
*gspca_dev
, __s32
*val
)
2155 struct sd
*sd
= (struct sd
*) gspca_dev
;
2161 static int sd_setautogain(struct gspca_dev
*gspca_dev
, __s32 val
)
2163 struct sd
*sd
= (struct sd
*) gspca_dev
;
2166 if (gspca_dev
->streaming
)
2167 setautogain(gspca_dev
);
2171 static int sd_getautogain(struct gspca_dev
*gspca_dev
, __s32
*val
)
2173 struct sd
*sd
= (struct sd
*) gspca_dev
;
2175 *val
= sd
->autogain
;
2179 static int sd_setvflip(struct gspca_dev
*gspca_dev
, __s32 val
)
2181 struct sd
*sd
= (struct sd
*) gspca_dev
;
2184 if (gspca_dev
->streaming
)
2189 static int sd_getvflip(struct gspca_dev
*gspca_dev
, __s32
*val
)
2191 struct sd
*sd
= (struct sd
*) gspca_dev
;
2197 static int sd_setinfrared(struct gspca_dev
*gspca_dev
, __s32 val
)
2199 struct sd
*sd
= (struct sd
*) gspca_dev
;
2202 if (gspca_dev
->streaming
)
2207 static int sd_getinfrared(struct gspca_dev
*gspca_dev
, __s32
*val
)
2209 struct sd
*sd
= (struct sd
*) gspca_dev
;
2211 *val
= sd
->infrared
;
2215 static int sd_setfreq(struct gspca_dev
*gspca_dev
, __s32 val
)
2217 struct sd
*sd
= (struct sd
*) gspca_dev
;
2220 if (gspca_dev
->streaming
)
2225 static int sd_getfreq(struct gspca_dev
*gspca_dev
, __s32
*val
)
2227 struct sd
*sd
= (struct sd
*) gspca_dev
;
2233 static int sd_set_jcomp(struct gspca_dev
*gspca_dev
,
2234 struct v4l2_jpegcompression
*jcomp
)
2236 struct sd
*sd
= (struct sd
*) gspca_dev
;
2238 if (jcomp
->quality
< QUALITY_MIN
)
2239 sd
->quality
= QUALITY_MIN
;
2240 else if (jcomp
->quality
> QUALITY_MAX
)
2241 sd
->quality
= QUALITY_MAX
;
2243 sd
->quality
= jcomp
->quality
;
2244 if (gspca_dev
->streaming
)
2245 jpeg_set_qual(sd
->jpeg_hdr
, sd
->quality
);
2249 static int sd_get_jcomp(struct gspca_dev
*gspca_dev
,
2250 struct v4l2_jpegcompression
*jcomp
)
2252 struct sd
*sd
= (struct sd
*) gspca_dev
;
2254 memset(jcomp
, 0, sizeof *jcomp
);
2255 jcomp
->quality
= sd
->quality
;
2256 jcomp
->jpeg_markers
= V4L2_JPEG_MARKER_DHT
2257 | V4L2_JPEG_MARKER_DQT
;
2261 static int sd_querymenu(struct gspca_dev
*gspca_dev
,
2262 struct v4l2_querymenu
*menu
)
2265 case V4L2_CID_POWER_LINE_FREQUENCY
:
2266 switch (menu
->index
) {
2267 case 0: /* V4L2_CID_POWER_LINE_FREQUENCY_DISABLED */
2268 strcpy((char *) menu
->name
, "NoFliker");
2270 case 1: /* V4L2_CID_POWER_LINE_FREQUENCY_50HZ */
2271 strcpy((char *) menu
->name
, "50 Hz");
2273 case 2: /* V4L2_CID_POWER_LINE_FREQUENCY_60HZ */
2274 strcpy((char *) menu
->name
, "60 Hz");
2282 /* sub-driver description */
2283 static const struct sd_desc sd_desc
= {
2284 .name
= MODULE_NAME
,
2286 .nctrls
= ARRAY_SIZE(sd_ctrls
),
2287 .config
= sd_config
,
2292 .pkt_scan
= sd_pkt_scan
,
2293 .dq_callback
= do_autogain
,
2294 .get_jcomp
= sd_get_jcomp
,
2295 .set_jcomp
= sd_set_jcomp
,
2296 .querymenu
= sd_querymenu
,
2299 /* -- module initialisation -- */
2300 #define BSI(bridge, sensor, i2c_addr) \
2301 .driver_info = (BRIDGE_ ## bridge << 16) \
2302 | (SENSOR_ ## sensor << 8) \
2304 static const __devinitdata
struct usb_device_id device_table
[] = {
2305 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2306 {USB_DEVICE(0x0458, 0x7025), BSI(SN9C120
, MI0360
, 0x5d)},
2307 {USB_DEVICE(0x0458, 0x702e), BSI(SN9C120
, OV7660
, 0x21)},
2309 {USB_DEVICE(0x045e, 0x00f5), BSI(SN9C105
, OV7660
, 0x21)},
2310 {USB_DEVICE(0x045e, 0x00f7), BSI(SN9C105
, OV7660
, 0x21)},
2311 {USB_DEVICE(0x0471, 0x0327), BSI(SN9C105
, MI0360
, 0x5d)},
2312 {USB_DEVICE(0x0471, 0x0328), BSI(SN9C105
, MI0360
, 0x5d)},
2313 {USB_DEVICE(0x0471, 0x0330), BSI(SN9C105
, MI0360
, 0x5d)},
2314 {USB_DEVICE(0x06f8, 0x3004), BSI(SN9C105
, OV7660
, 0x21)},
2315 {USB_DEVICE(0x06f8, 0x3008), BSI(SN9C105
, OV7660
, 0x21)},
2316 {USB_DEVICE(0x0c45, 0x6040), BSI(SN9C102P
, HV7131R
, 0x11)},
2318 {USB_DEVICE(0x0c45, 0x6040), BSI(SN9C102P, MI0360, 0x5d)}, */
2319 /* {USB_DEVICE(0x0c45, 0x603a), BSI(SN9C102P, OV7648, 0x??)}, */
2320 /* {USB_DEVICE(0x0c45, 0x607a), BSI(SN9C102P, OV7648, 0x??)}, */
2321 {USB_DEVICE(0x0c45, 0x607c), BSI(SN9C102P
, HV7131R
, 0x11)},
2322 /* {USB_DEVICE(0x0c45, 0x607e), BSI(SN9C102P, OV7630, 0x??)}, */
2323 {USB_DEVICE(0x0c45, 0x60c0), BSI(SN9C105
, MI0360
, 0x5d)},
2324 /* {USB_DEVICE(0x0c45, 0x60c8), BSI(SN9C105, OM6801, 0x??)}, */
2325 /* {USB_DEVICE(0x0c45, 0x60cc), BSI(SN9C105, HV7131GP, 0x??)}, */
2326 {USB_DEVICE(0x0c45, 0x60ec), BSI(SN9C105
, MO4000
, 0x21)},
2327 /* {USB_DEVICE(0x0c45, 0x60ef), BSI(SN9C105, ICM105C, 0x??)}, */
2328 /* {USB_DEVICE(0x0c45, 0x60fa), BSI(SN9C105, OV7648, 0x??)}, */
2329 {USB_DEVICE(0x0c45, 0x60fb), BSI(SN9C105
, OV7660
, 0x21)},
2330 {USB_DEVICE(0x0c45, 0x60fc), BSI(SN9C105
, HV7131R
, 0x11)},
2331 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2332 {USB_DEVICE(0x0c45, 0x60fe), BSI(SN9C105
, OV7630
, 0x21)},
2334 {USB_DEVICE(0x0c45, 0x6100), BSI(SN9C120
, MI0360
, 0x5d)}, /*sn9c128*/
2335 /* {USB_DEVICE(0x0c45, 0x6108), BSI(SN9C120, OM6801, 0x??)}, */
2336 {USB_DEVICE(0x0c45, 0x610a), BSI(SN9C120
, OV7648
, 0x21)}, /*sn9c128*/
2337 {USB_DEVICE(0x0c45, 0x610b), BSI(SN9C120
, OV7660
, 0x21)}, /*sn9c128*/
2338 {USB_DEVICE(0x0c45, 0x610c), BSI(SN9C120
, HV7131R
, 0x11)}, /*sn9c128*/
2339 {USB_DEVICE(0x0c45, 0x610e), BSI(SN9C120
, OV7630
, 0x21)}, /*sn9c128*/
2340 /* {USB_DEVICE(0x0c45, 0x6122), BSI(SN9C110, ICM105C, 0x??)}, */
2341 /* {USB_DEVICE(0x0c45, 0x6123), BSI(SN9C110, SanyoCCD, 0x??)}, */
2342 {USB_DEVICE(0x0c45, 0x6128), BSI(SN9C110
, OM6802
, 0x21)}, /*sn9c325?*/
2344 {USB_DEVICE(0x0c45, 0x612a), BSI(SN9C120
, OV7648
, 0x21)}, /*sn9c110?*/
2345 {USB_DEVICE(0x0c45, 0x612c), BSI(SN9C110
, MO4000
, 0x21)},
2346 {USB_DEVICE(0x0c45, 0x612e), BSI(SN9C110
, OV7630
, 0x21)},
2347 /* {USB_DEVICE(0x0c45, 0x612f), BSI(SN9C110, ICM105C, 0x??)}, */
2348 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2349 {USB_DEVICE(0x0c45, 0x6130), BSI(SN9C120
, MI0360
, 0x5d)},
2351 {USB_DEVICE(0x0c45, 0x6138), BSI(SN9C120
, MO4000
, 0x21)},
2352 {USB_DEVICE(0x0c45, 0x613a), BSI(SN9C120
, OV7648
, 0x21)},
2353 #if !defined CONFIG_USB_SN9C102 && !defined CONFIG_USB_SN9C102_MODULE
2354 {USB_DEVICE(0x0c45, 0x613b), BSI(SN9C120
, OV7660
, 0x21)},
2356 {USB_DEVICE(0x0c45, 0x613c), BSI(SN9C120
, HV7131R
, 0x11)},
2357 {USB_DEVICE(0x0c45, 0x613e), BSI(SN9C120
, OV7630
, 0x21)},
2358 {USB_DEVICE(0x0c45, 0x6143), BSI(SN9C120
, SP80708
, 0x18)},
2361 MODULE_DEVICE_TABLE(usb
, device_table
);
2363 /* -- device connect -- */
2364 static int sd_probe(struct usb_interface
*intf
,
2365 const struct usb_device_id
*id
)
2367 return gspca_dev_probe(intf
, id
, &sd_desc
, sizeof(struct sd
),
2371 static struct usb_driver sd_driver
= {
2372 .name
= MODULE_NAME
,
2373 .id_table
= device_table
,
2375 .disconnect
= gspca_disconnect
,
2377 .suspend
= gspca_suspend
,
2378 .resume
= gspca_resume
,
2382 /* -- module insert / remove -- */
2383 static int __init
sd_mod_init(void)
2386 ret
= usb_register(&sd_driver
);
2392 static void __exit
sd_mod_exit(void)
2394 usb_deregister(&sd_driver
);
2395 info("deregistered");
2398 module_init(sd_mod_init
);
2399 module_exit(sd_mod_exit
);