2 * Sonix sn9c102p sn9c105 sn9c120 (jpeg) subdriver
4 * Copyright (C) 2009-2011 Jean-François Moine <http://moinejf.free.fr>
5 * Copyright (C) 2005 Michel Xhaard mxhaard@magic.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.
18 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
20 #define MODULE_NAME "sonixj"
22 #include <linux/input.h>
26 MODULE_AUTHOR("Jean-François Moine <http://moinejf.free.fr>");
27 MODULE_DESCRIPTION("GSPCA/SONIX JPEG USB Camera Driver");
28 MODULE_LICENSE("GPL");
30 /* specific webcam descriptor */
32 struct gspca_dev gspca_dev
; /* !! must be the first item */
35 struct v4l2_ctrl
*brightness
;
36 struct v4l2_ctrl
*contrast
;
37 struct v4l2_ctrl
*saturation
;
38 struct { /* red/blue balance control cluster */
39 struct v4l2_ctrl
*red_bal
;
40 struct v4l2_ctrl
*blue_bal
;
42 struct { /* hflip/vflip control cluster */
43 struct v4l2_ctrl
*vflip
;
44 struct v4l2_ctrl
*hflip
;
46 struct v4l2_ctrl
*gamma
;
47 struct v4l2_ctrl
*illum
;
48 struct v4l2_ctrl
*sharpness
;
49 struct v4l2_ctrl
*freq
;
52 struct work_struct work
;
54 u32 pktsz
; /* (used by pkt_scan) */
59 u8 quality
; /* image quality */
60 #define QUALITY_MIN 25
61 #define QUALITY_MAX 90
62 #define QUALITY_DEF 70
70 #define AG_CNT_START 13
73 #define BRIDGE_SN9C102P 0
74 #define BRIDGE_SN9C105 1
75 #define BRIDGE_SN9C110 2
76 #define BRIDGE_SN9C120 3
77 u8 sensor
; /* Type of image sensor chip */
80 u8 jpeg_hdr
[JPEG_HDR_SZ
];
100 static void qual_upd(struct work_struct
*work
);
103 #define F_PDN_INV 0x01 /* inverse pin S_PWR_DN / sn_xxx tables */
104 #define F_ILLUM 0x02 /* presence of illuminator */
106 /* sn9c1xx definitions */
108 #define S_PWR_DN 0x01 /* sensor power down */
109 #define S_PDN_INV 0x02 /* inverse pin S_PWR_DN */
110 #define V_TX_EN 0x04 /* video transfer enable */
111 #define LED 0x08 /* output to pin LED */
112 #define SCL_SEL_OD 0x20 /* open-drain mode */
113 #define SYS_SEL_48M 0x40 /* system clock 0: 24MHz, 1: 48MHz */
115 #define MCK_SIZE_MASK 0x1f /* sensor master clock */
116 #define SEN_CLK_EN 0x20 /* enable sensor clock */
117 #define DEF_EN 0x80 /* defect pixel by 0: soft, 1: hard */
119 static const struct v4l2_pix_format cif_mode
[] = {
120 {352, 288, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
122 .sizeimage
= 352 * 288 * 4 / 8 + 590,
123 .colorspace
= V4L2_COLORSPACE_JPEG
,
126 static const struct v4l2_pix_format vga_mode
[] = {
127 {160, 120, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
129 .sizeimage
= 160 * 120 * 4 / 8 + 590,
130 .colorspace
= V4L2_COLORSPACE_JPEG
,
132 {320, 240, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
134 .sizeimage
= 320 * 240 * 3 / 8 + 590,
135 .colorspace
= V4L2_COLORSPACE_JPEG
,
137 {640, 480, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
139 /* Note 3 / 8 is not large enough, not even 5 / 8 is ?! */
140 .sizeimage
= 640 * 480 * 3 / 4 + 590,
141 .colorspace
= V4L2_COLORSPACE_JPEG
,
145 static const u8 sn_adcm1700
[0x1c] = {
146 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
147 0x00, 0x43, 0x60, 0x00, 0x1a, 0x00, 0x00, 0x00,
148 /* reg8 reg9 rega regb regc regd rege regf */
149 0x80, 0x51, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
150 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
151 0x03, 0x00, 0x05, 0x01, 0x05, 0x16, 0x12, 0x42,
152 /* reg18 reg19 reg1a reg1b */
153 0x06, 0x00, 0x00, 0x00
156 static const u8 sn_gc0307
[0x1c] = {
157 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
158 0x00, 0x61, 0x62, 0x00, 0x1a, 0x00, 0x00, 0x00,
159 /* reg8 reg9 rega regb regc regd rege regf */
160 0x80, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
161 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
162 0x03, 0x00, 0x03, 0x01, 0x08, 0x28, 0x1e, 0x02,
163 /* reg18 reg19 reg1a reg1b */
164 0x06, 0x00, 0x00, 0x00
167 static const u8 sn_hv7131
[0x1c] = {
168 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
169 0x00, 0x03, 0x60, 0x00, 0x1a, 0x20, 0x20, 0x20,
170 /* reg8 reg9 rega regb regc regd rege regf */
171 0x81, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
172 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
173 0x03, 0x00, 0x00, 0x01, 0x03, 0x28, 0x1e, 0x41,
174 /* reg18 reg19 reg1a reg1b */
175 0x0a, 0x00, 0x00, 0x00
178 static const u8 sn_mi0360
[0x1c] = {
179 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
180 0x00, 0x63, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
181 /* reg8 reg9 rega regb regc regd rege regf */
182 0x81, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
183 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
184 0x03, 0x00, 0x00, 0x02, 0x0a, 0x28, 0x1e, 0x61,
185 /* reg18 reg19 reg1a reg1b */
186 0x06, 0x00, 0x00, 0x00
189 static const u8 sn_mi0360b
[0x1c] = {
190 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
191 0x00, 0x61, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
192 /* reg8 reg9 rega regb regc regd rege regf */
193 0x81, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
194 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
195 0x03, 0x00, 0x00, 0x02, 0x0a, 0x28, 0x1e, 0x40,
196 /* reg18 reg19 reg1a reg1b */
197 0x06, 0x00, 0x00, 0x00
200 static const u8 sn_mo4000
[0x1c] = {
201 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
202 0x00, 0x23, 0x60, 0x00, 0x1a, 0x00, 0x20, 0x18,
203 /* reg8 reg9 rega regb regc regd rege regf */
204 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
205 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
206 0x03, 0x00, 0x0b, 0x0f, 0x14, 0x28, 0x1e, 0x40,
207 /* reg18 reg19 reg1a reg1b */
208 0x08, 0x00, 0x00, 0x00
211 static const u8 sn_mt9v111
[0x1c] = {
212 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
213 0x00, 0x61, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
214 /* reg8 reg9 rega regb regc regd rege regf */
215 0x81, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
216 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
217 0x03, 0x00, 0x00, 0x02, 0x1c, 0x28, 0x1e, 0x40,
218 /* reg18 reg19 reg1a reg1b */
219 0x06, 0x00, 0x00, 0x00
222 static const u8 sn_om6802
[0x1c] = {
223 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
224 0x00, 0x23, 0x72, 0x00, 0x1a, 0x20, 0x20, 0x19,
225 /* reg8 reg9 rega regb regc regd rege regf */
226 0x80, 0x34, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
227 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
228 0x03, 0x00, 0x51, 0x01, 0x00, 0x28, 0x1e, 0x40,
229 /* reg18 reg19 reg1a reg1b */
230 0x05, 0x00, 0x00, 0x00
233 static const u8 sn_ov7630
[0x1c] = {
234 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
235 0x00, 0x21, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
236 /* reg8 reg9 rega regb regc regd rege regf */
237 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
238 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
239 0x03, 0x00, 0x04, 0x01, 0x0a, 0x28, 0x1e, 0xc2,
240 /* reg18 reg19 reg1a reg1b */
241 0x0b, 0x00, 0x00, 0x00
244 static const u8 sn_ov7648
[0x1c] = {
245 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
246 0x00, 0x63, 0x40, 0x00, 0x1a, 0x20, 0x20, 0x20,
247 /* reg8 reg9 rega regb regc regd rege regf */
248 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
249 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
250 0x03, 0x00, 0x00, 0x01, 0x00, 0x28, 0x1e, 0x00,
251 /* reg18 reg19 reg1a reg1b */
252 0x0b, 0x00, 0x00, 0x00
255 static const u8 sn_ov7660
[0x1c] = {
256 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
257 0x00, 0x61, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
258 /* reg8 reg9 rega regb regc regd rege regf */
259 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
260 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
261 0x03, 0x00, 0x01, 0x01, 0x08, 0x28, 0x1e, 0x20,
262 /* reg18 reg19 reg1a reg1b */
263 0x07, 0x00, 0x00, 0x00
266 static const u8 sn_po1030
[0x1c] = {
267 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
268 0x00, 0x21, 0x62, 0x00, 0x1a, 0x20, 0x20, 0x20,
269 /* reg8 reg9 rega regb regc regd rege regf */
270 0x81, 0x6e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
271 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
272 0x03, 0x00, 0x00, 0x06, 0x06, 0x28, 0x1e, 0x00,
273 /* reg18 reg19 reg1a reg1b */
274 0x07, 0x00, 0x00, 0x00
277 static const u8 sn_po2030n
[0x1c] = {
278 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
279 0x00, 0x63, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
280 /* reg8 reg9 rega regb regc regd rege regf */
281 0x81, 0x6e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
282 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
283 0x03, 0x00, 0x00, 0x01, 0x14, 0x28, 0x1e, 0x00,
284 /* reg18 reg19 reg1a reg1b */
285 0x07, 0x00, 0x00, 0x00
288 static const u8 sn_soi768
[0x1c] = {
289 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
290 0x00, 0x21, 0x40, 0x00, 0x1a, 0x00, 0x00, 0x00,
291 /* reg8 reg9 rega regb regc regd rege regf */
292 0x81, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
293 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
294 0x03, 0x00, 0x00, 0x01, 0x08, 0x28, 0x1e, 0x00,
295 /* reg18 reg19 reg1a reg1b */
296 0x07, 0x00, 0x00, 0x00
299 static const u8 sn_sp80708
[0x1c] = {
300 /* reg0 reg1 reg2 reg3 reg4 reg5 reg6 reg7 */
301 0x00, 0x63, 0x60, 0x00, 0x1a, 0x20, 0x20, 0x20,
302 /* reg8 reg9 rega regb regc regd rege regf */
303 0x81, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
304 /* reg10 reg11 reg12 reg13 reg14 reg15 reg16 reg17 */
305 0x03, 0x00, 0x00, 0x03, 0x04, 0x28, 0x1e, 0x00,
306 /* reg18 reg19 reg1a reg1b */
307 0x07, 0x00, 0x00, 0x00
310 /* sequence specific to the sensors - !! index = SENSOR_xxx */
311 static const u8
*sn_tb
[] = {
312 [SENSOR_ADCM1700
] = sn_adcm1700
,
313 [SENSOR_GC0307
] = sn_gc0307
,
314 [SENSOR_HV7131R
] = sn_hv7131
,
315 [SENSOR_MI0360
] = sn_mi0360
,
316 [SENSOR_MI0360B
] = sn_mi0360b
,
317 [SENSOR_MO4000
] = sn_mo4000
,
318 [SENSOR_MT9V111
] = sn_mt9v111
,
319 [SENSOR_OM6802
] = sn_om6802
,
320 [SENSOR_OV7630
] = sn_ov7630
,
321 [SENSOR_OV7648
] = sn_ov7648
,
322 [SENSOR_OV7660
] = sn_ov7660
,
323 [SENSOR_PO1030
] = sn_po1030
,
324 [SENSOR_PO2030N
] = sn_po2030n
,
325 [SENSOR_SOI768
] = sn_soi768
,
326 [SENSOR_SP80708
] = sn_sp80708
,
329 /* default gamma table */
330 static const u8 gamma_def
[17] = {
331 0x00, 0x2d, 0x46, 0x5a, 0x6c, 0x7c, 0x8b, 0x99,
332 0xa6, 0xb2, 0xbf, 0xca, 0xd5, 0xe0, 0xeb, 0xf5, 0xff
334 /* gamma for sensor ADCM1700 */
335 static const u8 gamma_spec_0
[17] = {
336 0x0f, 0x39, 0x5a, 0x74, 0x86, 0x95, 0xa6, 0xb4,
337 0xbd, 0xc4, 0xcc, 0xd4, 0xd5, 0xde, 0xe4, 0xed, 0xf5
339 /* gamma for sensors HV7131R and MT9V111 */
340 static const u8 gamma_spec_1
[17] = {
341 0x08, 0x3a, 0x52, 0x65, 0x75, 0x83, 0x91, 0x9d,
342 0xa9, 0xb4, 0xbe, 0xc8, 0xd2, 0xdb, 0xe4, 0xed, 0xf5
344 /* gamma for sensor GC0307 */
345 static const u8 gamma_spec_2
[17] = {
346 0x14, 0x37, 0x50, 0x6a, 0x7c, 0x8d, 0x9d, 0xab,
347 0xb5, 0xbf, 0xc2, 0xcb, 0xd1, 0xd6, 0xdb, 0xe1, 0xeb
349 /* gamma for sensor SP80708 */
350 static const u8 gamma_spec_3
[17] = {
351 0x0a, 0x2d, 0x4e, 0x68, 0x7d, 0x8f, 0x9f, 0xab,
352 0xb7, 0xc2, 0xcc, 0xd3, 0xd8, 0xde, 0xe2, 0xe5, 0xe6
355 /* color matrix and offsets */
356 static const u8 reg84
[] = {
357 0x14, 0x00, 0x27, 0x00, 0x07, 0x00, /* YR YG YB gains */
358 0xe8, 0x0f, 0xda, 0x0f, 0x40, 0x00, /* UR UG UB */
359 0x3e, 0x00, 0xcd, 0x0f, 0xf7, 0x0f, /* VR VG VB */
360 0x00, 0x00, 0x00 /* YUV offsets */
365 static const u8 adcm1700_sensor_init
[][8] = {
366 {0xa0, 0x51, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x10},
367 {0xb0, 0x51, 0x04, 0x08, 0x00, 0x00, 0x00, 0x10}, /* reset */
368 {DELAY
, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
369 {0xb0, 0x51, 0x04, 0x00, 0x00, 0x00, 0x00, 0x10},
370 {DELAY
, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
371 {0xb0, 0x51, 0x0c, 0xe0, 0x2e, 0x00, 0x00, 0x10},
372 {0xb0, 0x51, 0x10, 0x02, 0x02, 0x00, 0x00, 0x10},
373 {0xb0, 0x51, 0x14, 0x0e, 0x0e, 0x00, 0x00, 0x10},
374 {0xb0, 0x51, 0x1c, 0x00, 0x80, 0x00, 0x00, 0x10},
375 {0xb0, 0x51, 0x20, 0x01, 0x00, 0x00, 0x00, 0x10},
376 {DELAY
, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
377 {0xb0, 0x51, 0x04, 0x04, 0x00, 0x00, 0x00, 0x10},
378 {DELAY
, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
379 {0xb0, 0x51, 0x04, 0x01, 0x00, 0x00, 0x00, 0x10},
380 {0xa0, 0x51, 0xfe, 0x10, 0x00, 0x00, 0x00, 0x10},
381 {0xb0, 0x51, 0x14, 0x01, 0x00, 0x00, 0x00, 0x10},
382 {0xb0, 0x51, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
385 static const u8 adcm1700_sensor_param1
[][8] = {
386 {0xb0, 0x51, 0x26, 0xf9, 0x01, 0x00, 0x00, 0x10}, /* exposure? */
387 {0xd0, 0x51, 0x1e, 0x8e, 0x8e, 0x8e, 0x8e, 0x10},
389 {0xa0, 0x51, 0xfe, 0x01, 0x00, 0x00, 0x00, 0x10},
390 {0xb0, 0x51, 0x00, 0x02, 0x00, 0x00, 0x00, 0x10},
391 {0xa0, 0x51, 0xfe, 0x10, 0x00, 0x00, 0x00, 0x10},
392 {0xb0, 0x51, 0x32, 0x00, 0x72, 0x00, 0x00, 0x10},
393 {0xd0, 0x51, 0x1e, 0xbe, 0xd7, 0xe8, 0xbe, 0x10}, /* exposure? */
395 {0xa0, 0x51, 0xfe, 0x01, 0x00, 0x00, 0x00, 0x10},
396 {0xb0, 0x51, 0x00, 0x02, 0x00, 0x00, 0x00, 0x10},
397 {0xa0, 0x51, 0xfe, 0x10, 0x00, 0x00, 0x00, 0x10},
398 {0xb0, 0x51, 0x32, 0x00, 0xa2, 0x00, 0x00, 0x10},
401 static const u8 gc0307_sensor_init
[][8] = {
402 {0xa0, 0x21, 0x43, 0x00, 0x00, 0x00, 0x00, 0x10},
403 {0xa0, 0x21, 0x44, 0xa2, 0x00, 0x00, 0x00, 0x10},
404 {0xa0, 0x21, 0x01, 0x6a, 0x00, 0x00, 0x00, 0x10},
405 {0xa0, 0x21, 0x02, 0x70, 0x00, 0x00, 0x00, 0x10},
406 {0xa0, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
407 {0xa0, 0x21, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x10},
408 {0xa0, 0x21, 0x1d, 0x00, 0x00, 0x00, 0x00, 0x10},
409 {0xa0, 0x21, 0x11, 0x05, 0x00, 0x00, 0x00, 0x10},
410 {0xa0, 0x21, 0x05, 0x00, 0x00, 0x00, 0x00, 0x10},
411 {0xa0, 0x21, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10},
412 {0xa0, 0x21, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10},
413 {0xa0, 0x21, 0x08, 0x02, 0x00, 0x00, 0x00, 0x10},
414 {0xa0, 0x21, 0x09, 0x01, 0x00, 0x00, 0x00, 0x10},
415 {0xa0, 0x21, 0x0a, 0xe8, 0x00, 0x00, 0x00, 0x10},
416 {0xa0, 0x21, 0x0b, 0x02, 0x00, 0x00, 0x00, 0x10},
417 {0xa0, 0x21, 0x0c, 0x80, 0x00, 0x00, 0x00, 0x10},
418 {0xa0, 0x21, 0x0d, 0x22, 0x00, 0x00, 0x00, 0x10},
419 {0xa0, 0x21, 0x0e, 0x02, 0x00, 0x00, 0x00, 0x10},
420 {0xa0, 0x21, 0x0f, 0xb2, 0x00, 0x00, 0x00, 0x10},
421 {0xa0, 0x21, 0x12, 0x70, 0x00, 0x00, 0x00, 0x10},
422 {DELAY
, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*delay 10ms*/
423 {0xa0, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00, 0x10},
424 {0xa0, 0x21, 0x15, 0xb8, 0x00, 0x00, 0x00, 0x10},
425 {0xa0, 0x21, 0x16, 0x13, 0x00, 0x00, 0x00, 0x10},
426 {0xa0, 0x21, 0x17, 0x52, 0x00, 0x00, 0x00, 0x10},
427 {0xa0, 0x21, 0x18, 0x50, 0x00, 0x00, 0x00, 0x10},
428 {0xa0, 0x21, 0x1e, 0x0d, 0x00, 0x00, 0x00, 0x10},
429 {0xa0, 0x21, 0x1f, 0x32, 0x00, 0x00, 0x00, 0x10},
430 {0xa0, 0x21, 0x61, 0x90, 0x00, 0x00, 0x00, 0x10},
431 {0xa0, 0x21, 0x63, 0x70, 0x00, 0x00, 0x00, 0x10},
432 {0xa0, 0x21, 0x65, 0x98, 0x00, 0x00, 0x00, 0x10},
433 {0xa0, 0x21, 0x67, 0x90, 0x00, 0x00, 0x00, 0x10},
434 {0xa0, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
435 {0xa0, 0x21, 0x04, 0x96, 0x00, 0x00, 0x00, 0x10},
436 {0xa0, 0x21, 0x45, 0x27, 0x00, 0x00, 0x00, 0x10},
437 {0xa0, 0x21, 0x47, 0x2c, 0x00, 0x00, 0x00, 0x10},
438 {0xa0, 0x21, 0x43, 0x47, 0x00, 0x00, 0x00, 0x10},
439 {0xa0, 0x21, 0x44, 0xd8, 0x00, 0x00, 0x00, 0x10},
442 static const u8 gc0307_sensor_param1
[][8] = {
443 {0xa0, 0x21, 0x68, 0x13, 0x00, 0x00, 0x00, 0x10},
444 {0xd0, 0x21, 0x61, 0x80, 0x00, 0x80, 0x00, 0x10},
445 {0xc0, 0x21, 0x65, 0x80, 0x00, 0x80, 0x00, 0x10},
446 {0xc0, 0x21, 0x63, 0xa0, 0x00, 0xa6, 0x00, 0x10},
448 {0xa0, 0x21, 0x01, 0x6e, 0x00, 0x00, 0x00, 0x10},
449 {0xa0, 0x21, 0x02, 0x88, 0x00, 0x00, 0x00, 0x10},
453 static const u8 hv7131r_sensor_init
[][8] = {
454 {0xc1, 0x11, 0x01, 0x08, 0x01, 0x00, 0x00, 0x10},
455 {0xb1, 0x11, 0x34, 0x17, 0x7f, 0x00, 0x00, 0x10},
456 {0xd1, 0x11, 0x40, 0xff, 0x7f, 0x7f, 0x7f, 0x10},
457 /* {0x91, 0x11, 0x44, 0x00, 0x00, 0x00, 0x00, 0x10}, */
458 {0xd1, 0x11, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
459 {0xd1, 0x11, 0x14, 0x01, 0xe2, 0x02, 0x82, 0x10},
460 /* {0x91, 0x11, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10}, */
462 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
463 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
464 {0xc1, 0x11, 0x25, 0x00, 0x61, 0xa8, 0x00, 0x10},
465 {0xa1, 0x11, 0x30, 0x22, 0x00, 0x00, 0x00, 0x10},
466 {0xc1, 0x11, 0x31, 0x20, 0x2e, 0x20, 0x00, 0x10},
467 {0xc1, 0x11, 0x25, 0x00, 0xc3, 0x50, 0x00, 0x10},
468 {0xa1, 0x11, 0x30, 0x07, 0x00, 0x00, 0x00, 0x10}, /* gain14 */
469 {0xc1, 0x11, 0x31, 0x10, 0x10, 0x10, 0x00, 0x10}, /* r g b 101a10 */
471 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
472 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
473 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
474 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
475 {0xa1, 0x11, 0x23, 0x09, 0x00, 0x00, 0x00, 0x10},
477 {0xa1, 0x11, 0x01, 0x08, 0x00, 0x00, 0x00, 0x10},
478 {0xa1, 0x11, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
479 {0xa1, 0x11, 0x21, 0xd0, 0x00, 0x00, 0x00, 0x10},
480 {0xa1, 0x11, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
481 {0xa1, 0x11, 0x23, 0x10, 0x00, 0x00, 0x00, 0x10},
482 {0xa1, 0x11, 0x01, 0x18, 0x00, 0x00, 0x00, 0x10},
483 /* set sensor clock */
486 static const u8 mi0360_sensor_init
[][8] = {
487 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
488 {0xb1, 0x5d, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10},
489 {0xb1, 0x5d, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
490 {0xd1, 0x5d, 0x01, 0x00, 0x08, 0x00, 0x16, 0x10},
491 {0xd1, 0x5d, 0x03, 0x01, 0xe2, 0x02, 0x82, 0x10},
492 {0xd1, 0x5d, 0x05, 0x00, 0x09, 0x00, 0x53, 0x10},
493 {0xb1, 0x5d, 0x0d, 0x00, 0x02, 0x00, 0x00, 0x10},
494 {0xd1, 0x5d, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
495 {0xd1, 0x5d, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10},
496 {0xd1, 0x5d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
497 {0xd1, 0x5d, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
498 {0xd1, 0x5d, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
499 {0xd1, 0x5d, 0x14, 0x00, 0x00, 0x00, 0x00, 0x10},
500 {0xd1, 0x5d, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10},
501 {0xd1, 0x5d, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10},
502 {0xd1, 0x5d, 0x1a, 0x00, 0x00, 0x00, 0x00, 0x10},
503 {0xd1, 0x5d, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x10},
504 {0xb1, 0x5d, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
505 {0xd1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
506 {0xd1, 0x5d, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
507 {0xd1, 0x5d, 0x24, 0x00, 0x00, 0x00, 0x00, 0x10},
508 {0xd1, 0x5d, 0x26, 0x00, 0x00, 0x00, 0x24, 0x10},
509 {0xd1, 0x5d, 0x2f, 0xf7, 0xb0, 0x00, 0x04, 0x10},
510 {0xd1, 0x5d, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10},
511 {0xd1, 0x5d, 0x33, 0x00, 0x00, 0x01, 0x00, 0x10},
512 {0xb1, 0x5d, 0x3d, 0x06, 0x8f, 0x00, 0x00, 0x10},
513 {0xd1, 0x5d, 0x40, 0x01, 0xe0, 0x00, 0xd1, 0x10},
514 {0xb1, 0x5d, 0x44, 0x00, 0x82, 0x00, 0x00, 0x10},
515 {0xd1, 0x5d, 0x58, 0x00, 0x78, 0x00, 0x43, 0x10},
516 {0xd1, 0x5d, 0x5a, 0x00, 0x00, 0x00, 0x00, 0x10},
517 {0xd1, 0x5d, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x10},
518 {0xd1, 0x5d, 0x5e, 0x00, 0x00, 0xa3, 0x1d, 0x10},
519 {0xb1, 0x5d, 0x62, 0x04, 0x11, 0x00, 0x00, 0x10},
521 {0xb1, 0x5d, 0x20, 0x91, 0x01, 0x00, 0x00, 0x10},
522 {0xb1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
523 {0xb1, 0x5d, 0x09, 0x00, 0x64, 0x00, 0x00, 0x10},
524 {0xd1, 0x5d, 0x2b, 0x00, 0xa0, 0x00, 0xb0, 0x10},
525 {0xd1, 0x5d, 0x2d, 0x00, 0xa0, 0x00, 0xa0, 0x10},
527 {0xb1, 0x5d, 0x0a, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor clck ?2 */
528 {0xb1, 0x5d, 0x06, 0x00, 0x30, 0x00, 0x00, 0x10},
529 {0xb1, 0x5d, 0x05, 0x00, 0x0a, 0x00, 0x00, 0x10},
530 {0xb1, 0x5d, 0x09, 0x02, 0x35, 0x00, 0x00, 0x10}, /* exposure 2 */
532 {0xd1, 0x5d, 0x2b, 0x00, 0xb9, 0x00, 0xe3, 0x10},
533 {0xd1, 0x5d, 0x2d, 0x00, 0x5f, 0x00, 0xb9, 0x10}, /* 42 */
534 /* {0xb1, 0x5d, 0x35, 0x00, 0x67, 0x00, 0x00, 0x10}, * gain orig */
535 /* {0xb1, 0x5d, 0x35, 0x00, 0x20, 0x00, 0x00, 0x10}, * gain */
536 {0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10}, /* update */
537 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor on */
540 static const u8 mi0360b_sensor_init
[][8] = {
541 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
542 {0xb1, 0x5d, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10},
543 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*delay 20ms*/
544 {0xb1, 0x5d, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
545 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*delay 20ms*/
546 {0xd1, 0x5d, 0x01, 0x00, 0x08, 0x00, 0x16, 0x10},
547 {0xd1, 0x5d, 0x03, 0x01, 0xe2, 0x02, 0x82, 0x10},
548 {0xd1, 0x5d, 0x05, 0x00, 0x00, 0x00, 0x00, 0x10},
549 {0xb1, 0x5d, 0x0d, 0x00, 0x02, 0x00, 0x00, 0x10},
550 {0xd1, 0x5d, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
551 {0xd1, 0x5d, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10},
552 {0xd1, 0x5d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
553 {0xd1, 0x5d, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
554 {0xd1, 0x5d, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
555 {0xd1, 0x5d, 0x14, 0x00, 0x00, 0x00, 0x00, 0x10},
556 {0xd1, 0x5d, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10},
557 {0xd1, 0x5d, 0x18, 0x00, 0x00, 0x00, 0x00, 0x10},
558 {0xd1, 0x5d, 0x1a, 0x00, 0x00, 0x00, 0x00, 0x10},
559 {0xd1, 0x5d, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x10},
560 {0xb1, 0x5d, 0x32, 0x00, 0x00, 0x00, 0x00, 0x10},
561 {0xd1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
562 {0xd1, 0x5d, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
563 {0xd1, 0x5d, 0x24, 0x00, 0x00, 0x00, 0x00, 0x10},
564 {0xd1, 0x5d, 0x26, 0x00, 0x00, 0x00, 0x24, 0x10},
565 {0xd1, 0x5d, 0x2f, 0xf7, 0xb0, 0x00, 0x04, 0x10},
566 {0xd1, 0x5d, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10},
567 {0xd1, 0x5d, 0x33, 0x00, 0x00, 0x01, 0x00, 0x10},
568 {0xb1, 0x5d, 0x3d, 0x06, 0x8f, 0x00, 0x00, 0x10},
569 {0xd1, 0x5d, 0x40, 0x01, 0xe0, 0x00, 0xd1, 0x10},
570 {0xb1, 0x5d, 0x44, 0x00, 0x82, 0x00, 0x00, 0x10},
571 {0xd1, 0x5d, 0x58, 0x00, 0x78, 0x00, 0x43, 0x10},
572 {0xd1, 0x5d, 0x5a, 0x00, 0x00, 0x00, 0x00, 0x10},
573 {0xd1, 0x5d, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x10},
574 {0xd1, 0x5d, 0x5e, 0x00, 0x00, 0xa3, 0x1d, 0x10},
575 {0xb1, 0x5d, 0x62, 0x04, 0x11, 0x00, 0x00, 0x10},
577 {0xb1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
578 {0xb1, 0x5d, 0x20, 0x11, 0x01, 0x00, 0x00, 0x10},
579 {0xb1, 0x5d, 0x09, 0x00, 0x64, 0x00, 0x00, 0x10},
580 {0xd1, 0x5d, 0x2b, 0x00, 0x33, 0x00, 0xa0, 0x10},
581 {0xd1, 0x5d, 0x2d, 0x00, 0xa0, 0x00, 0x33, 0x10},
584 static const u8 mi0360b_sensor_param1
[][8] = {
585 {0xb1, 0x5d, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
586 {0xb1, 0x5d, 0x06, 0x00, 0x53, 0x00, 0x00, 0x10},
587 {0xb1, 0x5d, 0x05, 0x00, 0x09, 0x00, 0x00, 0x10},
588 {0xb1, 0x5d, 0x09, 0x02, 0x35, 0x00, 0x00, 0x10}, /* exposure 2 */
590 {0xd1, 0x5d, 0x2b, 0x00, 0xd1, 0x01, 0xc9, 0x10},
591 {0xd1, 0x5d, 0x2d, 0x00, 0xed, 0x00, 0xd1, 0x10},
592 {0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10}, /* update */
593 {0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10}, /* sensor on */
596 static const u8 mo4000_sensor_init
[][8] = {
597 {0xa1, 0x21, 0x01, 0x02, 0x00, 0x00, 0x00, 0x10},
598 {0xa1, 0x21, 0x02, 0x00, 0x00, 0x00, 0x00, 0x10},
599 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
600 {0xa1, 0x21, 0x04, 0x00, 0x00, 0x00, 0x00, 0x10},
601 {0xa1, 0x21, 0x05, 0x00, 0x00, 0x00, 0x00, 0x10},
602 {0xa1, 0x21, 0x05, 0x04, 0x00, 0x00, 0x00, 0x10},
603 {0xa1, 0x21, 0x06, 0x80, 0x00, 0x00, 0x00, 0x10},
604 {0xa1, 0x21, 0x06, 0x81, 0x00, 0x00, 0x00, 0x10},
605 {0xa1, 0x21, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x10},
606 {0xa1, 0x21, 0x11, 0x00, 0x00, 0x00, 0x00, 0x10},
607 {0xa1, 0x21, 0x11, 0x20, 0x00, 0x00, 0x00, 0x10},
608 {0xa1, 0x21, 0x11, 0x30, 0x00, 0x00, 0x00, 0x10},
609 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
610 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
611 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
612 {0xa1, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10},
613 {0xa1, 0x21, 0x0f, 0x20, 0x00, 0x00, 0x00, 0x10},
614 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10},
615 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
616 {0xa1, 0x21, 0x11, 0x38, 0x00, 0x00, 0x00, 0x10},
619 static const u8 mt9v111_sensor_init
[][8] = {
620 {0xb1, 0x5c, 0x0d, 0x00, 0x01, 0x00, 0x00, 0x10}, /* reset? */
621 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
622 {0xb1, 0x5c, 0x0d, 0x00, 0x00, 0x00, 0x00, 0x10},
623 {0xb1, 0x5c, 0x01, 0x00, 0x01, 0x00, 0x00, 0x10}, /* IFP select */
624 {0xb1, 0x5c, 0x08, 0x04, 0x80, 0x00, 0x00, 0x10}, /* output fmt ctrl */
625 {0xb1, 0x5c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x10}, /* op mode ctrl */
626 {0xb1, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10}, /* sensor select */
627 {0xb1, 0x5c, 0x08, 0x00, 0x08, 0x00, 0x00, 0x10}, /* row start */
628 {0xb1, 0x5c, 0x02, 0x00, 0x16, 0x00, 0x00, 0x10}, /* col start */
629 {0xb1, 0x5c, 0x03, 0x01, 0xe7, 0x00, 0x00, 0x10}, /* window height */
630 {0xb1, 0x5c, 0x04, 0x02, 0x87, 0x00, 0x00, 0x10}, /* window width */
631 {0xb1, 0x5c, 0x07, 0x30, 0x02, 0x00, 0x00, 0x10}, /* output ctrl */
632 {0xb1, 0x5c, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x10}, /* shutter delay */
633 {0xb1, 0x5c, 0x12, 0x00, 0xb0, 0x00, 0x00, 0x10}, /* zoom col start */
634 {0xb1, 0x5c, 0x13, 0x00, 0x7c, 0x00, 0x00, 0x10}, /* zoom row start */
635 {0xb1, 0x5c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* digital zoom */
636 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10}, /* read mode */
637 {0xb1, 0x5c, 0x20, 0x00, 0x00, 0x00, 0x00, 0x10},
640 static const u8 mt9v111_sensor_param1
[][8] = {
641 {0xd1, 0x5c, 0x2b, 0x00, 0x33, 0x00, 0xad, 0x10}, /* G1 and B gains */
642 {0xd1, 0x5c, 0x2d, 0x00, 0xad, 0x00, 0x33, 0x10}, /* R and G2 gains */
643 {0xb1, 0x5c, 0x06, 0x00, 0x40, 0x00, 0x00, 0x10}, /* vert blanking */
644 {0xb1, 0x5c, 0x05, 0x00, 0x09, 0x00, 0x00, 0x10}, /* horiz blanking */
645 {0xb1, 0x5c, 0x35, 0x01, 0xc0, 0x00, 0x00, 0x10}, /* global gain */
648 static const u8 om6802_init0
[2][8] = {
650 {0xa0, 0x34, 0x29, 0x0e, 0x00, 0x00, 0x00, 0x10},
651 {0xa0, 0x34, 0x23, 0xb0, 0x00, 0x00, 0x00, 0x10},
653 static const u8 om6802_sensor_init
[][8] = {
654 {0xa0, 0x34, 0xdf, 0x6d, 0x00, 0x00, 0x00, 0x10},
656 {0xa0, 0x34, 0xdd, 0x18, 0x00, 0x00, 0x00, 0x10},
658 {0xa0, 0x34, 0x5a, 0xc0, 0x00, 0x00, 0x00, 0x10},
659 /* {0xa0, 0x34, 0xfb, 0x11, 0x00, 0x00, 0x00, 0x10}, */
660 {0xa0, 0x34, 0xf0, 0x04, 0x00, 0x00, 0x00, 0x10},
661 /* auto-exposure speed (0) / white balance mode (auto RGB) */
662 /* {0xa0, 0x34, 0xf1, 0x02, 0x00, 0x00, 0x00, 0x10},
664 /* {0xa0, 0x34, 0xfe, 0x5b, 0x00, 0x00, 0x00, 0x10},
665 * max AGC value in AE */
666 /* {0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10},
668 /* {0xa0, 0x34, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x10},
669 * preset brightness */
670 /* {0xa0, 0x34, 0xe7, 0x00, 0x00, 0x00, 0x00, 0x10},
672 /* {0xa0, 0x34, 0xe8, 0x31, 0x00, 0x00, 0x00, 0x10},
674 {0xa0, 0x34, 0xe9, 0x0f, 0x00, 0x00, 0x00, 0x10},
675 /* luminance mode (0x4f -> AutoExpo on) */
676 {0xa0, 0x34, 0xe4, 0xff, 0x00, 0x00, 0x00, 0x10},
678 /* {0xa0, 0x34, 0xef, 0x00, 0x00, 0x00, 0x00, 0x10},
680 /* {0xa0, 0x34, 0xfb, 0xee, 0x00, 0x00, 0x00, 0x10}, */
681 {0xa0, 0x34, 0x5d, 0x80, 0x00, 0x00, 0x00, 0x10},
684 static const u8 om6802_sensor_param1
[][8] = {
685 {0xa0, 0x34, 0x71, 0x84, 0x00, 0x00, 0x00, 0x10},
686 {0xa0, 0x34, 0x72, 0x05, 0x00, 0x00, 0x00, 0x10},
687 {0xa0, 0x34, 0x68, 0x80, 0x00, 0x00, 0x00, 0x10},
688 {0xa0, 0x34, 0x69, 0x01, 0x00, 0x00, 0x00, 0x10},
691 static const u8 ov7630_sensor_init
[][8] = {
692 {0xa1, 0x21, 0x76, 0x01, 0x00, 0x00, 0x00, 0x10},
693 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
694 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
695 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
696 {0xa1, 0x21, 0x12, 0xc8, 0x00, 0x00, 0x00, 0x10},
697 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
698 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
699 /* win: i2c_r from 00 to 80 */
700 {0xd1, 0x21, 0x03, 0x80, 0x10, 0x20, 0x80, 0x10},
701 {0xb1, 0x21, 0x0c, 0x20, 0x20, 0x00, 0x00, 0x10},
702 /* HDG: 0x11 was 0x00 change to 0x01 for better exposure (15 fps instead of 30)
703 0x13 was 0xc0 change to 0xc3 for auto gain and exposure */
704 {0xd1, 0x21, 0x11, 0x01, 0x48, 0xc3, 0x00, 0x10},
705 {0xb1, 0x21, 0x15, 0x80, 0x03, 0x00, 0x00, 0x10},
706 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
707 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
708 {0xd1, 0x21, 0x1f, 0x00, 0x80, 0x80, 0x80, 0x10},
709 {0xd1, 0x21, 0x23, 0xde, 0x10, 0x8a, 0xa0, 0x10},
710 {0xc1, 0x21, 0x27, 0xca, 0xa2, 0x74, 0x00, 0x10},
711 {0xd1, 0x21, 0x2a, 0x88, 0x00, 0x88, 0x01, 0x10},
712 {0xc1, 0x21, 0x2e, 0x80, 0x00, 0x18, 0x00, 0x10},
713 {0xa1, 0x21, 0x21, 0x08, 0x00, 0x00, 0x00, 0x10},
714 {0xa1, 0x21, 0x22, 0x00, 0x00, 0x00, 0x00, 0x10},
715 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10},
716 {0xb1, 0x21, 0x32, 0xc2, 0x08, 0x00, 0x00, 0x10},
717 {0xb1, 0x21, 0x4c, 0x00, 0x00, 0x00, 0x00, 0x10},
718 {0xd1, 0x21, 0x60, 0x05, 0x40, 0x12, 0x57, 0x10},
719 {0xa1, 0x21, 0x64, 0x73, 0x00, 0x00, 0x00, 0x10},
720 {0xd1, 0x21, 0x65, 0x00, 0x55, 0x01, 0xac, 0x10},
721 {0xa1, 0x21, 0x69, 0x38, 0x00, 0x00, 0x00, 0x10},
722 {0xd1, 0x21, 0x6f, 0x1f, 0x01, 0x00, 0x10, 0x10},
723 {0xd1, 0x21, 0x73, 0x50, 0x20, 0x02, 0x01, 0x10},
724 {0xd1, 0x21, 0x77, 0xf3, 0x90, 0x98, 0x98, 0x10},
725 {0xc1, 0x21, 0x7b, 0x00, 0x4c, 0xf7, 0x00, 0x10},
726 {0xd1, 0x21, 0x17, 0x1b, 0xbd, 0x05, 0xf6, 0x10},
727 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
730 static const u8 ov7630_sensor_param1
[][8] = {
731 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
732 {0xa1, 0x21, 0x12, 0x48, 0x00, 0x00, 0x00, 0x10},
733 /*fixme: + 0x12, 0x04*/
734 /* {0xa1, 0x21, 0x75, 0x82, 0x00, 0x00, 0x00, 0x10}, * COMN
736 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
737 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
738 {0xb1, 0x21, 0x01, 0x80, 0x80, 0x00, 0x00, 0x10},
740 /* {0xa1, 0x21, 0x2a, 0x88, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
741 /* {0xa1, 0x21, 0x2b, 0x34, 0x00, 0x00, 0x00, 0x10}, * set by setfreq */
743 {0xa1, 0x21, 0x10, 0x83, 0x00, 0x00, 0x00, 0x10},
744 /* {0xb1, 0x21, 0x01, 0x88, 0x70, 0x00, 0x00, 0x10}, */
748 static const u8 ov7648_sensor_init
[][8] = {
749 {0xa1, 0x21, 0x76, 0x00, 0x00, 0x00, 0x00, 0x10},
750 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset */
751 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
752 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
753 {0xd1, 0x21, 0x03, 0xa4, 0x30, 0x88, 0x00, 0x10},
754 {0xb1, 0x21, 0x11, 0x80, 0x08, 0x00, 0x00, 0x10},
755 {0xc1, 0x21, 0x13, 0xa0, 0x04, 0x84, 0x00, 0x10},
756 {0xd1, 0x21, 0x17, 0x1a, 0x02, 0xba, 0xf4, 0x10},
757 {0xa1, 0x21, 0x1b, 0x04, 0x00, 0x00, 0x00, 0x10},
758 {0xd1, 0x21, 0x1f, 0x41, 0xc0, 0x80, 0x80, 0x10},
759 {0xd1, 0x21, 0x23, 0xde, 0xa0, 0x80, 0x32, 0x10},
760 {0xd1, 0x21, 0x27, 0xfe, 0xa0, 0x00, 0x91, 0x10},
761 {0xd1, 0x21, 0x2b, 0x00, 0x88, 0x85, 0x80, 0x10},
762 {0xc1, 0x21, 0x2f, 0x9c, 0x00, 0xc4, 0x00, 0x10},
763 {0xd1, 0x21, 0x60, 0xa6, 0x60, 0x88, 0x12, 0x10},
764 {0xd1, 0x21, 0x64, 0x88, 0x00, 0x00, 0x94, 0x10},
765 {0xd1, 0x21, 0x68, 0x7a, 0x0c, 0x00, 0x00, 0x10},
766 {0xd1, 0x21, 0x6c, 0x11, 0x33, 0x22, 0x00, 0x10},
767 {0xd1, 0x21, 0x70, 0x11, 0x00, 0x10, 0x50, 0x10},
768 {0xd1, 0x21, 0x74, 0x20, 0x06, 0x00, 0xb5, 0x10},
769 {0xd1, 0x21, 0x78, 0x8a, 0x00, 0x00, 0x00, 0x10},
770 {0xb1, 0x21, 0x7c, 0x00, 0x43, 0x00, 0x00, 0x10},
772 {0xd1, 0x21, 0x21, 0x86, 0x00, 0xde, 0xa0, 0x10},
773 /* {0xd1, 0x21, 0x25, 0x80, 0x32, 0xfe, 0xa0, 0x10}, jfm done */
774 /* {0xd1, 0x21, 0x29, 0x00, 0x91, 0x00, 0x88, 0x10}, jfm done */
775 /* {0xb1, 0x21, 0x2d, 0x85, 0x00, 0x00, 0x00, 0x10}, set by setfreq */
778 static const u8 ov7648_sensor_param1
[][8] = {
779 /* {0xa1, 0x21, 0x12, 0x08, 0x00, 0x00, 0x00, 0x10}, jfm done */
780 /* {0xa1, 0x21, 0x75, 0x06, 0x00, 0x00, 0x00, 0x10}, * COMN
782 {0xa1, 0x21, 0x19, 0x02, 0x00, 0x00, 0x00, 0x10},
783 {0xa1, 0x21, 0x10, 0x32, 0x00, 0x00, 0x00, 0x10},
784 /* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
785 /* {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10}, * GAIN - def */
786 /* {0xb1, 0x21, 0x01, 0x6c, 0x6c, 0x00, 0x00, 0x10}, * B R - def: 80 */
788 {0xa1, 0x21, 0x11, 0x81, 0x00, 0x00, 0x00, 0x10}, /* CLKRC */
789 /* {0xa1, 0x21, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
790 /* {0xa1, 0x21, 0x16, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
791 /* {0xa1, 0x21, 0x2a, 0x91, 0x00, 0x00, 0x00, 0x10}, jfm done */
792 /* {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, jfm done */
793 /* {0xb1, 0x21, 0x01, 0x64, 0x84, 0x00, 0x00, 0x10}, * B R - def: 80 */
798 static const u8 ov7660_sensor_init
[][8] = {
799 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset SCCB */
800 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
801 {0xa1, 0x21, 0x12, 0x05, 0x00, 0x00, 0x00, 0x10},
802 /* Outformat = rawRGB */
803 {0xa1, 0x21, 0x13, 0xb8, 0x00, 0x00, 0x00, 0x10}, /* init COM8 */
804 {0xd1, 0x21, 0x00, 0x01, 0x74, 0x92, 0x00, 0x10},
805 /* GAIN BLUE RED VREF */
806 {0xd1, 0x21, 0x04, 0x00, 0x7d, 0x62, 0x00, 0x10},
807 /* COM 1 BAVE GEAVE AECHH */
808 {0xb1, 0x21, 0x08, 0x83, 0x01, 0x00, 0x00, 0x10}, /* RAVE COM2 */
809 {0xd1, 0x21, 0x0c, 0x00, 0x08, 0x04, 0x4f, 0x10}, /* COM 3 4 5 6 */
810 {0xd1, 0x21, 0x10, 0x7f, 0x40, 0x05, 0xff, 0x10},
811 /* AECH CLKRC COM7 COM8 */
812 {0xc1, 0x21, 0x14, 0x2c, 0x00, 0x02, 0x00, 0x10}, /* COM9 COM10 */
813 {0xd1, 0x21, 0x17, 0x10, 0x60, 0x02, 0x7b, 0x10},
814 /* HSTART HSTOP VSTRT VSTOP */
815 {0xa1, 0x21, 0x1b, 0x02, 0x00, 0x00, 0x00, 0x10}, /* PSHFT */
816 {0xb1, 0x21, 0x1e, 0x01, 0x0e, 0x00, 0x00, 0x10}, /* MVFP LAEC */
817 {0xd1, 0x21, 0x20, 0x07, 0x07, 0x07, 0x07, 0x10},
818 /* BOS GBOS GROS ROS (BGGR offset) */
819 /* {0xd1, 0x21, 0x24, 0x68, 0x58, 0xd4, 0x80, 0x10}, */
820 {0xd1, 0x21, 0x24, 0x78, 0x68, 0xd4, 0x80, 0x10},
821 /* AEW AEB VPT BBIAS */
822 {0xd1, 0x21, 0x28, 0x80, 0x30, 0x00, 0x00, 0x10},
823 /* GbBIAS RSVD EXHCH EXHCL */
824 {0xd1, 0x21, 0x2c, 0x80, 0x00, 0x00, 0x62, 0x10},
825 /* RBIAS ADVFL ASDVFH YAVE */
826 {0xc1, 0x21, 0x30, 0x08, 0x30, 0xb4, 0x00, 0x10},
827 /* HSYST HSYEN HREF */
828 {0xd1, 0x21, 0x33, 0x00, 0x07, 0x84, 0x00, 0x10}, /* reserved */
829 {0xd1, 0x21, 0x37, 0x0c, 0x02, 0x43, 0x00, 0x10},
830 /* ADC ACOM OFON TSLB */
831 {0xd1, 0x21, 0x3b, 0x02, 0x6c, 0x19, 0x0e, 0x10},
832 /* COM11 COM12 COM13 COM14 */
833 {0xd1, 0x21, 0x3f, 0x41, 0xc1, 0x22, 0x08, 0x10},
834 /* EDGE COM15 COM16 COM17 */
835 {0xd1, 0x21, 0x43, 0xf0, 0x10, 0x78, 0xa8, 0x10}, /* reserved */
836 {0xd1, 0x21, 0x47, 0x60, 0x80, 0x00, 0x00, 0x10}, /* reserved */
837 {0xd1, 0x21, 0x4b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* reserved */
838 {0xd1, 0x21, 0x4f, 0x46, 0x36, 0x0f, 0x17, 0x10}, /* MTX 1 2 3 4 */
839 {0xd1, 0x21, 0x53, 0x7f, 0x96, 0x40, 0x40, 0x10}, /* MTX 5 6 7 8 */
840 {0xb1, 0x21, 0x57, 0x40, 0x0f, 0x00, 0x00, 0x10}, /* MTX9 MTXS */
841 {0xd1, 0x21, 0x59, 0xba, 0x9a, 0x22, 0xb9, 0x10}, /* reserved */
842 {0xd1, 0x21, 0x5d, 0x9b, 0x10, 0xf0, 0x05, 0x10}, /* reserved */
843 {0xa1, 0x21, 0x61, 0x60, 0x00, 0x00, 0x00, 0x10}, /* reserved */
844 {0xd1, 0x21, 0x62, 0x00, 0x00, 0x50, 0x30, 0x10},
845 /* LCC1 LCC2 LCC3 LCC4 */
846 {0xa1, 0x21, 0x66, 0x00, 0x00, 0x00, 0x00, 0x10}, /* LCC5 */
847 {0xd1, 0x21, 0x67, 0x80, 0x7a, 0x90, 0x80, 0x10}, /* MANU */
848 {0xa1, 0x21, 0x6b, 0x0a, 0x00, 0x00, 0x00, 0x10},
849 /* band gap reference [0:3] DBLV */
850 {0xd1, 0x21, 0x6c, 0x30, 0x48, 0x80, 0x74, 0x10}, /* gamma curve */
851 {0xd1, 0x21, 0x70, 0x64, 0x60, 0x5c, 0x58, 0x10}, /* gamma curve */
852 {0xd1, 0x21, 0x74, 0x54, 0x4c, 0x40, 0x38, 0x10}, /* gamma curve */
853 {0xd1, 0x21, 0x78, 0x34, 0x30, 0x2f, 0x2b, 0x10}, /* gamma curve */
854 {0xd1, 0x21, 0x7c, 0x03, 0x07, 0x17, 0x34, 0x10}, /* gamma curve */
855 {0xd1, 0x21, 0x80, 0x41, 0x4d, 0x58, 0x63, 0x10}, /* gamma curve */
856 {0xd1, 0x21, 0x84, 0x6e, 0x77, 0x87, 0x95, 0x10}, /* gamma curve */
857 {0xc1, 0x21, 0x88, 0xaf, 0xc7, 0xdf, 0x00, 0x10}, /* gamma curve */
858 {0xc1, 0x21, 0x8b, 0x99, 0x99, 0xcf, 0x00, 0x10}, /* reserved */
859 {0xb1, 0x21, 0x92, 0x00, 0x00, 0x00, 0x00, 0x10}, /* DM_LNL/H */
860 /* not in all ms-win traces*/
861 {0xa1, 0x21, 0xa1, 0x00, 0x00, 0x00, 0x00, 0x10},
864 static const u8 ov7660_sensor_param1
[][8] = {
865 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10}, /* MVFP */
866 /* bits[3..0]reserved */
867 {0xa1, 0x21, 0x1e, 0x01, 0x00, 0x00, 0x00, 0x10},
868 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
869 /* VREF vertical frame ctrl */
870 {0xa1, 0x21, 0x03, 0x00, 0x00, 0x00, 0x00, 0x10},
871 {0xa1, 0x21, 0x10, 0x20, 0x00, 0x00, 0x00, 0x10}, /* AECH 0x20 */
872 {0xa1, 0x21, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFL */
873 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10}, /* ADVFH */
874 {0xa1, 0x21, 0x00, 0x1f, 0x00, 0x00, 0x00, 0x10}, /* GAIN */
875 /* {0xb1, 0x21, 0x01, 0x78, 0x78, 0x00, 0x00, 0x10}, * BLUE */
876 /****** (some exchanges in the win trace) ******/
878 {0xa1, 0x21, 0x93, 0x00, 0x00, 0x00, 0x00, 0x10},/* dummy line hight */
879 {0xa1, 0x21, 0x92, 0x25, 0x00, 0x00, 0x00, 0x10}, /* dummy line low */
880 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCH */
881 {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10}, /* EXHCL */
882 /* {0xa1, 0x21, 0x02, 0x90, 0x00, 0x00, 0x00, 0x10}, * RED */
883 /****** (some exchanges in the win trace) ******/
884 /******!! startsensor KO if changed !!****/
886 {0xa1, 0x21, 0x93, 0x01, 0x00, 0x00, 0x00, 0x10},
887 {0xa1, 0x21, 0x92, 0xff, 0x00, 0x00, 0x00, 0x10},
888 {0xa1, 0x21, 0x2a, 0x00, 0x00, 0x00, 0x00, 0x10},
889 {0xa1, 0x21, 0x2b, 0xc3, 0x00, 0x00, 0x00, 0x10},
893 static const u8 po1030_sensor_init
[][8] = {
894 /* the sensor registers are described in m5602/m5602_po1030.h */
895 {0xa1, 0x6e, 0x3f, 0x20, 0x00, 0x00, 0x00, 0x10}, /* sensor reset */
896 {DELAY
, 0x14, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 20ms */
897 {0xa1, 0x6e, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x10},
898 {0xa1, 0x6e, 0x3e, 0x00, 0x00, 0x00, 0x00, 0x10},
899 {0xd1, 0x6e, 0x04, 0x02, 0xb1, 0x02, 0x39, 0x10},
900 {0xd1, 0x6e, 0x08, 0x00, 0x01, 0x00, 0x00, 0x10},
901 {0xd1, 0x6e, 0x0c, 0x02, 0x7f, 0x01, 0xe0, 0x10},
902 {0xd1, 0x6e, 0x12, 0x03, 0x02, 0x00, 0x03, 0x10},
903 {0xd1, 0x6e, 0x16, 0x85, 0x40, 0x4a, 0x40, 0x10}, /* r/g1/b/g2 gains */
904 {0xc1, 0x6e, 0x1a, 0x00, 0x80, 0x00, 0x00, 0x10},
905 {0xd1, 0x6e, 0x1d, 0x08, 0x03, 0x00, 0x00, 0x10},
906 {0xd1, 0x6e, 0x23, 0x00, 0xb0, 0x00, 0x94, 0x10},
907 {0xd1, 0x6e, 0x27, 0x58, 0x00, 0x00, 0x00, 0x10},
908 {0xb1, 0x6e, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10},
909 {0xd1, 0x6e, 0x2d, 0x14, 0x35, 0x61, 0x84, 0x10}, /* gamma corr */
910 {0xd1, 0x6e, 0x31, 0xa2, 0xbd, 0xd8, 0xff, 0x10},
911 {0xd1, 0x6e, 0x35, 0x06, 0x1e, 0x12, 0x02, 0x10}, /* color matrix */
912 {0xd1, 0x6e, 0x39, 0xaa, 0x53, 0x37, 0xd5, 0x10},
913 {0xa1, 0x6e, 0x3d, 0xf2, 0x00, 0x00, 0x00, 0x10},
914 {0xd1, 0x6e, 0x3e, 0x00, 0x00, 0x80, 0x03, 0x10},
915 {0xd1, 0x6e, 0x42, 0x03, 0x00, 0x00, 0x00, 0x10},
916 {0xc1, 0x6e, 0x46, 0x00, 0x80, 0x80, 0x00, 0x10},
917 {0xd1, 0x6e, 0x4b, 0x02, 0xef, 0x08, 0xcd, 0x10},
918 {0xd1, 0x6e, 0x4f, 0x00, 0xd0, 0x00, 0xa0, 0x10},
919 {0xd1, 0x6e, 0x53, 0x01, 0xaa, 0x01, 0x40, 0x10},
920 {0xd1, 0x6e, 0x5a, 0x50, 0x04, 0x30, 0x03, 0x10}, /* raw rgb bayer */
921 {0xa1, 0x6e, 0x5e, 0x00, 0x00, 0x00, 0x00, 0x10},
922 {0xd1, 0x6e, 0x5f, 0x10, 0x40, 0xff, 0x00, 0x10},
924 {0xd1, 0x6e, 0x63, 0x40, 0x40, 0x00, 0x00, 0x10},
925 {0xd1, 0x6e, 0x67, 0x00, 0x00, 0x00, 0x00, 0x10},
926 {0xd1, 0x6e, 0x6b, 0x00, 0x00, 0x00, 0x00, 0x10},
927 {0xd1, 0x6e, 0x6f, 0x00, 0x00, 0x00, 0x00, 0x10},
928 {0xc1, 0x6e, 0x73, 0x10, 0x80, 0xeb, 0x00, 0x10},
931 static const u8 po1030_sensor_param1
[][8] = {
932 /* from ms-win traces - these values change with auto gain/expo/wb.. */
933 {0xa1, 0x6e, 0x1e, 0x03, 0x00, 0x00, 0x00, 0x10},
934 {0xa1, 0x6e, 0x1e, 0x03, 0x00, 0x00, 0x00, 0x10},
936 {0xc1, 0x6e, 0x1a, 0x02, 0xd4, 0xa4, 0x00, 0x10}, /* integlines */
937 {0xa1, 0x6e, 0x15, 0x04, 0x00, 0x00, 0x00, 0x10}, /* global gain */
938 {0xc1, 0x6e, 0x16, 0x40, 0x40, 0x40, 0x00, 0x10}, /* r/g1/b gains */
940 {0xa1, 0x6e, 0x1d, 0x08, 0x00, 0x00, 0x00, 0x10}, /* control1 */
941 {0xa1, 0x6e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x10}, /* frameheight */
942 {0xa1, 0x6e, 0x07, 0xd5, 0x00, 0x00, 0x00, 0x10},
943 /* {0xc1, 0x6e, 0x16, 0x49, 0x40, 0x45, 0x00, 0x10}, */
947 static const u8 po2030n_sensor_init
[][8] = {
948 {0xa1, 0x6e, 0x1e, 0x1a, 0x00, 0x00, 0x00, 0x10},
949 {0xa1, 0x6e, 0x1f, 0x99, 0x00, 0x00, 0x00, 0x10},
950 {DELAY
, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 10ms */
951 {0xa1, 0x6e, 0x1e, 0x0a, 0x00, 0x00, 0x00, 0x10},
952 {0xa1, 0x6e, 0x1f, 0x19, 0x00, 0x00, 0x00, 0x10},
953 {DELAY
, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 10ms */
954 {0xa1, 0x6e, 0x20, 0x44, 0x00, 0x00, 0x00, 0x10},
955 {0xa1, 0x6e, 0x04, 0x03, 0x00, 0x00, 0x00, 0x10},
956 {0xa1, 0x6e, 0x05, 0x70, 0x00, 0x00, 0x00, 0x10},
957 {0xa1, 0x6e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x10},
958 {0xa1, 0x6e, 0x07, 0x25, 0x00, 0x00, 0x00, 0x10},
959 {0xd1, 0x6e, 0x08, 0x00, 0xd0, 0x00, 0x08, 0x10},
960 {0xd1, 0x6e, 0x0c, 0x03, 0x50, 0x01, 0xe8, 0x10},
961 {0xd1, 0x6e, 0x1d, 0x20, 0x0a, 0x19, 0x44, 0x10},
962 {0xd1, 0x6e, 0x21, 0x00, 0x00, 0x00, 0x00, 0x10},
963 {0xd1, 0x6e, 0x25, 0x00, 0x00, 0x00, 0x00, 0x10},
964 {0xd1, 0x6e, 0x29, 0x00, 0x00, 0x00, 0x00, 0x10},
965 {0xd1, 0x6e, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10},
966 {0xd1, 0x6e, 0x31, 0x00, 0x00, 0x00, 0x00, 0x10},
967 {0xd1, 0x6e, 0x35, 0x00, 0x00, 0x00, 0x00, 0x10},
968 {0xd1, 0x6e, 0x39, 0x00, 0x00, 0x00, 0x00, 0x10},
969 {0xd1, 0x6e, 0x3d, 0x00, 0x00, 0x00, 0x00, 0x10},
970 {0xd1, 0x6e, 0x41, 0x00, 0x00, 0x00, 0x00, 0x10},
971 {0xd1, 0x6e, 0x45, 0x00, 0x00, 0x00, 0x00, 0x10},
972 {0xd1, 0x6e, 0x49, 0x00, 0x00, 0x00, 0x00, 0x10},
973 {0xd1, 0x6e, 0x4d, 0x00, 0x00, 0x00, 0xed, 0x10},
974 {0xd1, 0x6e, 0x51, 0x17, 0x4a, 0x2f, 0xc0, 0x10},
975 {0xd1, 0x6e, 0x55, 0x00, 0x00, 0x00, 0x00, 0x10},
976 {0xd1, 0x6e, 0x59, 0x00, 0x00, 0x00, 0x00, 0x10},
977 {0xd1, 0x6e, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x10},
978 {0xd1, 0x6e, 0x61, 0x00, 0x00, 0x00, 0x00, 0x10},
979 {0xd1, 0x6e, 0x65, 0x00, 0x00, 0x00, 0x00, 0x10},
980 {0xd1, 0x6e, 0x69, 0x00, 0x00, 0x00, 0x00, 0x10},
981 {0xd1, 0x6e, 0x6d, 0x00, 0x00, 0x00, 0x00, 0x10},
982 {0xd1, 0x6e, 0x71, 0x00, 0x00, 0x00, 0x00, 0x10},
983 {0xd1, 0x6e, 0x75, 0x00, 0x00, 0x00, 0x00, 0x10},
984 {0xd1, 0x6e, 0x79, 0x00, 0x00, 0x00, 0x00, 0x10},
985 {0xd1, 0x6e, 0x7d, 0x00, 0x00, 0x00, 0x00, 0x10},
986 {0xd1, 0x6e, 0x81, 0x00, 0x00, 0x00, 0x00, 0x10},
987 {0xd1, 0x6e, 0x85, 0x00, 0x00, 0x00, 0x08, 0x10},
988 {0xd1, 0x6e, 0x89, 0x01, 0xe8, 0x00, 0x01, 0x10},
989 {0xa1, 0x6e, 0x8d, 0x00, 0x00, 0x00, 0x00, 0x10},
990 {0xd1, 0x6e, 0x21, 0x00, 0x00, 0x00, 0x00, 0x10},
991 {0xd1, 0x6e, 0x25, 0x00, 0x00, 0x00, 0x01, 0x10},
992 {0xd1, 0x6e, 0x29, 0xe6, 0x00, 0xbd, 0x03, 0x10},
993 {0xd1, 0x6e, 0x2d, 0x41, 0x38, 0x68, 0x40, 0x10},
994 {0xd1, 0x6e, 0x31, 0x2b, 0x00, 0x36, 0x00, 0x10},
995 {0xd1, 0x6e, 0x35, 0x30, 0x30, 0x08, 0x00, 0x10},
996 {0xd1, 0x6e, 0x39, 0x00, 0x00, 0x33, 0x06, 0x10},
997 {0xb1, 0x6e, 0x3d, 0x06, 0x02, 0x00, 0x00, 0x10},
1000 static const u8 po2030n_sensor_param1
[][8] = {
1001 {0xa1, 0x6e, 0x1a, 0x01, 0x00, 0x00, 0x00, 0x10},
1002 {DELAY
, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 8ms */
1003 {0xa1, 0x6e, 0x1b, 0xf4, 0x00, 0x00, 0x00, 0x10},
1004 {0xa1, 0x6e, 0x15, 0x04, 0x00, 0x00, 0x00, 0x10},
1005 {0xd1, 0x6e, 0x16, 0x40, 0x40, 0x40, 0x40, 0x10}, /* RGBG gains */
1007 {0xa1, 0x6e, 0x1d, 0x00, 0x00, 0x00, 0x00, 0x10},
1008 {0xa1, 0x6e, 0x04, 0x03, 0x00, 0x00, 0x00, 0x10},
1009 {0xa1, 0x6e, 0x05, 0x6f, 0x00, 0x00, 0x00, 0x10},
1010 {0xa1, 0x6e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x10},
1011 {0xa1, 0x6e, 0x07, 0x25, 0x00, 0x00, 0x00, 0x10},
1015 static const u8 soi768_sensor_init
[][8] = {
1016 {0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10}, /* reset */
1017 {DELAY
, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /* delay 96ms */
1018 {0xa1, 0x21, 0x12, 0x00, 0x00, 0x00, 0x00, 0x10},
1019 {0xa1, 0x21, 0x13, 0x80, 0x00, 0x00, 0x00, 0x10},
1020 {0xa1, 0x21, 0x0f, 0x03, 0x00, 0x00, 0x00, 0x10},
1021 {0xa1, 0x21, 0x19, 0x00, 0x00, 0x00, 0x00, 0x10},
1024 static const u8 soi768_sensor_param1
[][8] = {
1025 {0xa1, 0x21, 0x10, 0x10, 0x00, 0x00, 0x00, 0x10},
1026 {0xa1, 0x21, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10},
1027 {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10},
1028 {0xa1, 0x21, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1029 {0xb1, 0x21, 0x01, 0x7f, 0x7f, 0x00, 0x00, 0x10},
1031 /* {0xa1, 0x21, 0x2e, 0x00, 0x00, 0x00, 0x00, 0x10}, */
1032 /* {0xa1, 0x21, 0x2d, 0x25, 0x00, 0x00, 0x00, 0x10}, */
1033 {0xa1, 0x21, 0x2b, 0x00, 0x00, 0x00, 0x00, 0x10},
1034 /* {0xb1, 0x21, 0x2d, 0x00, 0x00, 0x00, 0x00, 0x10}, */
1035 {0xa1, 0x21, 0x02, 0x8d, 0x00, 0x00, 0x00, 0x10},
1036 /* the next sequence should be used for auto gain */
1037 {0xa1, 0x21, 0x00, 0x07, 0x00, 0x00, 0x00, 0x10},
1038 /* global gain ? : 07 - change with 0x15 at the end */
1039 {0xa1, 0x21, 0x10, 0x3f, 0x00, 0x00, 0x00, 0x10}, /* ???? : 063f */
1040 {0xa1, 0x21, 0x04, 0x06, 0x00, 0x00, 0x00, 0x10},
1041 {0xb1, 0x21, 0x2d, 0x63, 0x03, 0x00, 0x00, 0x10},
1042 /* exposure ? : 0200 - change with 0x1e at the end */
1046 static const u8 sp80708_sensor_init
[][8] = {
1047 {0xa1, 0x18, 0x06, 0xf9, 0x00, 0x00, 0x00, 0x10},
1048 {0xa1, 0x18, 0x09, 0x1f, 0x00, 0x00, 0x00, 0x10},
1049 {0xa1, 0x18, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x10},
1050 {0xa1, 0x18, 0x0d, 0xc0, 0x00, 0x00, 0x00, 0x10},
1051 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
1052 {0xa1, 0x18, 0x0f, 0x0f, 0x00, 0x00, 0x00, 0x10},
1053 {0xa1, 0x18, 0x10, 0x40, 0x00, 0x00, 0x00, 0x10},
1054 {0xa1, 0x18, 0x11, 0x4e, 0x00, 0x00, 0x00, 0x10},
1055 {0xa1, 0x18, 0x12, 0x53, 0x00, 0x00, 0x00, 0x10},
1056 {0xa1, 0x18, 0x15, 0x80, 0x00, 0x00, 0x00, 0x10},
1057 {0xa1, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x10},
1058 {0xa1, 0x18, 0x19, 0x18, 0x00, 0x00, 0x00, 0x10},
1059 {0xa1, 0x18, 0x1a, 0x10, 0x00, 0x00, 0x00, 0x10},
1060 {0xa1, 0x18, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x10},
1061 {0xa1, 0x18, 0x1c, 0x28, 0x00, 0x00, 0x00, 0x10},
1062 {0xa1, 0x18, 0x1d, 0x02, 0x00, 0x00, 0x00, 0x10},
1063 {0xa1, 0x18, 0x1e, 0x10, 0x00, 0x00, 0x00, 0x10},
1064 {0xa1, 0x18, 0x26, 0x04, 0x00, 0x00, 0x00, 0x10},
1065 {0xa1, 0x18, 0x27, 0x1e, 0x00, 0x00, 0x00, 0x10},
1066 {0xa1, 0x18, 0x28, 0x5a, 0x00, 0x00, 0x00, 0x10},
1067 {0xa1, 0x18, 0x29, 0x28, 0x00, 0x00, 0x00, 0x10},
1068 {0xa1, 0x18, 0x2a, 0x78, 0x00, 0x00, 0x00, 0x10},
1069 {0xa1, 0x18, 0x2b, 0x01, 0x00, 0x00, 0x00, 0x10},
1070 {0xa1, 0x18, 0x2c, 0xf7, 0x00, 0x00, 0x00, 0x10},
1071 {0xa1, 0x18, 0x2d, 0x2d, 0x00, 0x00, 0x00, 0x10},
1072 {0xa1, 0x18, 0x2e, 0xd5, 0x00, 0x00, 0x00, 0x10},
1073 {0xa1, 0x18, 0x39, 0x42, 0x00, 0x00, 0x00, 0x10},
1074 {0xa1, 0x18, 0x3a, 0x67, 0x00, 0x00, 0x00, 0x10},
1075 {0xa1, 0x18, 0x3b, 0x87, 0x00, 0x00, 0x00, 0x10},
1076 {0xa1, 0x18, 0x3c, 0xa3, 0x00, 0x00, 0x00, 0x10},
1077 {0xa1, 0x18, 0x3d, 0xb0, 0x00, 0x00, 0x00, 0x10},
1078 {0xa1, 0x18, 0x3e, 0xbc, 0x00, 0x00, 0x00, 0x10},
1079 {0xa1, 0x18, 0x3f, 0xc8, 0x00, 0x00, 0x00, 0x10},
1080 {0xa1, 0x18, 0x40, 0xd4, 0x00, 0x00, 0x00, 0x10},
1081 {0xa1, 0x18, 0x41, 0xdf, 0x00, 0x00, 0x00, 0x10},
1082 {0xa1, 0x18, 0x42, 0xea, 0x00, 0x00, 0x00, 0x10},
1083 {0xa1, 0x18, 0x43, 0xf5, 0x00, 0x00, 0x00, 0x10},
1084 {0xa1, 0x18, 0x45, 0x80, 0x00, 0x00, 0x00, 0x10},
1085 {0xa1, 0x18, 0x46, 0x60, 0x00, 0x00, 0x00, 0x10},
1086 {0xa1, 0x18, 0x47, 0x50, 0x00, 0x00, 0x00, 0x10},
1087 {0xa1, 0x18, 0x48, 0x30, 0x00, 0x00, 0x00, 0x10},
1088 {0xa1, 0x18, 0x49, 0x01, 0x00, 0x00, 0x00, 0x10},
1089 {0xa1, 0x18, 0x4d, 0xae, 0x00, 0x00, 0x00, 0x10},
1090 {0xa1, 0x18, 0x4e, 0x03, 0x00, 0x00, 0x00, 0x10},
1091 {0xa1, 0x18, 0x4f, 0x66, 0x00, 0x00, 0x00, 0x10},
1092 {0xa1, 0x18, 0x50, 0x1c, 0x00, 0x00, 0x00, 0x10},
1093 {0xa1, 0x18, 0x44, 0x10, 0x00, 0x00, 0x00, 0x10},
1094 {0xa1, 0x18, 0x4a, 0x30, 0x00, 0x00, 0x00, 0x10},
1095 {0xa1, 0x18, 0x51, 0x80, 0x00, 0x00, 0x00, 0x10},
1096 {0xa1, 0x18, 0x52, 0x80, 0x00, 0x00, 0x00, 0x10},
1097 {0xa1, 0x18, 0x53, 0x80, 0x00, 0x00, 0x00, 0x10},
1098 {0xa1, 0x18, 0x54, 0x80, 0x00, 0x00, 0x00, 0x10},
1099 {0xa1, 0x18, 0x55, 0x80, 0x00, 0x00, 0x00, 0x10},
1100 {0xa1, 0x18, 0x56, 0x80, 0x00, 0x00, 0x00, 0x10},
1101 {0xa1, 0x18, 0x57, 0xe0, 0x00, 0x00, 0x00, 0x10},
1102 {0xa1, 0x18, 0x58, 0xc0, 0x00, 0x00, 0x00, 0x10},
1103 {0xa1, 0x18, 0x59, 0xab, 0x00, 0x00, 0x00, 0x10},
1104 {0xa1, 0x18, 0x5a, 0xa0, 0x00, 0x00, 0x00, 0x10},
1105 {0xa1, 0x18, 0x5b, 0x99, 0x00, 0x00, 0x00, 0x10},
1106 {0xa1, 0x18, 0x5c, 0x90, 0x00, 0x00, 0x00, 0x10},
1107 {0xa1, 0x18, 0x5e, 0x24, 0x00, 0x00, 0x00, 0x10},
1108 {0xa1, 0x18, 0x5f, 0x00, 0x00, 0x00, 0x00, 0x10},
1109 {0xa1, 0x18, 0x60, 0x00, 0x00, 0x00, 0x00, 0x10},
1110 {0xa1, 0x18, 0x61, 0x73, 0x00, 0x00, 0x00, 0x10},
1111 {0xa1, 0x18, 0x63, 0x42, 0x00, 0x00, 0x00, 0x10},
1112 {0xa1, 0x18, 0x64, 0x42, 0x00, 0x00, 0x00, 0x10},
1113 {0xa1, 0x18, 0x65, 0x42, 0x00, 0x00, 0x00, 0x10},
1114 {0xa1, 0x18, 0x66, 0x24, 0x00, 0x00, 0x00, 0x10},
1115 {0xa1, 0x18, 0x67, 0x24, 0x00, 0x00, 0x00, 0x10},
1116 {0xa1, 0x18, 0x68, 0x08, 0x00, 0x00, 0x00, 0x10},
1117 {0xa1, 0x18, 0x2f, 0xc9, 0x00, 0x00, 0x00, 0x10},
1120 static const u8 sp80708_sensor_param1
[][8] = {
1121 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
1122 {0xa1, 0x18, 0x0c, 0x04, 0x00, 0x00, 0x00, 0x10},
1123 {0xa1, 0x18, 0x03, 0x01, 0x00, 0x00, 0x00, 0x10},
1124 {0xa1, 0x18, 0x04, 0xa4, 0x00, 0x00, 0x00, 0x10},
1125 {0xa1, 0x18, 0x14, 0x3f, 0x00, 0x00, 0x00, 0x10},
1126 {0xa1, 0x18, 0x5d, 0x80, 0x00, 0x00, 0x00, 0x10},
1127 {0xb1, 0x18, 0x11, 0x40, 0x40, 0x00, 0x00, 0x10},
1131 static const u8 (*sensor_init
[])[8] = {
1132 [SENSOR_ADCM1700
] = adcm1700_sensor_init
,
1133 [SENSOR_GC0307
] = gc0307_sensor_init
,
1134 [SENSOR_HV7131R
] = hv7131r_sensor_init
,
1135 [SENSOR_MI0360
] = mi0360_sensor_init
,
1136 [SENSOR_MI0360B
] = mi0360b_sensor_init
,
1137 [SENSOR_MO4000
] = mo4000_sensor_init
,
1138 [SENSOR_MT9V111
] = mt9v111_sensor_init
,
1139 [SENSOR_OM6802
] = om6802_sensor_init
,
1140 [SENSOR_OV7630
] = ov7630_sensor_init
,
1141 [SENSOR_OV7648
] = ov7648_sensor_init
,
1142 [SENSOR_OV7660
] = ov7660_sensor_init
,
1143 [SENSOR_PO1030
] = po1030_sensor_init
,
1144 [SENSOR_PO2030N
] = po2030n_sensor_init
,
1145 [SENSOR_SOI768
] = soi768_sensor_init
,
1146 [SENSOR_SP80708
] = sp80708_sensor_init
,
1149 /* read <len> bytes to gspca_dev->usb_buf */
1150 static void reg_r(struct gspca_dev
*gspca_dev
,
1155 if (gspca_dev
->usb_err
< 0)
1157 if (len
> USB_BUF_SZ
) {
1158 gspca_err(gspca_dev
, "reg_r: buffer overflow\n");
1162 ret
= usb_control_msg(gspca_dev
->dev
,
1163 usb_rcvctrlpipe(gspca_dev
->dev
, 0),
1165 USB_DIR_IN
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1167 gspca_dev
->usb_buf
, len
,
1169 gspca_dbg(gspca_dev
, D_USBI
, "reg_r [%02x] -> %02x\n",
1170 value
, gspca_dev
->usb_buf
[0]);
1172 pr_err("reg_r err %d\n", ret
);
1173 gspca_dev
->usb_err
= ret
;
1175 * Make sure the buffer is zeroed to avoid uninitialized
1178 memset(gspca_dev
->usb_buf
, 0, USB_BUF_SZ
);
1182 static void reg_w1(struct gspca_dev
*gspca_dev
,
1188 if (gspca_dev
->usb_err
< 0)
1190 gspca_dbg(gspca_dev
, D_USBO
, "reg_w1 [%04x] = %02x\n", value
, data
);
1191 gspca_dev
->usb_buf
[0] = data
;
1192 ret
= usb_control_msg(gspca_dev
->dev
,
1193 usb_sndctrlpipe(gspca_dev
->dev
, 0),
1195 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1198 gspca_dev
->usb_buf
, 1,
1201 pr_err("reg_w1 err %d\n", ret
);
1202 gspca_dev
->usb_err
= ret
;
1205 static void reg_w(struct gspca_dev
*gspca_dev
,
1212 if (gspca_dev
->usb_err
< 0)
1214 gspca_dbg(gspca_dev
, D_USBO
, "reg_w [%04x] = %02x %02x ..\n",
1215 value
, buffer
[0], buffer
[1]);
1217 if (len
> USB_BUF_SZ
) {
1218 gspca_err(gspca_dev
, "reg_w: buffer overflow\n");
1222 memcpy(gspca_dev
->usb_buf
, buffer
, len
);
1223 ret
= usb_control_msg(gspca_dev
->dev
,
1224 usb_sndctrlpipe(gspca_dev
->dev
, 0),
1226 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1228 gspca_dev
->usb_buf
, len
,
1231 pr_err("reg_w err %d\n", ret
);
1232 gspca_dev
->usb_err
= ret
;
1236 /* I2C write 1 byte */
1237 static void i2c_w1(struct gspca_dev
*gspca_dev
, u8 reg
, u8 val
)
1239 struct sd
*sd
= (struct sd
*) gspca_dev
;
1242 if (gspca_dev
->usb_err
< 0)
1244 gspca_dbg(gspca_dev
, D_USBO
, "i2c_w1 [%02x] = %02x\n", reg
, val
);
1245 switch (sd
->sensor
) {
1246 case SENSOR_ADCM1700
:
1248 case SENSOR_GC0307
: /* i2c command = a0 (100 kHz) */
1249 gspca_dev
->usb_buf
[0] = 0x80 | (2 << 4);
1251 default: /* i2c command = a1 (400 kHz) */
1252 gspca_dev
->usb_buf
[0] = 0x81 | (2 << 4);
1255 gspca_dev
->usb_buf
[1] = sd
->i2c_addr
;
1256 gspca_dev
->usb_buf
[2] = reg
;
1257 gspca_dev
->usb_buf
[3] = val
;
1258 gspca_dev
->usb_buf
[4] = 0;
1259 gspca_dev
->usb_buf
[5] = 0;
1260 gspca_dev
->usb_buf
[6] = 0;
1261 gspca_dev
->usb_buf
[7] = 0x10;
1262 ret
= usb_control_msg(gspca_dev
->dev
,
1263 usb_sndctrlpipe(gspca_dev
->dev
, 0),
1265 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1266 0x08, /* value = i2c */
1268 gspca_dev
->usb_buf
, 8,
1272 pr_err("i2c_w1 err %d\n", ret
);
1273 gspca_dev
->usb_err
= ret
;
1277 /* I2C write 8 bytes */
1278 static void i2c_w8(struct gspca_dev
*gspca_dev
,
1283 if (gspca_dev
->usb_err
< 0)
1285 gspca_dbg(gspca_dev
, D_USBO
, "i2c_w8 [%02x] = %02x ..\n",
1286 buffer
[2], buffer
[3]);
1287 memcpy(gspca_dev
->usb_buf
, buffer
, 8);
1288 ret
= usb_control_msg(gspca_dev
->dev
,
1289 usb_sndctrlpipe(gspca_dev
->dev
, 0),
1291 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
1292 0x08, 0, /* value, index */
1293 gspca_dev
->usb_buf
, 8,
1297 pr_err("i2c_w8 err %d\n", ret
);
1298 gspca_dev
->usb_err
= ret
;
1302 /* sensor read 'len' (1..5) bytes in gspca_dev->usb_buf */
1303 static void i2c_r(struct gspca_dev
*gspca_dev
, u8 reg
, int len
)
1305 struct sd
*sd
= (struct sd
*) gspca_dev
;
1308 switch (sd
->sensor
) {
1309 case SENSOR_ADCM1700
:
1311 case SENSOR_GC0307
: /* i2c command = a0 (100 kHz) */
1312 mode
[0] = 0x80 | 0x10;
1314 default: /* i2c command = 91 (400 kHz) */
1315 mode
[0] = 0x81 | 0x10;
1318 mode
[1] = sd
->i2c_addr
;
1325 i2c_w8(gspca_dev
, mode
);
1327 mode
[0] = (mode
[0] & 0x81) | (len
<< 4) | 0x02;
1329 i2c_w8(gspca_dev
, mode
);
1331 reg_r(gspca_dev
, 0x0a, 5);
1334 static void i2c_w_seq(struct gspca_dev
*gspca_dev
,
1335 const u8 (*data
)[8])
1337 while ((*data
)[0] != 0) {
1338 if ((*data
)[0] != DELAY
)
1339 i2c_w8(gspca_dev
, *data
);
1346 /* check the ID of the hv7131 sensor */
1347 /* this sequence is needed because it activates the sensor */
1348 static void hv7131r_probe(struct gspca_dev
*gspca_dev
)
1350 i2c_w1(gspca_dev
, 0x02, 0); /* sensor wakeup */
1352 reg_w1(gspca_dev
, 0x02, 0x66); /* Gpio on */
1354 i2c_r(gspca_dev
, 0, 5); /* read sensor id */
1355 if (gspca_dev
->usb_buf
[0] == 0x02 /* chip ID (02 is R) */
1356 && gspca_dev
->usb_buf
[1] == 0x09
1357 && gspca_dev
->usb_buf
[2] == 0x01) {
1358 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor HV7131R found\n");
1361 pr_warn("Erroneous HV7131R ID 0x%02x 0x%02x 0x%02x\n",
1362 gspca_dev
->usb_buf
[0], gspca_dev
->usb_buf
[1],
1363 gspca_dev
->usb_buf
[2]);
1366 static void mi0360_probe(struct gspca_dev
*gspca_dev
)
1368 struct sd
*sd
= (struct sd
*) gspca_dev
;
1371 static const u8 probe_tb
[][4][8] = {
1373 {0xb0, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10},
1374 {0x90, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1375 {0xa2, 0x5d, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1376 {0xb0, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10}
1379 {0xb0, 0x5c, 0x01, 0x00, 0x04, 0x00, 0x00, 0x10},
1380 {0x90, 0x5c, 0x36, 0x00, 0x00, 0x00, 0x00, 0x10},
1381 {0xa2, 0x5c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10},
1386 for (i
= 0; i
< ARRAY_SIZE(probe_tb
); i
++) {
1387 reg_w1(gspca_dev
, 0x17, 0x62);
1388 reg_w1(gspca_dev
, 0x01, 0x08);
1389 for (j
= 0; j
< 3; j
++)
1390 i2c_w8(gspca_dev
, probe_tb
[i
][j
]);
1392 reg_r(gspca_dev
, 0x0a, 5);
1393 val
= (gspca_dev
->usb_buf
[3] << 8) | gspca_dev
->usb_buf
[4];
1394 if (probe_tb
[i
][3][0] != 0)
1395 i2c_w8(gspca_dev
, probe_tb
[i
][3]);
1396 reg_w1(gspca_dev
, 0x01, 0x29);
1397 reg_w1(gspca_dev
, 0x17, 0x42);
1401 if (gspca_dev
->usb_err
< 0)
1405 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor mi0360b\n");
1406 sd
->sensor
= SENSOR_MI0360B
;
1409 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor mt9v111\n");
1410 sd
->sensor
= SENSOR_MT9V111
;
1413 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor mi0360\n");
1416 gspca_dbg(gspca_dev
, D_PROBE
, "Unknown sensor %04x - forced to mi0360\n",
1422 static void ov7630_probe(struct gspca_dev
*gspca_dev
)
1424 struct sd
*sd
= (struct sd
*) gspca_dev
;
1428 reg_w1(gspca_dev
, 0x17, 0x62);
1429 reg_w1(gspca_dev
, 0x01, 0x08);
1430 sd
->i2c_addr
= 0x21;
1431 i2c_r(gspca_dev
, 0x0a, 2);
1432 val
= (gspca_dev
->usb_buf
[3] << 8) | gspca_dev
->usb_buf
[4];
1433 reg_w1(gspca_dev
, 0x01, 0x29);
1434 reg_w1(gspca_dev
, 0x17, 0x42);
1435 if (gspca_dev
->usb_err
< 0)
1437 if (val
== 0x7628) { /* soi768 */
1438 sd
->sensor
= SENSOR_SOI768
;
1439 /*fixme: only valid for 0c45:613e?*/
1440 gspca_dev
->cam
.input_flags
=
1441 V4L2_IN_ST_VFLIP
| V4L2_IN_ST_HFLIP
;
1442 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor soi768\n");
1445 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor ov%04x\n", val
);
1448 static void ov7648_probe(struct gspca_dev
*gspca_dev
)
1450 struct sd
*sd
= (struct sd
*) gspca_dev
;
1454 reg_w1(gspca_dev
, 0x17, 0x62);
1455 reg_w1(gspca_dev
, 0x01, 0x08);
1456 sd
->i2c_addr
= 0x21;
1457 i2c_r(gspca_dev
, 0x0a, 2);
1458 val
= (gspca_dev
->usb_buf
[3] << 8) | gspca_dev
->usb_buf
[4];
1459 reg_w1(gspca_dev
, 0x01, 0x29);
1460 reg_w1(gspca_dev
, 0x17, 0x42);
1461 if ((val
& 0xff00) == 0x7600) { /* ov76xx */
1462 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor ov%04x\n", val
);
1467 reg_w1(gspca_dev
, 0x17, 0x62);
1468 reg_w1(gspca_dev
, 0x01, 0x08);
1469 sd
->i2c_addr
= 0x6e;
1470 i2c_r(gspca_dev
, 0x00, 2);
1471 val
= (gspca_dev
->usb_buf
[3] << 8) | gspca_dev
->usb_buf
[4];
1472 reg_w1(gspca_dev
, 0x01, 0x29);
1473 reg_w1(gspca_dev
, 0x17, 0x42);
1474 if (gspca_dev
->usb_err
< 0)
1476 if (val
== 0x1030) { /* po1030 */
1477 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor po1030\n");
1478 sd
->sensor
= SENSOR_PO1030
;
1481 pr_err("Unknown sensor %04x\n", val
);
1484 /* 0c45:6142 sensor may be po2030n, gc0305 or gc0307 */
1485 static void po2030n_probe(struct gspca_dev
*gspca_dev
)
1487 struct sd
*sd
= (struct sd
*) gspca_dev
;
1491 reg_w1(gspca_dev
, 0x17, 0x62);
1492 reg_w1(gspca_dev
, 0x01, 0x08);
1493 reg_w1(gspca_dev
, 0x02, 0x22);
1494 sd
->i2c_addr
= 0x21;
1495 i2c_r(gspca_dev
, 0x00, 1);
1496 val
= gspca_dev
->usb_buf
[4];
1497 reg_w1(gspca_dev
, 0x01, 0x29); /* reset */
1498 reg_w1(gspca_dev
, 0x17, 0x42);
1499 if (val
== 0x99) { /* gc0307 (?) */
1500 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor gc0307\n");
1501 sd
->sensor
= SENSOR_GC0307
;
1506 reg_w1(gspca_dev
, 0x17, 0x62);
1507 reg_w1(gspca_dev
, 0x01, 0x0a);
1508 sd
->i2c_addr
= 0x6e;
1509 i2c_r(gspca_dev
, 0x00, 2);
1510 val
= (gspca_dev
->usb_buf
[3] << 8) | gspca_dev
->usb_buf
[4];
1511 reg_w1(gspca_dev
, 0x01, 0x29);
1512 reg_w1(gspca_dev
, 0x17, 0x42);
1513 if (gspca_dev
->usb_err
< 0)
1515 if (val
== 0x2030) {
1516 gspca_dbg(gspca_dev
, D_PROBE
, "Sensor po2030n\n");
1517 /* sd->sensor = SENSOR_PO2030N; */
1519 pr_err("Unknown sensor ID %04x\n", val
);
1523 /* this function is called at probe time */
1524 static int sd_config(struct gspca_dev
*gspca_dev
,
1525 const struct usb_device_id
*id
)
1527 struct sd
*sd
= (struct sd
*) gspca_dev
;
1530 sd
->bridge
= id
->driver_info
>> 16;
1531 sd
->sensor
= id
->driver_info
>> 8;
1532 sd
->flags
= id
->driver_info
;
1534 cam
= &gspca_dev
->cam
;
1535 if (sd
->sensor
== SENSOR_ADCM1700
) {
1536 cam
->cam_mode
= cif_mode
;
1537 cam
->nmodes
= ARRAY_SIZE(cif_mode
);
1539 cam
->cam_mode
= vga_mode
;
1540 cam
->nmodes
= ARRAY_SIZE(vga_mode
);
1542 cam
->npkt
= 24; /* 24 packets per ISOC message */
1545 sd
->quality
= QUALITY_DEF
;
1547 INIT_WORK(&sd
->work
, qual_upd
);
1552 /* this function is called at probe and resume time */
1553 static int sd_init(struct gspca_dev
*gspca_dev
)
1555 struct sd
*sd
= (struct sd
*) gspca_dev
;
1557 u8 regGpio
[] = { 0x29, 0x70 }; /* no audio */
1560 /* setup a selector by bridge */
1561 reg_w1(gspca_dev
, 0xf1, 0x01);
1562 reg_r(gspca_dev
, 0x00, 1);
1563 reg_w1(gspca_dev
, 0xf1, 0x00);
1564 reg_r(gspca_dev
, 0x00, 1); /* get sonix chip id */
1565 regF1
= gspca_dev
->usb_buf
[0];
1566 if (gspca_dev
->usb_err
< 0)
1567 return gspca_dev
->usb_err
;
1568 gspca_dbg(gspca_dev
, D_PROBE
, "Sonix chip id: %02x\n", regF1
);
1569 if (gspca_dev
->audio
)
1570 regGpio
[1] |= 0x04; /* with audio */
1571 switch (sd
->bridge
) {
1572 case BRIDGE_SN9C102P
:
1573 case BRIDGE_SN9C105
:
1578 /* case BRIDGE_SN9C110: */
1579 /* case BRIDGE_SN9C120: */
1584 switch (sd
->sensor
) {
1586 mi0360_probe(gspca_dev
);
1589 ov7630_probe(gspca_dev
);
1592 ov7648_probe(gspca_dev
);
1594 case SENSOR_PO2030N
:
1595 po2030n_probe(gspca_dev
);
1599 switch (sd
->bridge
) {
1600 case BRIDGE_SN9C102P
:
1601 reg_w1(gspca_dev
, 0x02, regGpio
[1]);
1604 reg_w(gspca_dev
, 0x01, regGpio
, 2);
1608 /* Note we do not disable the sensor clock here (power saving mode),
1609 as that also disables the button on the cam. */
1610 reg_w1(gspca_dev
, 0xf1, 0x00);
1612 /* set the i2c address */
1613 sn9c1xx
= sn_tb
[sd
->sensor
];
1614 sd
->i2c_addr
= sn9c1xx
[9];
1616 return gspca_dev
->usb_err
;
1619 static int sd_s_ctrl(struct v4l2_ctrl
*ctrl
);
1621 static const struct v4l2_ctrl_ops sd_ctrl_ops
= {
1622 .s_ctrl
= sd_s_ctrl
,
1625 /* this function is called at probe time */
1626 static int sd_init_controls(struct gspca_dev
*gspca_dev
)
1628 struct sd
*sd
= (struct sd
*) gspca_dev
;
1629 struct v4l2_ctrl_handler
*hdl
= &gspca_dev
->ctrl_handler
;
1631 gspca_dev
->vdev
.ctrl_handler
= hdl
;
1632 v4l2_ctrl_handler_init(hdl
, 14);
1634 sd
->brightness
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1635 V4L2_CID_BRIGHTNESS
, 0, 255, 1, 128);
1636 #define CONTRAST_MAX 127
1637 sd
->contrast
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1638 V4L2_CID_CONTRAST
, 0, CONTRAST_MAX
, 1, 20);
1639 #define COLORS_DEF 25
1640 sd
->saturation
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1641 V4L2_CID_SATURATION
, 0, 40, 1, COLORS_DEF
);
1642 sd
->red_bal
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1643 V4L2_CID_RED_BALANCE
, 24, 40, 1, 32);
1644 sd
->blue_bal
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1645 V4L2_CID_BLUE_BALANCE
, 24, 40, 1, 32);
1646 #define GAMMA_DEF 20
1647 sd
->gamma
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1648 V4L2_CID_GAMMA
, 0, 40, 1, GAMMA_DEF
);
1650 if (sd
->sensor
== SENSOR_OM6802
)
1651 sd
->sharpness
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1652 V4L2_CID_SHARPNESS
, 0, 255, 1, 16);
1654 sd
->sharpness
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1655 V4L2_CID_SHARPNESS
, 0, 255, 1, 90);
1657 if (sd
->flags
& F_ILLUM
)
1658 sd
->illum
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1659 V4L2_CID_ILLUMINATORS_1
, 0, 1, 1, 0);
1661 if (sd
->sensor
== SENSOR_PO2030N
) {
1662 gspca_dev
->exposure
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1663 V4L2_CID_EXPOSURE
, 500, 1500, 1, 1024);
1664 gspca_dev
->gain
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1665 V4L2_CID_GAIN
, 4, 49, 1, 15);
1666 sd
->hflip
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1667 V4L2_CID_HFLIP
, 0, 1, 1, 0);
1670 if (sd
->sensor
!= SENSOR_ADCM1700
&& sd
->sensor
!= SENSOR_OV7660
&&
1671 sd
->sensor
!= SENSOR_PO1030
&& sd
->sensor
!= SENSOR_SOI768
&&
1672 sd
->sensor
!= SENSOR_SP80708
)
1673 gspca_dev
->autogain
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1674 V4L2_CID_AUTOGAIN
, 0, 1, 1, 1);
1676 if (sd
->sensor
== SENSOR_HV7131R
|| sd
->sensor
== SENSOR_OV7630
||
1677 sd
->sensor
== SENSOR_OV7648
|| sd
->sensor
== SENSOR_PO2030N
)
1678 sd
->vflip
= v4l2_ctrl_new_std(hdl
, &sd_ctrl_ops
,
1679 V4L2_CID_VFLIP
, 0, 1, 1, 0);
1681 if (sd
->sensor
== SENSOR_OV7630
|| sd
->sensor
== SENSOR_OV7648
||
1682 sd
->sensor
== SENSOR_OV7660
)
1683 sd
->freq
= v4l2_ctrl_new_std_menu(hdl
, &sd_ctrl_ops
,
1684 V4L2_CID_POWER_LINE_FREQUENCY
,
1685 V4L2_CID_POWER_LINE_FREQUENCY_60HZ
, 0,
1686 V4L2_CID_POWER_LINE_FREQUENCY_50HZ
);
1689 pr_err("Could not initialize controls\n");
1693 v4l2_ctrl_cluster(2, &sd
->red_bal
);
1694 if (sd
->sensor
== SENSOR_PO2030N
) {
1695 v4l2_ctrl_cluster(2, &sd
->vflip
);
1696 v4l2_ctrl_auto_cluster(3, &gspca_dev
->autogain
, 0, false);
1702 static u32
expo_adjust(struct gspca_dev
*gspca_dev
,
1705 struct sd
*sd
= (struct sd
*) gspca_dev
;
1707 switch (sd
->sensor
) {
1708 case SENSOR_GC0307
: {
1711 /* expo = 0..255 -> a = 19..43 */
1712 a
= 19 + expo
* 25 / 256;
1713 i2c_w1(gspca_dev
, 0x68, a
);
1715 b
= a
* a
* 4; /* heuristic */
1716 i2c_w1(gspca_dev
, 0x03, b
>> 8);
1717 i2c_w1(gspca_dev
, 0x04, b
);
1720 case SENSOR_HV7131R
: {
1722 { 0xc1, 0x11, 0x25, 0x00, 0x00, 0x00, 0x00, 0x16 };
1724 Expodoit
[3] = expo
>> 16;
1725 Expodoit
[4] = expo
>> 8;
1727 i2c_w8(gspca_dev
, Expodoit
);
1731 case SENSOR_MI0360B
: {
1732 u8 expoMi
[] = /* exposure 0x0635 -> 4 fp/s 0x10 */
1733 { 0xb1, 0x5d, 0x09, 0x00, 0x00, 0x00, 0x00, 0x16 };
1734 static const u8 doit
[] = /* update sensor */
1735 { 0xb1, 0x5d, 0x07, 0x00, 0x03, 0x00, 0x00, 0x10 };
1736 static const u8 sensorgo
[] = /* sensor on */
1737 { 0xb1, 0x5d, 0x07, 0x00, 0x02, 0x00, 0x00, 0x10 };
1741 else if (expo
< 0x0001)
1743 expoMi
[3] = expo
>> 8;
1745 i2c_w8(gspca_dev
, expoMi
);
1746 i2c_w8(gspca_dev
, doit
);
1747 i2c_w8(gspca_dev
, sensorgo
);
1750 case SENSOR_MO4000
: {
1752 { 0xa1, 0x21, 0x0f, 0x00, 0x00, 0x00, 0x00, 0x10 };
1754 { 0xa1, 0x21, 0x10, 0x00, 0x00, 0x00, 0x00, 0x10 };
1755 static const u8 gainMo
[] =
1756 { 0xa1, 0x21, 0x00, 0x10, 0x00, 0x00, 0x00, 0x1d };
1760 else if (expo
< 0x0001)
1762 expoMof
[3] = (expo
& 0x03fc) >> 2;
1763 i2c_w8(gspca_dev
, expoMof
);
1764 expoMo10
[3] = ((expo
& 0x1c00) >> 10)
1765 | ((expo
& 0x0003) << 4);
1766 i2c_w8(gspca_dev
, expoMo10
);
1767 i2c_w8(gspca_dev
, gainMo
);
1768 gspca_dbg(gspca_dev
, D_FRAM
, "set exposure %d\n",
1769 ((expoMo10
[3] & 0x07) << 10)
1771 | ((expoMo10
[3] & 0x30) >> 4));
1774 case SENSOR_MT9V111
: {
1776 { 0xb1, 0x5c, 0x09, 0x00, 0x00, 0x00, 0x00, 0x10 };
1780 else if (expo
< 0x0060)
1782 expo_c1
[3] = expo
>> 8;
1784 i2c_w8(gspca_dev
, expo_c1
);
1787 case SENSOR_OM6802
: {
1789 { 0xa0, 0x34, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x10 };
1790 /* preset AGC - works when AutoExpo = off */
1796 gainOm
[3] = expo
>> 2;
1797 i2c_w8(gspca_dev
, gainOm
);
1798 reg_w1(gspca_dev
, 0x96, expo
>> 5);
1799 gspca_dbg(gspca_dev
, D_FRAM
, "set exposure %d\n", gainOm
[3]);
1806 static void setbrightness(struct gspca_dev
*gspca_dev
)
1808 struct sd
*sd
= (struct sd
*) gspca_dev
;
1810 int brightness
= sd
->brightness
->val
;
1813 k2
= (brightness
- 0x80) >> 2;
1814 switch (sd
->sensor
) {
1815 case SENSOR_ADCM1700
:
1817 k2
= 0; /* only positive Y offset */
1819 case SENSOR_HV7131R
:
1820 expo
= brightness
<< 12;
1821 if (expo
> 0x002dc6c0)
1823 else if (expo
< 0x02a0)
1825 sd
->exposure
= expo_adjust(gspca_dev
, expo
);
1829 expo
= brightness
<< 4;
1830 sd
->exposure
= expo_adjust(gspca_dev
, expo
);
1832 case SENSOR_MI0360B
:
1833 expo
= brightness
<< 2;
1834 sd
->exposure
= expo_adjust(gspca_dev
, expo
);
1838 sd
->exposure
= expo_adjust(gspca_dev
, expo
);
1839 return; /* don't set the Y offset */
1840 case SENSOR_MT9V111
:
1841 expo
= brightness
<< 2;
1842 sd
->exposure
= expo_adjust(gspca_dev
, expo
);
1843 return; /* don't set the Y offset */
1845 expo
= brightness
<< 2;
1846 sd
->exposure
= expo_adjust(gspca_dev
, expo
);
1847 return; /* Y offset already set */
1850 reg_w1(gspca_dev
, 0x96, k2
); /* color matrix Y offset */
1853 static void setcontrast(struct gspca_dev
*gspca_dev
)
1855 struct sd
*sd
= (struct sd
*) gspca_dev
;
1859 k2
= sd
->contrast
->val
* 37 / (CONTRAST_MAX
+ 1)
1861 contrast
[0] = (k2
+ 1) / 2; /* red */
1863 contrast
[2] = k2
; /* green */
1865 contrast
[4] = k2
/ 5; /* blue */
1867 reg_w(gspca_dev
, 0x84, contrast
, sizeof contrast
);
1870 static void setcolors(struct gspca_dev
*gspca_dev
)
1872 struct sd
*sd
= (struct sd
*) gspca_dev
;
1875 u8 reg8a
[12]; /* U & V gains */
1876 static const s16 uv_com
[6] = { /* same as reg84 in signed decimal */
1877 -24, -38, 64, /* UR UG UB */
1878 62, -51, -9 /* VR VG VB */
1880 static const s16 uv_mi0360b
[6] = {
1881 -20, -38, 64, /* UR UG UB */
1882 60, -51, -9 /* VR VG VB */
1885 colors
= sd
->saturation
->val
;
1886 if (sd
->sensor
== SENSOR_MI0360B
)
1890 for (i
= 0; i
< 6; i
++) {
1891 v
= uv
[i
] * colors
/ COLORS_DEF
;
1893 reg8a
[i
* 2 + 1] = (v
>> 8) & 0x0f;
1895 reg_w(gspca_dev
, 0x8a, reg8a
, sizeof reg8a
);
1898 static void setredblue(struct gspca_dev
*gspca_dev
)
1900 struct sd
*sd
= (struct sd
*) gspca_dev
;
1902 if (sd
->sensor
== SENSOR_PO2030N
) {
1903 u8 rg1b
[] = /* red green1 blue (no g2) */
1904 {0xc1, 0x6e, 0x16, 0x00, 0x40, 0x00, 0x00, 0x10};
1906 /* 0x40 = normal value = gain x 1 */
1907 rg1b
[3] = sd
->red_bal
->val
* 2;
1908 rg1b
[5] = sd
->blue_bal
->val
* 2;
1909 i2c_w8(gspca_dev
, rg1b
);
1912 reg_w1(gspca_dev
, 0x05, sd
->red_bal
->val
);
1913 /* reg_w1(gspca_dev, 0x07, 32); */
1914 reg_w1(gspca_dev
, 0x06, sd
->blue_bal
->val
);
1917 static void setgamma(struct gspca_dev
*gspca_dev
)
1919 struct sd
*sd
= (struct sd
*) gspca_dev
;
1922 const u8
*gamma_base
;
1923 static const u8 delta
[17] = {
1924 0x00, 0x14, 0x1c, 0x1c, 0x1c, 0x1c, 0x1b, 0x1a,
1925 0x18, 0x13, 0x10, 0x0e, 0x08, 0x07, 0x04, 0x02, 0x00
1928 switch (sd
->sensor
) {
1929 case SENSOR_ADCM1700
:
1930 gamma_base
= gamma_spec_0
;
1932 case SENSOR_HV7131R
:
1933 case SENSOR_MI0360B
:
1934 case SENSOR_MT9V111
:
1935 gamma_base
= gamma_spec_1
;
1938 gamma_base
= gamma_spec_2
;
1940 case SENSOR_SP80708
:
1941 gamma_base
= gamma_spec_3
;
1944 gamma_base
= gamma_def
;
1948 val
= sd
->gamma
->val
;
1949 for (i
= 0; i
< sizeof gamma
; i
++)
1950 gamma
[i
] = gamma_base
[i
]
1951 + delta
[i
] * (val
- GAMMA_DEF
) / 32;
1952 reg_w(gspca_dev
, 0x20, gamma
, sizeof gamma
);
1955 static void setexposure(struct gspca_dev
*gspca_dev
)
1957 struct sd
*sd
= (struct sd
*) gspca_dev
;
1959 if (sd
->sensor
== SENSOR_PO2030N
) {
1960 u8 rexpo
[] = /* 1a: expo H, 1b: expo M */
1961 {0xa1, 0x6e, 0x1a, 0x00, 0x40, 0x00, 0x00, 0x10};
1963 rexpo
[3] = gspca_dev
->exposure
->val
>> 8;
1964 i2c_w8(gspca_dev
, rexpo
);
1967 rexpo
[3] = gspca_dev
->exposure
->val
;
1968 i2c_w8(gspca_dev
, rexpo
);
1972 static void setautogain(struct gspca_dev
*gspca_dev
)
1974 struct sd
*sd
= (struct sd
*) gspca_dev
;
1976 switch (sd
->sensor
) {
1978 case SENSOR_OV7648
: {
1981 if (sd
->sensor
== SENSOR_OV7630
)
1985 if (gspca_dev
->autogain
->val
)
1987 i2c_w1(&sd
->gspca_dev
, 0x13, comb
);
1991 if (gspca_dev
->autogain
->val
)
1992 sd
->ag_cnt
= AG_CNT_START
;
1997 static void setgain(struct gspca_dev
*gspca_dev
)
1999 struct sd
*sd
= (struct sd
*) gspca_dev
;
2001 if (sd
->sensor
== SENSOR_PO2030N
) {
2002 u8 rgain
[] = /* 15: gain */
2003 {0xa1, 0x6e, 0x15, 0x00, 0x40, 0x00, 0x00, 0x15};
2005 rgain
[3] = gspca_dev
->gain
->val
;
2006 i2c_w8(gspca_dev
, rgain
);
2010 static void sethvflip(struct gspca_dev
*gspca_dev
)
2012 struct sd
*sd
= (struct sd
*) gspca_dev
;
2015 switch (sd
->sensor
) {
2016 case SENSOR_HV7131R
:
2017 comn
= 0x18; /* clkdiv = 1, ablcen = 1 */
2020 i2c_w1(gspca_dev
, 0x01, comn
); /* sctra */
2024 if (!sd
->vflip
->val
)
2026 i2c_w1(gspca_dev
, 0x75, comn
);
2032 i2c_w1(gspca_dev
, 0x75, comn
);
2034 case SENSOR_PO2030N
:
2035 /* Reg. 0x1E: Timing Generator Control Register 2 (Tgcontrol2)
2036 * (reset value: 0x0A)
2037 * bit7: HM: Horizontal Mirror: 0: disable, 1: enable
2038 * bit6: VM: Vertical Mirror: 0: disable, 1: enable
2039 * bit5: ST: Shutter Selection: 0: electrical, 1: mechanical
2040 * bit4: FT: Single Frame Transfer: 0: disable, 1: enable
2048 i2c_w1(&sd
->gspca_dev
, 0x1e, comn
);
2053 static void setsharpness(struct gspca_dev
*gspca_dev
)
2055 struct sd
*sd
= (struct sd
*) gspca_dev
;
2057 reg_w1(gspca_dev
, 0x99, sd
->sharpness
->val
);
2060 static void setillum(struct gspca_dev
*gspca_dev
)
2062 struct sd
*sd
= (struct sd
*) gspca_dev
;
2064 switch (sd
->sensor
) {
2065 case SENSOR_ADCM1700
:
2066 reg_w1(gspca_dev
, 0x02, /* gpio */
2067 sd
->illum
->val
? 0x64 : 0x60);
2069 case SENSOR_MT9V111
:
2070 reg_w1(gspca_dev
, 0x02,
2071 sd
->illum
->val
? 0x77 : 0x74);
2072 /* should have been: */
2073 /* 0x55 : 0x54); * 370i */
2074 /* 0x66 : 0x64); * Clip */
2079 static void setfreq(struct gspca_dev
*gspca_dev
)
2081 struct sd
*sd
= (struct sd
*) gspca_dev
;
2083 if (sd
->sensor
== SENSOR_OV7660
) {
2086 com8
= 0xdf; /* auto gain/wb/expo */
2087 switch (sd
->freq
->val
) {
2088 case 0: /* Banding filter disabled */
2089 i2c_w1(gspca_dev
, 0x13, com8
| 0x20);
2092 i2c_w1(gspca_dev
, 0x13, com8
);
2093 i2c_w1(gspca_dev
, 0x3b, 0x0a);
2096 i2c_w1(gspca_dev
, 0x13, com8
);
2097 i2c_w1(gspca_dev
, 0x3b, 0x02);
2101 u8 reg2a
= 0, reg2b
= 0, reg2d
= 0;
2103 /* Get reg2a / reg2d base values */
2104 switch (sd
->sensor
) {
2115 switch (sd
->freq
->val
) {
2116 case 0: /* Banding filter disabled */
2118 case 1: /* 50 hz (filter on and framerate adj) */
2123 case 2: /* 60 hz (filter on, no framerate adj) */
2128 i2c_w1(gspca_dev
, 0x2a, reg2a
);
2129 i2c_w1(gspca_dev
, 0x2b, reg2b
);
2130 i2c_w1(gspca_dev
, 0x2d, reg2d
);
2134 static void setjpegqual(struct gspca_dev
*gspca_dev
)
2136 struct sd
*sd
= (struct sd
*) gspca_dev
;
2138 jpeg_set_qual(sd
->jpeg_hdr
, sd
->quality
);
2140 #error "No room enough in usb_buf for quantization table"
2142 memcpy(gspca_dev
->usb_buf
, &sd
->jpeg_hdr
[JPEG_QT0_OFFSET
], 64);
2143 usb_control_msg(gspca_dev
->dev
,
2144 usb_sndctrlpipe(gspca_dev
->dev
, 0),
2146 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
2148 gspca_dev
->usb_buf
, 64,
2150 memcpy(gspca_dev
->usb_buf
, &sd
->jpeg_hdr
[JPEG_QT1_OFFSET
], 64);
2151 usb_control_msg(gspca_dev
->dev
,
2152 usb_sndctrlpipe(gspca_dev
->dev
, 0),
2154 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_INTERFACE
,
2156 gspca_dev
->usb_buf
, 64,
2160 reg_w1(gspca_dev
, 0x18, sd
->reg18
);
2163 /* JPEG quality update */
2164 /* This function is executed from a work queue. */
2165 static void qual_upd(struct work_struct
*work
)
2167 struct sd
*sd
= container_of(work
, struct sd
, work
);
2168 struct gspca_dev
*gspca_dev
= &sd
->gspca_dev
;
2170 /* To protect gspca_dev->usb_buf and gspca_dev->usb_err */
2171 mutex_lock(&gspca_dev
->usb_lock
);
2172 gspca_dbg(gspca_dev
, D_STREAM
, "qual_upd %d%%\n", sd
->quality
);
2173 gspca_dev
->usb_err
= 0;
2174 setjpegqual(gspca_dev
);
2175 mutex_unlock(&gspca_dev
->usb_lock
);
2178 /* -- start the camera -- */
2179 static int sd_start(struct gspca_dev
*gspca_dev
)
2181 struct sd
*sd
= (struct sd
*) gspca_dev
;
2186 const u8 (*init
)[8];
2189 static const u8 reg9a_def
[] =
2190 {0x00, 0x40, 0x20, 0x00, 0x00, 0x00};
2191 static const u8 reg9a_spec
[] =
2192 {0x00, 0x40, 0x38, 0x30, 0x00, 0x20};
2193 static const u8 regd4
[] = {0x60, 0x00, 0x00};
2194 static const u8 C0
[] = { 0x2d, 0x2d, 0x3a, 0x05, 0x04, 0x3f };
2195 static const u8 CA
[] = { 0x28, 0xd8, 0x14, 0xec };
2196 static const u8 CA_adcm1700
[] =
2197 { 0x14, 0xec, 0x0a, 0xf6 };
2198 static const u8 CA_po2030n
[] =
2199 { 0x1e, 0xe2, 0x14, 0xec };
2200 static const u8 CE
[] = { 0x32, 0xdd, 0x2d, 0xdd }; /* MI0360 */
2201 static const u8 CE_gc0307
[] =
2202 { 0x32, 0xce, 0x2d, 0xd3 };
2203 static const u8 CE_ov76xx
[] =
2204 { 0x32, 0xdd, 0x32, 0xdd };
2205 static const u8 CE_po2030n
[] =
2206 { 0x14, 0xe7, 0x1e, 0xdd };
2208 /* create the JPEG header */
2209 jpeg_define(sd
->jpeg_hdr
, gspca_dev
->pixfmt
.height
,
2210 gspca_dev
->pixfmt
.width
,
2211 0x21); /* JPEG 422 */
2213 /* initialize the bridge */
2214 sn9c1xx
= sn_tb
[sd
->sensor
];
2216 /* sensor clock already enabled in sd_init */
2217 /* reg_w1(gspca_dev, 0xf1, 0x00); */
2219 if (sd
->flags
& F_PDN_INV
)
2220 reg01
^= S_PDN_INV
; /* power down inverted */
2221 reg_w1(gspca_dev
, 0x01, reg01
);
2223 /* configure gpio */
2225 reg0102
[1] = sn9c1xx
[2];
2226 if (gspca_dev
->audio
)
2227 reg0102
[1] |= 0x04; /* keep the audio connection */
2228 reg_w(gspca_dev
, 0x01, reg0102
, 2);
2229 reg_w(gspca_dev
, 0x08, &sn9c1xx
[8], 2);
2230 reg_w(gspca_dev
, 0x17, &sn9c1xx
[0x17], 5);
2231 switch (sd
->sensor
) {
2235 case SENSOR_PO2030N
:
2237 case SENSOR_SP80708
:
2244 reg_w(gspca_dev
, 0x9a, reg9a
, 6);
2246 reg_w(gspca_dev
, 0xd4, regd4
, sizeof regd4
);
2248 reg_w(gspca_dev
, 0x03, &sn9c1xx
[3], 0x0f);
2250 reg17
= sn9c1xx
[0x17];
2251 switch (sd
->sensor
) {
2253 msleep(50); /*fixme: is it useful? */
2257 reg_w1(gspca_dev
, 0x02, 0x73);
2258 reg17
|= SEN_CLK_EN
;
2259 reg_w1(gspca_dev
, 0x17, reg17
);
2260 reg_w1(gspca_dev
, 0x01, 0x22);
2262 reg01
= SCL_SEL_OD
| S_PDN_INV
;
2263 reg17
&= ~MCK_SIZE_MASK
;
2264 reg17
|= 0x04; /* clock / 4 */
2267 reg01
|= SYS_SEL_48M
;
2268 reg_w1(gspca_dev
, 0x01, reg01
);
2269 reg17
|= SEN_CLK_EN
;
2270 reg_w1(gspca_dev
, 0x17, reg17
);
2271 reg01
&= ~S_PWR_DN
; /* sensor power on */
2272 reg_w1(gspca_dev
, 0x01, reg01
);
2273 reg01
&= ~SCL_SEL_OD
; /* remove open-drain mode */
2274 reg_w1(gspca_dev
, 0x01, reg01
);
2276 switch (sd
->sensor
) {
2277 case SENSOR_HV7131R
:
2278 hv7131r_probe(gspca_dev
); /*fixme: is it useful? */
2282 reg_w1(gspca_dev
, 0x01, reg01
);
2283 i2c_w8(gspca_dev
, om6802_init0
[0]);
2284 i2c_w8(gspca_dev
, om6802_init0
[1]);
2286 reg_w1(gspca_dev
, 0x02, 0x71);
2289 case SENSOR_SP80708
:
2291 reg_w1(gspca_dev
, 0x02, 0x62);
2295 /* initialize the sensor */
2296 i2c_w_seq(gspca_dev
, sensor_init
[sd
->sensor
]);
2298 reg_w1(gspca_dev
, 0x15, sn9c1xx
[0x15]);
2299 reg_w1(gspca_dev
, 0x16, sn9c1xx
[0x16]);
2300 reg_w1(gspca_dev
, 0x12, sn9c1xx
[0x12]);
2301 reg_w1(gspca_dev
, 0x13, sn9c1xx
[0x13]);
2302 reg_w1(gspca_dev
, 0x18, sn9c1xx
[0x18]);
2303 if (sd
->sensor
== SENSOR_ADCM1700
) {
2304 reg_w1(gspca_dev
, 0xd2, 0x3a); /* AE_H_SIZE = 116 */
2305 reg_w1(gspca_dev
, 0xd3, 0x30); /* AE_V_SIZE = 96 */
2307 reg_w1(gspca_dev
, 0xd2, 0x6a); /* AE_H_SIZE = 212 */
2308 reg_w1(gspca_dev
, 0xd3, 0x50); /* AE_V_SIZE = 160 */
2310 reg_w1(gspca_dev
, 0xc6, 0x00);
2311 reg_w1(gspca_dev
, 0xc7, 0x00);
2312 if (sd
->sensor
== SENSOR_ADCM1700
) {
2313 reg_w1(gspca_dev
, 0xc8, 0x2c); /* AW_H_STOP = 352 */
2314 reg_w1(gspca_dev
, 0xc9, 0x24); /* AW_V_STOP = 288 */
2316 reg_w1(gspca_dev
, 0xc8, 0x50); /* AW_H_STOP = 640 */
2317 reg_w1(gspca_dev
, 0xc9, 0x3c); /* AW_V_STOP = 480 */
2319 reg_w1(gspca_dev
, 0x18, sn9c1xx
[0x18]);
2320 switch (sd
->sensor
) {
2322 /* case SENSOR_OV7648: * fixme: sometimes */
2328 reg_w1(gspca_dev
, 0x17, reg17
);
2330 reg_w1(gspca_dev
, 0x05, 0x00); /* red */
2331 reg_w1(gspca_dev
, 0x07, 0x00); /* green */
2332 reg_w1(gspca_dev
, 0x06, 0x00); /* blue */
2333 reg_w1(gspca_dev
, 0x14, sn9c1xx
[0x14]);
2335 setgamma(gspca_dev
);
2337 /*fixme: 8 times with all zeroes and 1 or 2 times with normal values */
2338 for (i
= 0; i
< 8; i
++)
2339 reg_w(gspca_dev
, 0x84, reg84
, sizeof reg84
);
2340 switch (sd
->sensor
) {
2341 case SENSOR_ADCM1700
:
2343 case SENSOR_SP80708
:
2344 reg_w1(gspca_dev
, 0x9a, 0x05);
2347 case SENSOR_MT9V111
:
2348 case SENSOR_MI0360B
:
2349 reg_w1(gspca_dev
, 0x9a, 0x07);
2353 reg_w1(gspca_dev
, 0x9a, 0x0a);
2355 case SENSOR_PO2030N
:
2357 reg_w1(gspca_dev
, 0x9a, 0x06);
2360 reg_w1(gspca_dev
, 0x9a, 0x08);
2363 setsharpness(gspca_dev
);
2365 reg_w(gspca_dev
, 0x84, reg84
, sizeof reg84
);
2366 reg_w1(gspca_dev
, 0x05, 0x20); /* red */
2367 reg_w1(gspca_dev
, 0x07, 0x20); /* green */
2368 reg_w1(gspca_dev
, 0x06, 0x20); /* blue */
2371 mode
= gspca_dev
->cam
.cam_mode
[gspca_dev
->curr_mode
].priv
;
2372 reg01
|= SYS_SEL_48M
| V_TX_EN
;
2373 reg17
&= ~MCK_SIZE_MASK
;
2374 reg17
|= 0x02; /* clock / 2 */
2375 switch (sd
->sensor
) {
2376 case SENSOR_ADCM1700
:
2377 init
= adcm1700_sensor_param1
;
2380 init
= gc0307_sensor_param1
;
2382 case SENSOR_HV7131R
:
2385 reg01
&= ~SYS_SEL_48M
; /* 640x480: clk 24Mhz */
2386 reg17
&= ~MCK_SIZE_MASK
;
2387 reg17
|= 0x01; /* clock / 1 */
2389 case SENSOR_MI0360B
:
2390 init
= mi0360b_sensor_param1
;
2393 if (mode
) { /* if 320x240 */
2394 reg01
&= ~SYS_SEL_48M
; /* clk 24Mz */
2395 reg17
&= ~MCK_SIZE_MASK
;
2396 reg17
|= 0x01; /* clock / 1 */
2399 case SENSOR_MT9V111
:
2400 init
= mt9v111_sensor_param1
;
2403 init
= om6802_sensor_param1
;
2404 if (!mode
) { /* if 640x480 */
2405 reg17
&= ~MCK_SIZE_MASK
;
2406 reg17
|= 0x04; /* clock / 4 */
2408 reg01
&= ~SYS_SEL_48M
; /* clk 24Mz */
2409 reg17
&= ~MCK_SIZE_MASK
;
2410 reg17
|= 0x02; /* clock / 2 */
2414 init
= ov7630_sensor_param1
;
2417 init
= ov7648_sensor_param1
;
2418 reg17
&= ~MCK_SIZE_MASK
;
2419 reg17
|= 0x01; /* clock / 1 */
2422 init
= ov7660_sensor_param1
;
2425 init
= po1030_sensor_param1
;
2427 case SENSOR_PO2030N
:
2428 init
= po2030n_sensor_param1
;
2431 init
= soi768_sensor_param1
;
2433 case SENSOR_SP80708
:
2434 init
= sp80708_sensor_param1
;
2438 /* more sensor initialization - param1 */
2440 i2c_w_seq(gspca_dev
, init
);
2444 reg_w(gspca_dev
, 0xc0, C0
, 6);
2445 switch (sd
->sensor
) {
2446 case SENSOR_ADCM1700
:
2449 reg_w(gspca_dev
, 0xca, CA_adcm1700
, 4);
2451 case SENSOR_PO2030N
:
2452 reg_w(gspca_dev
, 0xca, CA_po2030n
, 4);
2455 reg_w(gspca_dev
, 0xca, CA
, 4);
2458 switch (sd
->sensor
) {
2459 case SENSOR_ADCM1700
:
2464 reg_w(gspca_dev
, 0xce, CE_ov76xx
, 4);
2467 reg_w(gspca_dev
, 0xce, CE_gc0307
, 4);
2469 case SENSOR_PO2030N
:
2470 reg_w(gspca_dev
, 0xce, CE_po2030n
, 4);
2473 reg_w(gspca_dev
, 0xce, CE
, 4);
2474 /* ?? {0x1e, 0xdd, 0x2d, 0xe7} */
2478 /* here change size mode 0 -> VGA; 1 -> CIF */
2479 sd
->reg18
= sn9c1xx
[0x18] | (mode
<< 4) | 0x40;
2480 reg_w1(gspca_dev
, 0x18, sd
->reg18
);
2481 setjpegqual(gspca_dev
);
2483 reg_w1(gspca_dev
, 0x17, reg17
);
2484 reg_w1(gspca_dev
, 0x01, reg01
);
2488 sd
->pktsz
= sd
->npkt
= 0;
2489 sd
->nchg
= sd
->short_mark
= 0;
2491 return gspca_dev
->usb_err
;
2494 static void sd_stopN(struct gspca_dev
*gspca_dev
)
2496 struct sd
*sd
= (struct sd
*) gspca_dev
;
2497 static const u8 stophv7131
[] =
2498 { 0xa1, 0x11, 0x02, 0x09, 0x00, 0x00, 0x00, 0x10 };
2499 static const u8 stopmi0360
[] =
2500 { 0xb1, 0x5d, 0x07, 0x00, 0x00, 0x00, 0x00, 0x10 };
2501 static const u8 stopov7648
[] =
2502 { 0xa1, 0x21, 0x76, 0x20, 0x00, 0x00, 0x00, 0x10 };
2503 static const u8 stopsoi768
[] =
2504 { 0xa1, 0x21, 0x12, 0x80, 0x00, 0x00, 0x00, 0x10 };
2509 reg17
= sd
->reg17
& ~SEN_CLK_EN
;
2510 switch (sd
->sensor
) {
2511 case SENSOR_ADCM1700
:
2513 case SENSOR_PO2030N
:
2514 case SENSOR_SP80708
:
2516 reg_w1(gspca_dev
, 0x01, reg01
);
2517 reg01
&= ~(LED
| V_TX_EN
);
2518 reg_w1(gspca_dev
, 0x01, reg01
);
2519 /* reg_w1(gspca_dev, 0x02, 0x??); * LED off ? */
2521 case SENSOR_HV7131R
:
2523 reg_w1(gspca_dev
, 0x01, reg01
);
2524 i2c_w8(gspca_dev
, stophv7131
);
2527 case SENSOR_MI0360B
:
2529 reg_w1(gspca_dev
, 0x01, reg01
);
2530 /* reg_w1(gspca_dev, 0x02, 0x40); * LED off ? */
2531 i2c_w8(gspca_dev
, stopmi0360
);
2533 case SENSOR_MT9V111
:
2537 reg_w1(gspca_dev
, 0x01, reg01
);
2542 reg_w1(gspca_dev
, 0x01, reg01
);
2543 i2c_w8(gspca_dev
, stopov7648
);
2547 reg_w1(gspca_dev
, 0x01, reg01
);
2550 i2c_w8(gspca_dev
, stopsoi768
);
2554 reg01
|= SCL_SEL_OD
;
2555 reg_w1(gspca_dev
, 0x01, reg01
);
2556 reg01
|= S_PWR_DN
; /* sensor power down */
2557 reg_w1(gspca_dev
, 0x01, reg01
);
2558 reg_w1(gspca_dev
, 0x17, reg17
);
2559 reg01
&= ~SYS_SEL_48M
; /* clock 24MHz */
2560 reg_w1(gspca_dev
, 0x01, reg01
);
2562 reg_w1(gspca_dev
, 0x01, reg01
);
2563 /* Don't disable sensor clock as that disables the button on the cam */
2564 /* reg_w1(gspca_dev, 0xf1, 0x01); */
2567 /* called on streamoff with alt==0 and on disconnect */
2568 /* the usb_lock is held at entry - restore on exit */
2569 static void sd_stop0(struct gspca_dev
*gspca_dev
)
2571 struct sd
*sd
= (struct sd
*) gspca_dev
;
2573 mutex_unlock(&gspca_dev
->usb_lock
);
2574 flush_work(&sd
->work
);
2575 mutex_lock(&gspca_dev
->usb_lock
);
2578 static void do_autogain(struct gspca_dev
*gspca_dev
)
2580 struct sd
*sd
= (struct sd
*) gspca_dev
;
2586 /* Thanks S., without your advice, autobright should not work :) */
2589 if (--sd
->ag_cnt
>= 0)
2591 sd
->ag_cnt
= AG_CNT_START
;
2593 delta
= atomic_read(&sd
->avg_lum
);
2594 gspca_dbg(gspca_dev
, D_FRAM
, "mean lum %d\n", delta
);
2596 if (sd
->sensor
== SENSOR_PO2030N
) {
2597 gspca_expo_autogain(gspca_dev
, delta
, luma_mean
, luma_delta
,
2602 if (delta
< luma_mean
- luma_delta
||
2603 delta
> luma_mean
+ luma_delta
) {
2604 switch (sd
->sensor
) {
2606 expotimes
= sd
->exposure
;
2607 expotimes
+= (luma_mean
- delta
) >> 6;
2610 sd
->exposure
= expo_adjust(gspca_dev
,
2611 (unsigned int) expotimes
);
2613 case SENSOR_HV7131R
:
2614 expotimes
= sd
->exposure
>> 8;
2615 expotimes
+= (luma_mean
- delta
) >> 4;
2618 sd
->exposure
= expo_adjust(gspca_dev
,
2619 (unsigned int) (expotimes
<< 8));
2622 case SENSOR_MT9V111
:
2623 expotimes
= sd
->exposure
;
2624 expotimes
+= (luma_mean
- delta
) >> 2;
2627 sd
->exposure
= expo_adjust(gspca_dev
,
2628 (unsigned int) expotimes
);
2629 setredblue(gspca_dev
);
2632 /* case SENSOR_MO4000: */
2633 /* case SENSOR_MI0360: */
2634 /* case SENSOR_MI0360B: */
2635 expotimes
= sd
->exposure
;
2636 expotimes
+= (luma_mean
- delta
) >> 6;
2639 sd
->exposure
= expo_adjust(gspca_dev
,
2640 (unsigned int) expotimes
);
2641 setredblue(gspca_dev
);
2647 /* set the average luminosity from an isoc marker */
2648 static void set_lum(struct sd
*sd
,
2657 avg_lum
= (data
[27] << 8) + data
[28] /* w3 */
2659 + (data
[31] << 8) + data
[32] /* w5 */
2661 + (data
[23] << 8) + data
[24] /* w1 */
2663 + (data
[35] << 8) + data
[36] /* w7 */
2665 + (data
[29] << 10) + (data
[30] << 2); /* w4 * 4 */
2667 atomic_set(&sd
->avg_lum
, avg_lum
);
2670 /* scan the URB packets */
2671 /* This function is run at interrupt level. */
2672 static void sd_pkt_scan(struct gspca_dev
*gspca_dev
,
2673 u8
*data
, /* isoc packet */
2674 int len
) /* iso packet length */
2676 struct sd
*sd
= (struct sd
*) gspca_dev
;
2680 * A frame ends on the marker
2681 * ff ff 00 c4 c4 96 ..
2682 * which is 62 bytes long and is followed by various information
2683 * including statuses and luminosity.
2685 * A marker may be splitted on two packets.
2687 * The 6th byte of a marker contains the bits:
2689 * 0xc0: frame sequence
2690 * When the bit 'USB full' is set, the frame must be discarded;
2691 * this is also the case when the 2 bytes before the marker are
2692 * not the JPEG end of frame ('ff d9').
2695 /* count the packets and their size */
2699 /*fixme: assumption about the following code:
2700 * - there can be only one marker in a packet
2703 /* skip the remaining bytes of a short marker */
2707 if (i
< 0 /* if 'ff' at end of previous packet */
2711 if (data
[0] == 0xff && data
[1] == 0xff) {
2721 /* search backwards if there is a marker in the packet */
2722 for (i
= len
- 1; --i
>= 0; ) {
2723 if (data
[i
] != 0xff) {
2727 if (data
[i
+ 1] == 0xff) {
2729 /* (there may be 'ff ff' inside a marker) */
2730 if (i
+ 2 >= len
|| data
[i
+ 2] == 0x00)
2735 /* no marker found */
2736 /* add the JPEG header if first fragment */
2737 if (data
[len
- 1] == 0xff)
2738 sd
->short_mark
= -1;
2739 if (gspca_dev
->last_packet_type
== LAST_PACKET
)
2740 gspca_frame_add(gspca_dev
, FIRST_PACKET
,
2741 sd
->jpeg_hdr
, JPEG_HDR_SZ
);
2742 gspca_frame_add(gspca_dev
, INTER_PACKET
, data
, len
);
2746 /* if some error, discard the frame and decrease the quality */
2750 if (data
[i
- 2] != 0xff || data
[i
- 1] != 0xd9) {
2751 gspca_dev
->last_packet_type
= DISCARD_PACKET
;
2754 } else if (i
+ 6 < len
) {
2755 if (data
[i
+ 6] & 0x08) {
2756 gspca_dev
->last_packet_type
= DISCARD_PACKET
;
2761 gspca_frame_add(gspca_dev
, LAST_PACKET
, data
, i
);
2763 /* compute the filling rate and a new JPEG quality */
2764 if (new_qual
== 0) {
2767 r
= (sd
->pktsz
* 100) /
2769 gspca_dev
->urb
[0]->iso_frame_desc
[0].length
);
2775 if (new_qual
!= 0) {
2776 sd
->nchg
+= new_qual
;
2777 if (sd
->nchg
< -6 || sd
->nchg
>= 12) {
2779 new_qual
+= sd
->quality
;
2780 if (new_qual
< QUALITY_MIN
)
2781 new_qual
= QUALITY_MIN
;
2782 else if (new_qual
> QUALITY_MAX
)
2783 new_qual
= QUALITY_MAX
;
2784 if (new_qual
!= sd
->quality
) {
2785 sd
->quality
= new_qual
;
2786 schedule_work(&sd
->work
);
2792 sd
->pktsz
= sd
->npkt
= 0;
2794 /* if the marker is smaller than 62 bytes,
2795 * memorize the number of bytes to skip in the next packet */
2796 if (i
+ 62 > len
) { /* no more usable data */
2797 sd
->short_mark
= i
+ 62 - len
;
2800 if (sd
->ag_cnt
>= 0)
2801 set_lum(sd
, data
+ i
);
2803 /* if more data, start a new frame */
2808 gspca_frame_add(gspca_dev
, FIRST_PACKET
,
2809 sd
->jpeg_hdr
, JPEG_HDR_SZ
);
2810 gspca_frame_add(gspca_dev
, INTER_PACKET
, data
, len
);
2814 static int sd_s_ctrl(struct v4l2_ctrl
*ctrl
)
2816 struct gspca_dev
*gspca_dev
=
2817 container_of(ctrl
->handler
, struct gspca_dev
, ctrl_handler
);
2819 gspca_dev
->usb_err
= 0;
2821 if (!gspca_dev
->streaming
)
2825 case V4L2_CID_BRIGHTNESS
:
2826 setbrightness(gspca_dev
);
2828 case V4L2_CID_CONTRAST
:
2829 setcontrast(gspca_dev
);
2831 case V4L2_CID_SATURATION
:
2832 setcolors(gspca_dev
);
2834 case V4L2_CID_RED_BALANCE
:
2835 setredblue(gspca_dev
);
2837 case V4L2_CID_GAMMA
:
2838 setgamma(gspca_dev
);
2840 case V4L2_CID_AUTOGAIN
:
2841 setautogain(gspca_dev
);
2842 setexposure(gspca_dev
);
2845 case V4L2_CID_VFLIP
:
2846 sethvflip(gspca_dev
);
2848 case V4L2_CID_SHARPNESS
:
2849 setsharpness(gspca_dev
);
2851 case V4L2_CID_ILLUMINATORS_1
:
2852 setillum(gspca_dev
);
2854 case V4L2_CID_POWER_LINE_FREQUENCY
:
2860 return gspca_dev
->usb_err
;
2863 #if IS_ENABLED(CONFIG_INPUT)
2864 static int sd_int_pkt_scan(struct gspca_dev
*gspca_dev
,
2865 u8
*data
, /* interrupt packet data */
2866 int len
) /* interrupt packet length */
2870 if (len
== 1 && data
[0] == 1) {
2871 input_report_key(gspca_dev
->input_dev
, KEY_CAMERA
, 1);
2872 input_sync(gspca_dev
->input_dev
);
2873 input_report_key(gspca_dev
->input_dev
, KEY_CAMERA
, 0);
2874 input_sync(gspca_dev
->input_dev
);
2882 /* sub-driver description */
2883 static const struct sd_desc sd_desc
= {
2884 .name
= MODULE_NAME
,
2885 .config
= sd_config
,
2887 .init_controls
= sd_init_controls
,
2891 .pkt_scan
= sd_pkt_scan
,
2892 .dq_callback
= do_autogain
,
2893 #if IS_ENABLED(CONFIG_INPUT)
2894 .int_pkt_scan
= sd_int_pkt_scan
,
2898 /* -- module initialisation -- */
2899 #define BS(bridge, sensor) \
2900 .driver_info = (BRIDGE_ ## bridge << 16) \
2901 | (SENSOR_ ## sensor << 8)
2902 #define BSF(bridge, sensor, flags) \
2903 .driver_info = (BRIDGE_ ## bridge << 16) \
2904 | (SENSOR_ ## sensor << 8) \
2906 static const struct usb_device_id device_table
[] = {
2907 {USB_DEVICE(0x0458, 0x7025), BSF(SN9C120
, MI0360B
, F_PDN_INV
)},
2908 {USB_DEVICE(0x0458, 0x702e), BS(SN9C120
, OV7660
)},
2909 {USB_DEVICE(0x045e, 0x00f5), BSF(SN9C105
, OV7660
, F_PDN_INV
)},
2910 {USB_DEVICE(0x045e, 0x00f7), BSF(SN9C105
, OV7660
, F_PDN_INV
)},
2911 {USB_DEVICE(0x0471, 0x0327), BS(SN9C105
, MI0360
)},
2912 {USB_DEVICE(0x0471, 0x0328), BS(SN9C105
, MI0360
)},
2913 {USB_DEVICE(0x0471, 0x0330), BS(SN9C105
, MI0360
)},
2914 {USB_DEVICE(0x06f8, 0x3004), BS(SN9C105
, OV7660
)},
2915 {USB_DEVICE(0x06f8, 0x3008), BS(SN9C105
, OV7660
)},
2916 /* {USB_DEVICE(0x0c45, 0x603a), BS(SN9C102P, OV7648)}, */
2917 {USB_DEVICE(0x0c45, 0x6040), BS(SN9C102P
, HV7131R
)},
2918 /* {USB_DEVICE(0x0c45, 0x607a), BS(SN9C102P, OV7648)}, */
2919 /* {USB_DEVICE(0x0c45, 0x607b), BS(SN9C102P, OV7660)}, */
2920 {USB_DEVICE(0x0c45, 0x607c), BS(SN9C102P
, HV7131R
)},
2921 /* {USB_DEVICE(0x0c45, 0x607e), BS(SN9C102P, OV7630)}, */
2922 {USB_DEVICE(0x0c45, 0x60c0), BSF(SN9C105
, MI0360
, F_ILLUM
)},
2924 /* {USB_DEVICE(0x0c45, 0x60c2), BS(SN9C105, P1030xC)}, */
2925 /* {USB_DEVICE(0x0c45, 0x60c8), BS(SN9C105, OM6802)}, */
2926 /* {USB_DEVICE(0x0c45, 0x60cc), BS(SN9C105, HV7131GP)}, */
2927 {USB_DEVICE(0x0c45, 0x60ce), BS(SN9C105
, SP80708
)},
2928 {USB_DEVICE(0x0c45, 0x60ec), BS(SN9C105
, MO4000
)},
2929 /* {USB_DEVICE(0x0c45, 0x60ef), BS(SN9C105, ICM105C)}, */
2930 /* {USB_DEVICE(0x0c45, 0x60fa), BS(SN9C105, OV7648)}, */
2931 /* {USB_DEVICE(0x0c45, 0x60f2), BS(SN9C105, OV7660)}, */
2932 {USB_DEVICE(0x0c45, 0x60fb), BS(SN9C105
, OV7660
)},
2933 {USB_DEVICE(0x0c45, 0x60fc), BS(SN9C105
, HV7131R
)},
2934 {USB_DEVICE(0x0c45, 0x60fe), BS(SN9C105
, OV7630
)},
2935 {USB_DEVICE(0x0c45, 0x6100), BS(SN9C120
, MI0360
)}, /*sn9c128*/
2936 {USB_DEVICE(0x0c45, 0x6102), BS(SN9C120
, PO2030N
)}, /* /GC0305*/
2937 /* {USB_DEVICE(0x0c45, 0x6108), BS(SN9C120, OM6802)}, */
2938 {USB_DEVICE(0x0c45, 0x610a), BS(SN9C120
, OV7648
)}, /*sn9c128*/
2939 {USB_DEVICE(0x0c45, 0x610b), BS(SN9C120
, OV7660
)}, /*sn9c128*/
2940 {USB_DEVICE(0x0c45, 0x610c), BS(SN9C120
, HV7131R
)}, /*sn9c128*/
2941 {USB_DEVICE(0x0c45, 0x610e), BS(SN9C120
, OV7630
)}, /*sn9c128*/
2942 /* {USB_DEVICE(0x0c45, 0x610f), BS(SN9C120, S5K53BEB)}, */
2943 /* {USB_DEVICE(0x0c45, 0x6122), BS(SN9C110, ICM105C)}, */
2944 /* {USB_DEVICE(0x0c45, 0x6123), BS(SN9C110, SanyoCCD)}, */
2945 {USB_DEVICE(0x0c45, 0x6128), BS(SN9C120
, OM6802
)}, /*sn9c325?*/
2947 {USB_DEVICE(0x0c45, 0x612a), BS(SN9C120
, OV7648
)}, /*sn9c325?*/
2948 {USB_DEVICE(0x0c45, 0x612b), BS(SN9C110
, ADCM1700
)},
2949 {USB_DEVICE(0x0c45, 0x612c), BS(SN9C110
, MO4000
)},
2950 {USB_DEVICE(0x0c45, 0x612e), BS(SN9C110
, OV7630
)},
2951 /* {USB_DEVICE(0x0c45, 0x612f), BS(SN9C110, ICM105C)}, */
2952 {USB_DEVICE(0x0c45, 0x6130), BS(SN9C120
, MI0360
)},
2953 /* or MT9V111 / MI0360B */
2954 /* {USB_DEVICE(0x0c45, 0x6132), BS(SN9C120, OV7670)}, */
2955 {USB_DEVICE(0x0c45, 0x6138), BS(SN9C120
, MO4000
)},
2956 {USB_DEVICE(0x0c45, 0x613a), BS(SN9C120
, OV7648
)},
2957 {USB_DEVICE(0x0c45, 0x613b), BS(SN9C120
, OV7660
)},
2958 {USB_DEVICE(0x0c45, 0x613c), BS(SN9C120
, HV7131R
)},
2959 {USB_DEVICE(0x0c45, 0x613e), BS(SN9C120
, OV7630
)},
2960 {USB_DEVICE(0x0c45, 0x6142), BS(SN9C120
, PO2030N
)}, /*sn9c120b*/
2961 /* or GC0305 / GC0307 */
2962 {USB_DEVICE(0x0c45, 0x6143), BS(SN9C120
, SP80708
)}, /*sn9c120b*/
2963 {USB_DEVICE(0x0c45, 0x6148), BS(SN9C120
, OM6802
)}, /*sn9c120b*/
2964 {USB_DEVICE(0x0c45, 0x614a), BSF(SN9C120
, ADCM1700
, F_ILLUM
)},
2965 /* {USB_DEVICE(0x0c45, 0x614c), BS(SN9C120, GC0306)}, */ /*sn9c120b*/
2968 MODULE_DEVICE_TABLE(usb
, device_table
);
2970 /* -- device connect -- */
2971 static int sd_probe(struct usb_interface
*intf
,
2972 const struct usb_device_id
*id
)
2974 return gspca_dev_probe(intf
, id
, &sd_desc
, sizeof(struct sd
),
2978 static struct usb_driver sd_driver
= {
2979 .name
= MODULE_NAME
,
2980 .id_table
= device_table
,
2982 .disconnect
= gspca_disconnect
,
2984 .suspend
= gspca_suspend
,
2985 .resume
= gspca_resume
,
2986 .reset_resume
= gspca_resume
,
2990 module_usb_driver(sd_driver
);