1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * OV519 driver
4 *
5 * Copyright (C) 2008-2011 Jean-François Moine <moinejf@free.fr>
6 * Copyright (C) 2009 Hans de Goede <hdegoede@redhat.com>
7 *
8 * This module is adapted from the ov51x-jpeg package, which itself
9 * was adapted from the ov511 driver.
10 *
11 * Original copyright for the ov511 driver is:
12 *
13 * Copyright (c) 1999-2006 Mark W. McClelland
14 * Support for OV519, OV8610 Copyright (c) 2003 Joerg Heckenbach
15 * Many improvements by Bret Wallach <bwallac1@san.rr.com>
16 * Color fixes by by Orion Sky Lawlor <olawlor@acm.org> (2/26/2000)
17 * OV7620 fixes by Charl P. Botha <cpbotha@ieee.org>
18 * Changes by Claudio Matsuoka <claudio@conectiva.com>
19 *
20 * ov51x-jpeg original copyright is:
21 *
22 * Copyright (c) 2004-2007 Romain Beauxis <toots@rastageeks.org>
23 * Support for OV7670 sensors was contributed by Sam Skipsey <aoanla@yahoo.com>
24 */
25
26 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
27
28 #define MODULE_NAME "ov519"
29
30 #include <linux/input.h>
31 #include "gspca.h"
32
33 /* The jpeg_hdr is used by w996Xcf only */
34 /* The CONEX_CAM define for jpeg.h needs renaming, now its used here too */
35 #define CONEX_CAM
36 #include "jpeg.h"
37
38 MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
39 MODULE_DESCRIPTION("OV519 USB Camera Driver");
40 MODULE_LICENSE("GPL");
41
42 /* global parameters */
43 static int frame_rate;
44
45 /* Number of times to retry a failed I2C transaction. Increase this if you
46 * are getting "Failed to read sensor ID..." */
47 static int i2c_detect_tries = 10;
48
49 /* ov519 device descriptor */
50 struct sd {
51 struct gspca_dev gspca_dev; /* !! must be the first item */
52
53 struct v4l2_ctrl *jpegqual;
54 struct v4l2_ctrl *freq;
55 struct { /* h/vflip control cluster */
56 struct v4l2_ctrl *hflip;
57 struct v4l2_ctrl *vflip;
58 };
59 struct { /* autobrightness/brightness control cluster */
60 struct v4l2_ctrl *autobright;
61 struct v4l2_ctrl *brightness;
62 };
63
64 u8 revision;
65
66 u8 packet_nr;
67
68 char bridge;
69 #define BRIDGE_OV511 0
70 #define BRIDGE_OV511PLUS 1
71 #define BRIDGE_OV518 2
72 #define BRIDGE_OV518PLUS 3
73 #define BRIDGE_OV519 4 /* = ov530 */
74 #define BRIDGE_OVFX2 5
75 #define BRIDGE_W9968CF 6
76 #define BRIDGE_MASK 7
77
78 char invert_led;
79 #define BRIDGE_INVERT_LED 8
80
81 char snapshot_pressed;
82 char snapshot_needs_reset;
83
84 /* Determined by sensor type */
85 u8 sif;
86
87 #define QUALITY_MIN 50
88 #define QUALITY_MAX 70
89 #define QUALITY_DEF 50
90
91 u8 stopped; /* Streaming is temporarily paused */
92 u8 first_frame;
93
94 u8 frame_rate; /* current Framerate */
95 u8 clockdiv; /* clockdiv override */
96
97 s8 sensor; /* Type of image sensor chip (SEN_*) */
98
99 u8 sensor_addr;
100 u16 sensor_width;
101 u16 sensor_height;
102 s16 sensor_reg_cache[256];
103
104 u8 jpeg_hdr[JPEG_HDR_SZ];
105 };
106 enum sensors {
107 SEN_OV2610,
108 SEN_OV2610AE,
109 SEN_OV3610,
110 SEN_OV6620,
111 SEN_OV6630,
112 SEN_OV66308AF,
113 SEN_OV7610,
114 SEN_OV7620,
115 SEN_OV7620AE,
116 SEN_OV7640,
117 SEN_OV7648,
118 SEN_OV7660,
119 SEN_OV7670,
120 SEN_OV76BE,
121 SEN_OV8610,
122 SEN_OV9600,
123 };
124
125 /* Note this is a bit of a hack, but the w9968cf driver needs the code for all
126 the ov sensors which is already present here. When we have the time we
127 really should move the sensor drivers to v4l2 sub drivers. */
128 #include "w996Xcf.c"
129
130 /* table of the disabled controls */
131 struct ctrl_valid {
132 unsigned int has_brightness:1;
133 unsigned int has_contrast:1;
134 unsigned int has_exposure:1;
135 unsigned int has_autogain:1;
136 unsigned int has_sat:1;
137 unsigned int has_hvflip:1;
138 unsigned int has_autobright:1;
139 unsigned int has_freq:1;
140 };
141
142 static const struct ctrl_valid valid_controls[] = {
143 [SEN_OV2610] = {
144 .has_exposure = 1,
145 .has_autogain = 1,
146 },
147 [SEN_OV2610AE] = {
148 .has_exposure = 1,
149 .has_autogain = 1,
150 },
151 [SEN_OV3610] = {
152 /* No controls */
153 },
154 [SEN_OV6620] = {
155 .has_brightness = 1,
156 .has_contrast = 1,
157 .has_sat = 1,
158 .has_autobright = 1,
159 .has_freq = 1,
160 },
161 [SEN_OV6630] = {
162 .has_brightness = 1,
163 .has_contrast = 1,
164 .has_sat = 1,
165 .has_autobright = 1,
166 .has_freq = 1,
167 },
168 [SEN_OV66308AF] = {
169 .has_brightness = 1,
170 .has_contrast = 1,
171 .has_sat = 1,
172 .has_autobright = 1,
173 .has_freq = 1,
174 },
175 [SEN_OV7610] = {
176 .has_brightness = 1,
177 .has_contrast = 1,
178 .has_sat = 1,
179 .has_autobright = 1,
180 .has_freq = 1,
181 },
182 [SEN_OV7620] = {
183 .has_brightness = 1,
184 .has_contrast = 1,
185 .has_sat = 1,
186 .has_autobright = 1,
187 .has_freq = 1,
188 },
189 [SEN_OV7620AE] = {
190 .has_brightness = 1,
191 .has_contrast = 1,
192 .has_sat = 1,
193 .has_autobright = 1,
194 .has_freq = 1,
195 },
196 [SEN_OV7640] = {
197 .has_brightness = 1,
198 .has_sat = 1,
199 .has_freq = 1,
200 },
201 [SEN_OV7648] = {
202 .has_brightness = 1,
203 .has_sat = 1,
204 .has_freq = 1,
205 },
206 [SEN_OV7660] = {
207 .has_brightness = 1,
208 .has_contrast = 1,
209 .has_sat = 1,
210 .has_hvflip = 1,
211 .has_freq = 1,
212 },
213 [SEN_OV7670] = {
214 .has_brightness = 1,
215 .has_contrast = 1,
216 .has_hvflip = 1,
217 .has_freq = 1,
218 },
219 [SEN_OV76BE] = {
220 .has_brightness = 1,
221 .has_contrast = 1,
222 .has_sat = 1,
223 .has_autobright = 1,
224 .has_freq = 1,
225 },
226 [SEN_OV8610] = {
227 .has_brightness = 1,
228 .has_contrast = 1,
229 .has_sat = 1,
230 .has_autobright = 1,
231 },
232 [SEN_OV9600] = {
233 .has_exposure = 1,
234 .has_autogain = 1,
235 },
236 };
237
238 static const struct v4l2_pix_format ov519_vga_mode[] = {
239 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
240 .bytesperline = 320,
241 .sizeimage = 320 * 240 * 3 / 8 + 590,
242 .colorspace = V4L2_COLORSPACE_JPEG,
243 .priv = 1},
244 {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
245 .bytesperline = 640,
246 .sizeimage = 640 * 480 * 3 / 8 + 590,
247 .colorspace = V4L2_COLORSPACE_JPEG,
248 .priv = 0},
249 };
250 static const struct v4l2_pix_format ov519_sif_mode[] = {
251 {160, 120, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
252 .bytesperline = 160,
253 .sizeimage = 160 * 120 * 3 / 8 + 590,
254 .colorspace = V4L2_COLORSPACE_JPEG,
255 .priv = 3},
256 {176, 144, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
257 .bytesperline = 176,
258 .sizeimage = 176 * 144 * 3 / 8 + 590,
259 .colorspace = V4L2_COLORSPACE_JPEG,
260 .priv = 1},
261 {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
262 .bytesperline = 320,
263 .sizeimage = 320 * 240 * 3 / 8 + 590,
264 .colorspace = V4L2_COLORSPACE_JPEG,
265 .priv = 2},
266 {352, 288, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
267 .bytesperline = 352,
268 .sizeimage = 352 * 288 * 3 / 8 + 590,
269 .colorspace = V4L2_COLORSPACE_JPEG,
270 .priv = 0},
271 };
272
273 /* Note some of the sizeimage values for the ov511 / ov518 may seem
274 larger then necessary, however they need to be this big as the ov511 /
275 ov518 always fills the entire isoc frame, using 0 padding bytes when
276 it doesn't have any data. So with low framerates the amount of data
277 transferred can become quite large (libv4l will remove all the 0 padding
278 in userspace). */
279 static const struct v4l2_pix_format ov518_vga_mode[] = {
280 {320, 240, V4L2_PIX_FMT_OV518, V4L2_FIELD_NONE,
281 .bytesperline = 320,
282 .sizeimage = 320 * 240 * 3,
283 .colorspace = V4L2_COLORSPACE_JPEG,
284 .priv = 1},
285 {640, 480, V4L2_PIX_FMT_OV518, V4L2_FIELD_NONE,
286 .bytesperline = 640,
287 .sizeimage = 640 * 480 * 2,
288 .colorspace = V4L2_COLORSPACE_JPEG,
289 .priv = 0},
290 };
291 static const struct v4l2_pix_format ov518_sif_mode[] = {
292 {160, 120, V4L2_PIX_FMT_OV518, V4L2_FIELD_NONE,
293 .bytesperline = 160,
294 .sizeimage = 70000,
295 .colorspace = V4L2_COLORSPACE_JPEG,
296 .priv = 3},
297 {176, 144, V4L2_PIX_FMT_OV518, V4L2_FIELD_NONE,
298 .bytesperline = 176,
299 .sizeimage = 70000,
300 .colorspace = V4L2_COLORSPACE_JPEG,
301 .priv = 1},
302 {320, 240, V4L2_PIX_FMT_OV518, V4L2_FIELD_NONE,
303 .bytesperline = 320,
304 .sizeimage = 320 * 240 * 3,
305 .colorspace = V4L2_COLORSPACE_JPEG,
306 .priv = 2},
307 {352, 288, V4L2_PIX_FMT_OV518, V4L2_FIELD_NONE,
308 .bytesperline = 352,
309 .sizeimage = 352 * 288 * 3,
310 .colorspace = V4L2_COLORSPACE_JPEG,
311 .priv = 0},
312 };
313
314 static const struct v4l2_pix_format ov511_vga_mode[] = {
315 {320, 240, V4L2_PIX_FMT_OV511, V4L2_FIELD_NONE,
316 .bytesperline = 320,
317 .sizeimage = 320 * 240 * 3,
318 .colorspace = V4L2_COLORSPACE_JPEG,
319 .priv = 1},
320 {640, 480, V4L2_PIX_FMT_OV511, V4L2_FIELD_NONE,
321 .bytesperline = 640,
322 .sizeimage = 640 * 480 * 2,
323 .colorspace = V4L2_COLORSPACE_JPEG,
324 .priv = 0},
325 };
326 static const struct v4l2_pix_format ov511_sif_mode[] = {
327 {160, 120, V4L2_PIX_FMT_OV511, V4L2_FIELD_NONE,
328 .bytesperline = 160,
329 .sizeimage = 70000,
330 .colorspace = V4L2_COLORSPACE_JPEG,
331 .priv = 3},
332 {176, 144, V4L2_PIX_FMT_OV511, V4L2_FIELD_NONE,
333 .bytesperline = 176,
334 .sizeimage = 70000,
335 .colorspace = V4L2_COLORSPACE_JPEG,
336 .priv = 1},
337 {320, 240, V4L2_PIX_FMT_OV511, V4L2_FIELD_NONE,
338 .bytesperline = 320,
339 .sizeimage = 320 * 240 * 3,
340 .colorspace = V4L2_COLORSPACE_JPEG,
341 .priv = 2},
342 {352, 288, V4L2_PIX_FMT_OV511, V4L2_FIELD_NONE,
343 .bytesperline = 352,
344 .sizeimage = 352 * 288 * 3,
345 .colorspace = V4L2_COLORSPACE_JPEG,
346 .priv = 0},
347 };
348
349 static const struct v4l2_pix_format ovfx2_ov2610_mode[] = {
350 {800, 600, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
351 .bytesperline = 800,
352 .sizeimage = 800 * 600,
353 .colorspace = V4L2_COLORSPACE_SRGB,
354 .priv = 1},
355 {1600, 1200, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
356 .bytesperline = 1600,
357 .sizeimage = 1600 * 1200,
358 .colorspace = V4L2_COLORSPACE_SRGB},
359 };
360 static const struct v4l2_pix_format ovfx2_ov3610_mode[] = {
361 {640, 480, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
362 .bytesperline = 640,
363 .sizeimage = 640 * 480,
364 .colorspace = V4L2_COLORSPACE_SRGB,
365 .priv = 1},
366 {800, 600, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
367 .bytesperline = 800,
368 .sizeimage = 800 * 600,
369 .colorspace = V4L2_COLORSPACE_SRGB,
370 .priv = 1},
371 {1024, 768, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
372 .bytesperline = 1024,
373 .sizeimage = 1024 * 768,
374 .colorspace = V4L2_COLORSPACE_SRGB,
375 .priv = 1},
376 {1600, 1200, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
377 .bytesperline = 1600,
378 .sizeimage = 1600 * 1200,
379 .colorspace = V4L2_COLORSPACE_SRGB,
380 .priv = 0},
381 {2048, 1536, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
382 .bytesperline = 2048,
383 .sizeimage = 2048 * 1536,
384 .colorspace = V4L2_COLORSPACE_SRGB,
385 .priv = 0},
386 };
387 static const struct v4l2_pix_format ovfx2_ov9600_mode[] = {
388 {640, 480, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
389 .bytesperline = 640,
390 .sizeimage = 640 * 480,
391 .colorspace = V4L2_COLORSPACE_SRGB,
392 .priv = 1},
393 {1280, 1024, V4L2_PIX_FMT_SBGGR8, V4L2_FIELD_NONE,
394 .bytesperline = 1280,
395 .sizeimage = 1280 * 1024,
396 .colorspace = V4L2_COLORSPACE_SRGB},
397 };
398
399 /* Registers common to OV511 / OV518 */
400 #define R51x_FIFO_PSIZE 0x30 /* 2 bytes wide w/ OV518(+) */
401 #define R51x_SYS_RESET 0x50
402 /* Reset type flags */
403 #define OV511_RESET_OMNICE 0x08
404 #define R51x_SYS_INIT 0x53
405 #define R51x_SYS_SNAP 0x52
406 #define R51x_SYS_CUST_ID 0x5f
407 #define R51x_COMP_LUT_BEGIN 0x80
408
409 /* OV511 Camera interface register numbers */
410 #define R511_CAM_DELAY 0x10
411 #define R511_CAM_EDGE 0x11
412 #define R511_CAM_PXCNT 0x12
413 #define R511_CAM_LNCNT 0x13
414 #define R511_CAM_PXDIV 0x14
415 #define R511_CAM_LNDIV 0x15
416 #define R511_CAM_UV_EN 0x16
417 #define R511_CAM_LINE_MODE 0x17
418 #define R511_CAM_OPTS 0x18
419
420 #define R511_SNAP_FRAME 0x19
421 #define R511_SNAP_PXCNT 0x1a
422 #define R511_SNAP_LNCNT 0x1b
423 #define R511_SNAP_PXDIV 0x1c
424 #define R511_SNAP_LNDIV 0x1d
425 #define R511_SNAP_UV_EN 0x1e
426 #define R511_SNAP_OPTS 0x1f
427
428 #define R511_DRAM_FLOW_CTL 0x20
429 #define R511_FIFO_OPTS 0x31
430 #define R511_I2C_CTL 0x40
431 #define R511_SYS_LED_CTL 0x55 /* OV511+ only */
432 #define R511_COMP_EN 0x78
433 #define R511_COMP_LUT_EN 0x79
434
435 /* OV518 Camera interface register numbers */
436 #define R518_GPIO_OUT 0x56 /* OV518(+) only */
437 #define R518_GPIO_CTL 0x57 /* OV518(+) only */
438
439 /* OV519 Camera interface register numbers */
440 #define OV519_R10_H_SIZE 0x10
441 #define OV519_R11_V_SIZE 0x11
442 #define OV519_R12_X_OFFSETL 0x12
443 #define OV519_R13_X_OFFSETH 0x13
444 #define OV519_R14_Y_OFFSETL 0x14
445 #define OV519_R15_Y_OFFSETH 0x15
446 #define OV519_R16_DIVIDER 0x16
447 #define OV519_R20_DFR 0x20
448 #define OV519_R25_FORMAT 0x25
449
450 /* OV519 System Controller register numbers */
451 #define OV519_R51_RESET1 0x51
452 #define OV519_R54_EN_CLK1 0x54
453 #define OV519_R57_SNAPSHOT 0x57
454
455 #define OV519_GPIO_DATA_OUT0 0x71
456 #define OV519_GPIO_IO_CTRL0 0x72
457
458 /*#define OV511_ENDPOINT_ADDRESS 1 * Isoc endpoint number */
459
460 /*
461 * The FX2 chip does not give us a zero length read at end of frame.
462 * It does, however, give a short read at the end of a frame, if
463 * necessary, rather than run two frames together.
464 *
465 * By choosing the right bulk transfer size, we are guaranteed to always
466 * get a short read for the last read of each frame. Frame sizes are
467 * always a composite number (width * height, or a multiple) so if we
468 * choose a prime number, we are guaranteed that the last read of a
469 * frame will be short.
470 *
471 * But it isn't that easy: the 2.6 kernel requires a multiple of 4KB,
472 * otherwise EOVERFLOW "babbling" errors occur. I have not been able
473 * to figure out why. [PMiller]
474 *
475 * The constant (13 * 4096) is the largest "prime enough" number less than 64KB.
476 *
477 * It isn't enough to know the number of bytes per frame, in case we
478 * have data dropouts or buffer overruns (even though the FX2 double
479 * buffers, there are some pretty strict real time constraints for
480 * isochronous transfer for larger frame sizes).
481 */
482 /*jfm: this value does not work for 800x600 - see isoc_init */
483 #define OVFX2_BULK_SIZE (13 * 4096)
484
485 /* I2C registers */
486 #define R51x_I2C_W_SID 0x41
487 #define R51x_I2C_SADDR_3 0x42
488 #define R51x_I2C_SADDR_2 0x43
489 #define R51x_I2C_R_SID 0x44
490 #define R51x_I2C_DATA 0x45
491 #define R518_I2C_CTL 0x47 /* OV518(+) only */
492 #define OVFX2_I2C_ADDR 0x00
493
494 /* I2C ADDRESSES */
495 #define OV7xx0_SID 0x42
496 #define OV_HIRES_SID 0x60 /* OV9xxx / OV2xxx / OV3xxx */
497 #define OV8xx0_SID 0xa0
498 #define OV6xx0_SID 0xc0
499
500 /* OV7610 registers */
501 #define OV7610_REG_GAIN 0x00 /* gain setting (5:0) */
502 #define OV7610_REG_BLUE 0x01 /* blue channel balance */
503 #define OV7610_REG_RED 0x02 /* red channel balance */
504 #define OV7610_REG_SAT 0x03 /* saturation */
505 #define OV8610_REG_HUE 0x04 /* 04 reserved */
506 #define OV7610_REG_CNT 0x05 /* Y contrast */
507 #define OV7610_REG_BRT 0x06 /* Y brightness */
508 #define OV7610_REG_COM_C 0x14 /* misc common regs */
509 #define OV7610_REG_ID_HIGH 0x1c /* manufacturer ID MSB */
510 #define OV7610_REG_ID_LOW 0x1d /* manufacturer ID LSB */
511 #define OV7610_REG_COM_I 0x29 /* misc settings */
512
513 /* OV7660 and OV7670 registers */
514 #define OV7670_R00_GAIN 0x00 /* Gain lower 8 bits (rest in vref) */
515 #define OV7670_R01_BLUE 0x01 /* blue gain */
516 #define OV7670_R02_RED 0x02 /* red gain */
517 #define OV7670_R03_VREF 0x03 /* Pieces of GAIN, VSTART, VSTOP */
518 #define OV7670_R04_COM1 0x04 /* Control 1 */
519 /*#define OV7670_R07_AECHH 0x07 * AEC MS 5 bits */
520 #define OV7670_R0C_COM3 0x0c /* Control 3 */
521 #define OV7670_R0D_COM4 0x0d /* Control 4 */
522 #define OV7670_R0E_COM5 0x0e /* All "reserved" */
523 #define OV7670_R0F_COM6 0x0f /* Control 6 */
524 #define OV7670_R10_AECH 0x10 /* More bits of AEC value */
525 #define OV7670_R11_CLKRC 0x11 /* Clock control */
526 #define OV7670_R12_COM7 0x12 /* Control 7 */
527 #define OV7670_COM7_FMT_VGA 0x00
528 /*#define OV7670_COM7_YUV 0x00 * YUV */
529 #define OV7670_COM7_FMT_QVGA 0x10 /* QVGA format */
530 #define OV7670_COM7_FMT_MASK 0x38
531 #define OV7670_COM7_RESET 0x80 /* Register reset */
532 #define OV7670_R13_COM8 0x13 /* Control 8 */
533 #define OV7670_COM8_AEC 0x01 /* Auto exposure enable */
534 #define OV7670_COM8_AWB 0x02 /* White balance enable */
535 #define OV7670_COM8_AGC 0x04 /* Auto gain enable */
536 #define OV7670_COM8_BFILT 0x20 /* Band filter enable */
537 #define OV7670_COM8_AECSTEP 0x40 /* Unlimited AEC step size */
538 #define OV7670_COM8_FASTAEC 0x80 /* Enable fast AGC/AEC */
539 #define OV7670_R14_COM9 0x14 /* Control 9 - gain ceiling */
540 #define OV7670_R15_COM10 0x15 /* Control 10 */
541 #define OV7670_R17_HSTART 0x17 /* Horiz start high bits */
542 #define OV7670_R18_HSTOP 0x18 /* Horiz stop high bits */
543 #define OV7670_R19_VSTART 0x19 /* Vert start high bits */
544 #define OV7670_R1A_VSTOP 0x1a /* Vert stop high bits */
545 #define OV7670_R1E_MVFP 0x1e /* Mirror / vflip */
546 #define OV7670_MVFP_VFLIP 0x10 /* vertical flip */
547 #define OV7670_MVFP_MIRROR 0x20 /* Mirror image */
548 #define OV7670_R24_AEW 0x24 /* AGC upper limit */
549 #define OV7670_R25_AEB 0x25 /* AGC lower limit */
550 #define OV7670_R26_VPT 0x26 /* AGC/AEC fast mode op region */
551 #define OV7670_R32_HREF 0x32 /* HREF pieces */
552 #define OV7670_R3A_TSLB 0x3a /* lots of stuff */
553 #define OV7670_R3B_COM11 0x3b /* Control 11 */
554 #define OV7670_COM11_EXP 0x02
555 #define OV7670_COM11_HZAUTO 0x10 /* Auto detect 50/60 Hz */
556 #define OV7670_R3C_COM12 0x3c /* Control 12 */
557 #define OV7670_R3D_COM13 0x3d /* Control 13 */
558 #define OV7670_COM13_GAMMA 0x80 /* Gamma enable */
559 #define OV7670_COM13_UVSAT 0x40 /* UV saturation auto adjustment */
560 #define OV7670_R3E_COM14 0x3e /* Control 14 */
561 #define OV7670_R3F_EDGE 0x3f /* Edge enhancement factor */
562 #define OV7670_R40_COM15 0x40 /* Control 15 */
563 /*#define OV7670_COM15_R00FF 0xc0 * 00 to FF */
564 #define OV7670_R41_COM16 0x41 /* Control 16 */
565 #define OV7670_COM16_AWBGAIN 0x08 /* AWB gain enable */
566 /* end of ov7660 common registers */
567 #define OV7670_R55_BRIGHT 0x55 /* Brightness */
568 #define OV7670_R56_CONTRAS 0x56 /* Contrast control */
569 #define OV7670_R69_GFIX 0x69 /* Fix gain control */
570 /*#define OV7670_R8C_RGB444 0x8c * RGB 444 control */
571 #define OV7670_R9F_HAECC1 0x9f /* Hist AEC/AGC control 1 */
572 #define OV7670_RA0_HAECC2 0xa0 /* Hist AEC/AGC control 2 */
573 #define OV7670_RA5_BD50MAX 0xa5 /* 50hz banding step limit */
574 #define OV7670_RA6_HAECC3 0xa6 /* Hist AEC/AGC control 3 */
575 #define OV7670_RA7_HAECC4 0xa7 /* Hist AEC/AGC control 4 */
576 #define OV7670_RA8_HAECC5 0xa8 /* Hist AEC/AGC control 5 */
577 #define OV7670_RA9_HAECC6 0xa9 /* Hist AEC/AGC control 6 */
578 #define OV7670_RAA_HAECC7 0xaa /* Hist AEC/AGC control 7 */
579 #define OV7670_RAB_BD60MAX 0xab /* 60hz banding step limit */
580
581 struct ov_regvals {
582 u8 reg;
583 u8 val;
584 };
585 struct ov_i2c_regvals {
586 u8 reg;
587 u8 val;
588 };
589
590 /* Settings for OV2610 camera chip */
591 static const struct ov_i2c_regvals norm_2610[] = {
592 { 0x12, 0x80 }, /* reset */
593 };
594
595 static const struct ov_i2c_regvals norm_2610ae[] = {
596 {0x12, 0x80}, /* reset */
597 {0x13, 0xcd},
598 {0x09, 0x01},
599 {0x0d, 0x00},
600 {0x11, 0x80},
601 {0x12, 0x20}, /* 1600x1200 */
602 {0x33, 0x0c},
603 {0x35, 0x90},
604 {0x36, 0x37},
605 /* ms-win traces */
606 {0x11, 0x83}, /* clock / 3 ? */
607 {0x2d, 0x00}, /* 60 Hz filter */
608 {0x24, 0xb0}, /* normal colors */
609 {0x25, 0x90},
610 {0x10, 0x43},
611 };
612
613 static const struct ov_i2c_regvals norm_3620b[] = {
614 /*
615 * From the datasheet: "Note that after writing to register COMH
616 * (0x12) to change the sensor mode, registers related to the
617 * sensor’s cropping window will be reset back to their default
618 * values."
619 *
620 * "wait 4096 external clock ... to make sure the sensor is
621 * stable and ready to access registers" i.e. 160us at 24MHz
622 */
623 { 0x12, 0x80 }, /* COMH reset */
624 { 0x12, 0x00 }, /* QXGA, master */
625
626 /*
627 * 11 CLKRC "Clock Rate Control"
628 * [7] internal frequency doublers: on
629 * [6] video port mode: master
630 * [5:0] clock divider: 1
631 */
632 { 0x11, 0x80 },
633
634 /*
635 * 13 COMI "Common Control I"
636 * = 192 (0xC0) 11000000
637 * COMI[7] "AEC speed selection"
638 * = 1 (0x01) 1....... "Faster AEC correction"
639 * COMI[6] "AEC speed step selection"
640 * = 1 (0x01) .1...... "Big steps, fast"
641 * COMI[5] "Banding filter on off"
642 * = 0 (0x00) ..0..... "Off"
643 * COMI[4] "Banding filter option"
644 * = 0 (0x00) ...0.... "Main clock is 48 MHz and
645 * the PLL is ON"
646 * COMI[3] "Reserved"
647 * = 0 (0x00) ....0...
648 * COMI[2] "AGC auto manual control selection"
649 * = 0 (0x00) .....0.. "Manual"
650 * COMI[1] "AWB auto manual control selection"
651 * = 0 (0x00) ......0. "Manual"
652 * COMI[0] "Exposure control"
653 * = 0 (0x00) .......0 "Manual"
654 */
655 { 0x13, 0xc0 },
656
657 /*
658 * 09 COMC "Common Control C"
659 * = 8 (0x08) 00001000
660 * COMC[7:5] "Reserved"
661 * = 0 (0x00) 000.....
662 * COMC[4] "Sleep Mode Enable"
663 * = 0 (0x00) ...0.... "Normal mode"
664 * COMC[3:2] "Sensor sampling reset timing selection"
665 * = 2 (0x02) ....10.. "Longer reset time"
666 * COMC[1:0] "Output drive current select"
667 * = 0 (0x00) ......00 "Weakest"
668 */
669 { 0x09, 0x08 },
670
671 /*
672 * 0C COMD "Common Control D"
673 * = 8 (0x08) 00001000
674 * COMD[7] "Reserved"
675 * = 0 (0x00) 0.......
676 * COMD[6] "Swap MSB and LSB at the output port"
677 * = 0 (0x00) .0...... "False"
678 * COMD[5:3] "Reserved"
679 * = 1 (0x01) ..001...
680 * COMD[2] "Output Average On Off"
681 * = 0 (0x00) .....0.. "Output Normal"
682 * COMD[1] "Sensor precharge voltage selection"
683 * = 0 (0x00) ......0. "Selects internal
684 * reference precharge
685 * voltage"
686 * COMD[0] "Snapshot option"
687 * = 0 (0x00) .......0 "Enable live video output
688 * after snapshot sequence"
689 */
690 { 0x0c, 0x08 },
691
692 /*
693 * 0D COME "Common Control E"
694 * = 161 (0xA1) 10100001
695 * COME[7] "Output average option"
696 * = 1 (0x01) 1....... "Output average of 4 pixels"
697 * COME[6] "Anti-blooming control"
698 * = 0 (0x00) .0...... "Off"
699 * COME[5:3] "Reserved"
700 * = 4 (0x04) ..100...
701 * COME[2] "Clock output power down pin status"
702 * = 0 (0x00) .....0.. "Tri-state data output pin
703 * on power down"
704 * COME[1] "Data output pin status selection at power down"
705 * = 0 (0x00) ......0. "Tri-state VSYNC, PCLK,
706 * HREF, and CHSYNC pins on
707 * power down"
708 * COME[0] "Auto zero circuit select"
709 * = 1 (0x01) .......1 "On"
710 */
711 { 0x0d, 0xa1 },
712
713 /*
714 * 0E COMF "Common Control F"
715 * = 112 (0x70) 01110000
716 * COMF[7] "System clock selection"
717 * = 0 (0x00) 0....... "Use 24 MHz system clock"
718 * COMF[6:4] "Reserved"
719 * = 7 (0x07) .111....
720 * COMF[3] "Manual auto negative offset canceling selection"
721 * = 0 (0x00) ....0... "Auto detect negative
722 * offset and cancel it"
723 * COMF[2:0] "Reserved"
724 * = 0 (0x00) .....000
725 */
726 { 0x0e, 0x70 },
727
728 /*
729 * 0F COMG "Common Control G"
730 * = 66 (0x42) 01000010
731 * COMG[7] "Optical black output selection"
732 * = 0 (0x00) 0....... "Disable"
733 * COMG[6] "Black level calibrate selection"
734 * = 1 (0x01) .1...... "Use optical black pixels
735 * to calibrate"
736 * COMG[5:4] "Reserved"
737 * = 0 (0x00) ..00....
738 * COMG[3] "Channel offset adjustment"
739 * = 0 (0x00) ....0... "Disable offset adjustment"
740 * COMG[2] "ADC black level calibration option"
741 * = 0 (0x00) .....0.. "Use B/G line and G/R
742 * line to calibrate each
743 * channel's black level"
744 * COMG[1] "Reserved"
745 * = 1 (0x01) ......1.
746 * COMG[0] "ADC black level calibration enable"
747 * = 0 (0x00) .......0 "Disable"
748 */
749 { 0x0f, 0x42 },
750
751 /*
752 * 14 COMJ "Common Control J"
753 * = 198 (0xC6) 11000110
754 * COMJ[7:6] "AGC gain ceiling"
755 * = 3 (0x03) 11...... "8x"
756 * COMJ[5:4] "Reserved"
757 * = 0 (0x00) ..00....
758 * COMJ[3] "Auto banding filter"
759 * = 0 (0x00) ....0... "Banding filter is always
760 * on off depending on
761 * COMI[5] setting"
762 * COMJ[2] "VSYNC drop option"
763 * = 1 (0x01) .....1.. "SYNC is dropped if frame
764 * data is dropped"
765 * COMJ[1] "Frame data drop"
766 * = 1 (0x01) ......1. "Drop frame data if
767 * exposure is not within
768 * tolerance. In AEC mode,
769 * data is normally dropped
770 * when data is out of
771 * range."
772 * COMJ[0] "Reserved"
773 * = 0 (0x00) .......0
774 */
775 { 0x14, 0xc6 },
776
777 /*
778 * 15 COMK "Common Control K"
779 * = 2 (0x02) 00000010
780 * COMK[7] "CHSYNC pin output swap"
781 * = 0 (0x00) 0....... "CHSYNC"
782 * COMK[6] "HREF pin output swap"
783 * = 0 (0x00) .0...... "HREF"
784 * COMK[5] "PCLK output selection"
785 * = 0 (0x00) ..0..... "PCLK always output"
786 * COMK[4] "PCLK edge selection"
787 * = 0 (0x00) ...0.... "Data valid on falling edge"
788 * COMK[3] "HREF output polarity"
789 * = 0 (0x00) ....0... "positive"
790 * COMK[2] "Reserved"
791 * = 0 (0x00) .....0..
792 * COMK[1] "VSYNC polarity"
793 * = 1 (0x01) ......1. "negative"
794 * COMK[0] "HSYNC polarity"
795 * = 0 (0x00) .......0 "positive"
796 */
797 { 0x15, 0x02 },
798
799 /*
800 * 33 CHLF "Current Control"
801 * = 9 (0x09) 00001001
802 * CHLF[7:6] "Sensor current control"
803 * = 0 (0x00) 00......
804 * CHLF[5] "Sensor current range control"
805 * = 0 (0x00) ..0..... "normal range"
806 * CHLF[4] "Sensor current"
807 * = 0 (0x00) ...0.... "normal current"
808 * CHLF[3] "Sensor buffer current control"
809 * = 1 (0x01) ....1... "half current"
810 * CHLF[2] "Column buffer current control"
811 * = 0 (0x00) .....0.. "normal current"
812 * CHLF[1] "Analog DSP current control"
813 * = 0 (0x00) ......0. "normal current"
814 * CHLF[1] "ADC current control"
815 * = 0 (0x00) ......0. "normal current"
816 */
817 { 0x33, 0x09 },
818
819 /*
820 * 34 VBLM "Blooming Control"
821 * = 80 (0x50) 01010000
822 * VBLM[7] "Hard soft reset switch"
823 * = 0 (0x00) 0....... "Hard reset"
824 * VBLM[6:4] "Blooming voltage selection"
825 * = 5 (0x05) .101....
826 * VBLM[3:0] "Sensor current control"
827 * = 0 (0x00) ....0000
828 */
829 { 0x34, 0x50 },
830
831 /*
832 * 36 VCHG "Sensor Precharge Voltage Control"
833 * = 0 (0x00) 00000000
834 * VCHG[7] "Reserved"
835 * = 0 (0x00) 0.......
836 * VCHG[6:4] "Sensor precharge voltage control"
837 * = 0 (0x00) .000....
838 * VCHG[3:0] "Sensor array common reference"
839 * = 0 (0x00) ....0000
840 */
841 { 0x36, 0x00 },
842
843 /*
844 * 37 ADC "ADC Reference Control"
845 * = 4 (0x04) 00000100
846 * ADC[7:4] "Reserved"
847 * = 0 (0x00) 0000....
848 * ADC[3] "ADC input signal range"
849 * = 0 (0x00) ....0... "Input signal 1.0x"
850 * ADC[2:0] "ADC range control"
851 * = 4 (0x04) .....100
852 */
853 { 0x37, 0x04 },
854
855 /*
856 * 38 ACOM "Analog Common Ground"
857 * = 82 (0x52) 01010010
858 * ACOM[7] "Analog gain control"
859 * = 0 (0x00) 0....... "Gain 1x"
860 * ACOM[6] "Analog black level calibration"
861 * = 1 (0x01) .1...... "On"
862 * ACOM[5:0] "Reserved"
863 * = 18 (0x12) ..010010
864 */
865 { 0x38, 0x52 },
866
867 /*
868 * 3A FREFA "Internal Reference Adjustment"
869 * = 0 (0x00) 00000000
870 * FREFA[7:0] "Range"
871 * = 0 (0x00) 00000000
872 */
873 { 0x3a, 0x00 },
874
875 /*
876 * 3C FVOPT "Internal Reference Adjustment"
877 * = 31 (0x1F) 00011111
878 * FVOPT[7:0] "Range"
879 * = 31 (0x1F) 00011111
880 */
881 { 0x3c, 0x1f },
882
883 /*
884 * 44 Undocumented = 0 (0x00) 00000000
885 * 44[7:0] "It's a secret"
886 * = 0 (0x00) 00000000
887 */
888 { 0x44, 0x00 },
889
890 /*
891 * 40 Undocumented = 0 (0x00) 00000000
892 * 40[7:0] "It's a secret"
893 * = 0 (0x00) 00000000
894 */
895 { 0x40, 0x00 },
896
897 /*
898 * 41 Undocumented = 0 (0x00) 00000000
899 * 41[7:0] "It's a secret"
900 * = 0 (0x00) 00000000
901 */
902 { 0x41, 0x00 },
903
904 /*
905 * 42 Undocumented = 0 (0x00) 00000000
906 * 42[7:0] "It's a secret"
907 * = 0 (0x00) 00000000
908 */
909 { 0x42, 0x00 },
910
911 /*
912 * 43 Undocumented = 0 (0x00) 00000000
913 * 43[7:0] "It's a secret"
914 * = 0 (0x00) 00000000
915 */
916 { 0x43, 0x00 },
917
918 /*
919 * 45 Undocumented = 128 (0x80) 10000000
920 * 45[7:0] "It's a secret"
921 * = 128 (0x80) 10000000
922 */
923 { 0x45, 0x80 },
924
925 /*
926 * 48 Undocumented = 192 (0xC0) 11000000
927 * 48[7:0] "It's a secret"
928 * = 192 (0xC0) 11000000
929 */
930 { 0x48, 0xc0 },
931
932 /*
933 * 49 Undocumented = 25 (0x19) 00011001
934 * 49[7:0] "It's a secret"
935 * = 25 (0x19) 00011001
936 */
937 { 0x49, 0x19 },
938
939 /*
940 * 4B Undocumented = 128 (0x80) 10000000
941 * 4B[7:0] "It's a secret"
942 * = 128 (0x80) 10000000
943 */
944 { 0x4b, 0x80 },
945
946 /*
947 * 4D Undocumented = 196 (0xC4) 11000100
948 * 4D[7:0] "It's a secret"
949 * = 196 (0xC4) 11000100
950 */
951 { 0x4d, 0xc4 },
952
953 /*
954 * 35 VREF "Reference Voltage Control"
955 * = 76 (0x4c) 01001100
956 * VREF[7:5] "Column high reference control"
957 * = 2 (0x02) 010..... "higher voltage"
958 * VREF[4:2] "Column low reference control"
959 * = 3 (0x03) ...011.. "Highest voltage"
960 * VREF[1:0] "Reserved"
961 * = 0 (0x00) ......00
962 */
963 { 0x35, 0x4c },
964
965 /*
966 * 3D Undocumented = 0 (0x00) 00000000
967 * 3D[7:0] "It's a secret"
968 * = 0 (0x00) 00000000
969 */
970 { 0x3d, 0x00 },
971
972 /*
973 * 3E Undocumented = 0 (0x00) 00000000
974 * 3E[7:0] "It's a secret"
975 * = 0 (0x00) 00000000
976 */
977 { 0x3e, 0x00 },
978
979 /*
980 * 3B FREFB "Internal Reference Adjustment"
981 * = 24 (0x18) 00011000
982 * FREFB[7:0] "Range"
983 * = 24 (0x18) 00011000
984 */
985 { 0x3b, 0x18 },
986
987 /*
988 * 33 CHLF "Current Control"
989 * = 25 (0x19) 00011001
990 * CHLF[7:6] "Sensor current control"
991 * = 0 (0x00) 00......
992 * CHLF[5] "Sensor current range control"
993 * = 0 (0x00) ..0..... "normal range"
994 * CHLF[4] "Sensor current"
995 * = 1 (0x01) ...1.... "double current"
996 * CHLF[3] "Sensor buffer current control"
997 * = 1 (0x01) ....1... "half current"
998 * CHLF[2] "Column buffer current control"
999 * = 0 (0x00) .....0.. "normal current"
1000 * CHLF[1] "Analog DSP current control"
1001 * = 0 (0x00) ......0. "normal current"
1002 * CHLF[1] "ADC current control"
1003 * = 0 (0x00) ......0. "normal current"
1004 */
1005 { 0x33, 0x19 },
1006
1007 /*
1008 * 34 VBLM "Blooming Control"
1009 * = 90 (0x5A) 01011010
1010 * VBLM[7] "Hard soft reset switch"
1011 * = 0 (0x00) 0....... "Hard reset"
1012 * VBLM[6:4] "Blooming voltage selection"
1013 * = 5 (0x05) .101....
1014 * VBLM[3:0] "Sensor current control"
1015 * = 10 (0x0A) ....1010
1016 */
1017 { 0x34, 0x5a },
1018
1019 /*
1020 * 3B FREFB "Internal Reference Adjustment"
1021 * = 0 (0x00) 00000000
1022 * FREFB[7:0] "Range"
1023 * = 0 (0x00) 00000000
1024 */
1025 { 0x3b, 0x00 },
1026
1027 /*
1028 * 33 CHLF "Current Control"
1029 * = 9 (0x09) 00001001
1030 * CHLF[7:6] "Sensor current control"
1031 * = 0 (0x00) 00......
1032 * CHLF[5] "Sensor current range control"
1033 * = 0 (0x00) ..0..... "normal range"
1034 * CHLF[4] "Sensor current"
1035 * = 0 (0x00) ...0.... "normal current"
1036 * CHLF[3] "Sensor buffer current control"
1037 * = 1 (0x01) ....1... "half current"
1038 * CHLF[2] "Column buffer current control"
1039 * = 0 (0x00) .....0.. "normal current"
1040 * CHLF[1] "Analog DSP current control"
1041 * = 0 (0x00) ......0. "normal current"
1042 * CHLF[1] "ADC current control"
1043 * = 0 (0x00) ......0. "normal current"
1044 */
1045 { 0x33, 0x09 },
1046
1047 /*
1048 * 34 VBLM "Blooming Control"
1049 * = 80 (0x50) 01010000
1050 * VBLM[7] "Hard soft reset switch"
1051 * = 0 (0x00) 0....... "Hard reset"
1052 * VBLM[6:4] "Blooming voltage selection"
1053 * = 5 (0x05) .101....
1054 * VBLM[3:0] "Sensor current control"
1055 * = 0 (0x00) ....0000
1056 */
1057 { 0x34, 0x50 },
1058
1059 /*
1060 * 12 COMH "Common Control H"
1061 * = 64 (0x40) 01000000
1062 * COMH[7] "SRST"
1063 * = 0 (0x00) 0....... "No-op"
1064 * COMH[6:4] "Resolution selection"
1065 * = 4 (0x04) .100.... "XGA"
1066 * COMH[3] "Master slave selection"
1067 * = 0 (0x00) ....0... "Master mode"
1068 * COMH[2] "Internal B/R channel option"
1069 * = 0 (0x00) .....0.. "B/R use same channel"
1070 * COMH[1] "Color bar test pattern"
1071 * = 0 (0x00) ......0. "Off"
1072 * COMH[0] "Reserved"
1073 * = 0 (0x00) .......0
1074 */
1075 { 0x12, 0x40 },
1076
1077 /*
1078 * 17 HREFST "Horizontal window start"
1079 * = 31 (0x1F) 00011111
1080 * HREFST[7:0] "Horizontal window start, 8 MSBs"
1081 * = 31 (0x1F) 00011111
1082 */
1083 { 0x17, 0x1f },
1084
1085 /*
1086 * 18 HREFEND "Horizontal window end"
1087 * = 95 (0x5F) 01011111
1088 * HREFEND[7:0] "Horizontal Window End, 8 MSBs"
1089 * = 95 (0x5F) 01011111
1090 */
1091 { 0x18, 0x5f },
1092
1093 /*
1094 * 19 VSTRT "Vertical window start"
1095 * = 0 (0x00) 00000000
1096 * VSTRT[7:0] "Vertical Window Start, 8 MSBs"
1097 * = 0 (0x00) 00000000
1098 */
1099 { 0x19, 0x00 },
1100
1101 /*
1102 * 1A VEND "Vertical window end"
1103 * = 96 (0x60) 01100000
1104 * VEND[7:0] "Vertical Window End, 8 MSBs"
1105 * = 96 (0x60) 01100000
1106 */
1107 { 0x1a, 0x60 },
1108
1109 /*
1110 * 32 COMM "Common Control M"
1111 * = 18 (0x12) 00010010
1112 * COMM[7:6] "Pixel clock divide option"
1113 * = 0 (0x00) 00...... "/1"
1114 * COMM[5:3] "Horizontal window end position, 3 LSBs"
1115 * = 2 (0x02) ..010...
1116 * COMM[2:0] "Horizontal window start position, 3 LSBs"
1117 * = 2 (0x02) .....010
1118 */
1119 { 0x32, 0x12 },
1120
1121 /*
1122 * 03 COMA "Common Control A"
1123 * = 74 (0x4A) 01001010
1124 * COMA[7:4] "AWB Update Threshold"
1125 * = 4 (0x04) 0100....
1126 * COMA[3:2] "Vertical window end line control 2 LSBs"
1127 * = 2 (0x02) ....10..
1128 * COMA[1:0] "Vertical window start line control 2 LSBs"
1129 * = 2 (0x02) ......10
1130 */
1131 { 0x03, 0x4a },
1132
1133 /*
1134 * 11 CLKRC "Clock Rate Control"
1135 * = 128 (0x80) 10000000
1136 * CLKRC[7] "Internal frequency doublers on off seclection"
1137 * = 1 (0x01) 1....... "On"
1138 * CLKRC[6] "Digital video master slave selection"
1139 * = 0 (0x00) .0...... "Master mode, sensor
1140 * provides PCLK"
1141 * CLKRC[5:0] "Clock divider { CLK = PCLK/(1+CLKRC[5:0]) }"
1142 * = 0 (0x00) ..000000
1143 */
1144 { 0x11, 0x80 },
1145
1146 /*
1147 * 12 COMH "Common Control H"
1148 * = 0 (0x00) 00000000
1149 * COMH[7] "SRST"
1150 * = 0 (0x00) 0....... "No-op"
1151 * COMH[6:4] "Resolution selection"
1152 * = 0 (0x00) .000.... "QXGA"
1153 * COMH[3] "Master slave selection"
1154 * = 0 (0x00) ....0... "Master mode"
1155 * COMH[2] "Internal B/R channel option"
1156 * = 0 (0x00) .....0.. "B/R use same channel"
1157 * COMH[1] "Color bar test pattern"
1158 * = 0 (0x00) ......0. "Off"
1159 * COMH[0] "Reserved"
1160 * = 0 (0x00) .......0
1161 */
1162 { 0x12, 0x00 },
1163
1164 /*
1165 * 12 COMH "Common Control H"
1166 * = 64 (0x40) 01000000
1167 * COMH[7] "SRST"
1168 * = 0 (0x00) 0....... "No-op"
1169 * COMH[6:4] "Resolution selection"
1170 * = 4 (0x04) .100.... "XGA"
1171 * COMH[3] "Master slave selection"
1172 * = 0 (0x00) ....0... "Master mode"
1173 * COMH[2] "Internal B/R channel option"
1174 * = 0 (0x00) .....0.. "B/R use same channel"
1175 * COMH[1] "Color bar test pattern"
1176 * = 0 (0x00) ......0. "Off"
1177 * COMH[0] "Reserved"
1178 * = 0 (0x00) .......0
1179 */
1180 { 0x12, 0x40 },
1181
1182 /*
1183 * 17 HREFST "Horizontal window start"
1184 * = 31 (0x1F) 00011111
1185 * HREFST[7:0] "Horizontal window start, 8 MSBs"
1186 * = 31 (0x1F) 00011111
1187 */
1188 { 0x17, 0x1f },
1189
1190 /*
1191 * 18 HREFEND "Horizontal window end"
1192 * = 95 (0x5F) 01011111
1193 * HREFEND[7:0] "Horizontal Window End, 8 MSBs"
1194 * = 95 (0x5F) 01011111
1195 */
1196 { 0x18, 0x5f },
1197
1198 /*
1199 * 19 VSTRT "Vertical window start"
1200 * = 0 (0x00) 00000000
1201 * VSTRT[7:0] "Vertical Window Start, 8 MSBs"
1202 * = 0 (0x00) 00000000
1203 */
1204 { 0x19, 0x00 },
1205
1206 /*
1207 * 1A VEND "Vertical window end"
1208 * = 96 (0x60) 01100000
1209 * VEND[7:0] "Vertical Window End, 8 MSBs"
1210 * = 96 (0x60) 01100000
1211 */
1212 { 0x1a, 0x60 },
1213
1214 /*
1215 * 32 COMM "Common Control M"
1216 * = 18 (0x12) 00010010
1217 * COMM[7:6] "Pixel clock divide option"
1218 * = 0 (0x00) 00...... "/1"
1219 * COMM[5:3] "Horizontal window end position, 3 LSBs"
1220 * = 2 (0x02) ..010...
1221 * COMM[2:0] "Horizontal window start position, 3 LSBs"
1222 * = 2 (0x02) .....010
1223 */
1224 { 0x32, 0x12 },
1225
1226 /*
1227 * 03 COMA "Common Control A"
1228 * = 74 (0x4A) 01001010
1229 * COMA[7:4] "AWB Update Threshold"
1230 * = 4 (0x04) 0100....
1231 * COMA[3:2] "Vertical window end line control 2 LSBs"
1232 * = 2 (0x02) ....10..
1233 * COMA[1:0] "Vertical window start line control 2 LSBs"
1234 * = 2 (0x02) ......10
1235 */
1236 { 0x03, 0x4a },
1237
1238 /*
1239 * 02 RED "Red Gain Control"
1240 * = 175 (0xAF) 10101111
1241 * RED[7] "Action"
1242 * = 1 (0x01) 1....... "gain = 1/(1+bitrev([6:0]))"
1243 * RED[6:0] "Value"
1244 * = 47 (0x2F) .0101111
1245 */
1246 { 0x02, 0xaf },
1247
1248 /*
1249 * 2D ADDVSL "VSYNC Pulse Width"
1250 * = 210 (0xD2) 11010010
1251 * ADDVSL[7:0] "VSYNC pulse width, LSB"
1252 * = 210 (0xD2) 11010010
1253 */
1254 { 0x2d, 0xd2 },
1255
1256 /*
1257 * 00 GAIN = 24 (0x18) 00011000
1258 * GAIN[7:6] "Reserved"
1259 * = 0 (0x00) 00......
1260 * GAIN[5] "Double"
1261 * = 0 (0x00) ..0..... "False"
1262 * GAIN[4] "Double"
1263 * = 1 (0x01) ...1.... "True"
1264 * GAIN[3:0] "Range"
1265 * = 8 (0x08) ....1000
1266 */
1267 { 0x00, 0x18 },
1268
1269 /*
1270 * 01 BLUE "Blue Gain Control"
1271 * = 240 (0xF0) 11110000
1272 * BLUE[7] "Action"
1273 * = 1 (0x01) 1....... "gain = 1/(1+bitrev([6:0]))"
1274 * BLUE[6:0] "Value"
1275 * = 112 (0x70) .1110000
1276 */
1277 { 0x01, 0xf0 },
1278
1279 /*
1280 * 10 AEC "Automatic Exposure Control"
1281 * = 10 (0x0A) 00001010
1282 * AEC[7:0] "Automatic Exposure Control, 8 MSBs"
1283 * = 10 (0x0A) 00001010
1284 */
1285 { 0x10, 0x0a },
1286
1287 { 0xe1, 0x67 },
1288 { 0xe3, 0x03 },
1289 { 0xe4, 0x26 },
1290 { 0xe5, 0x3e },
1291 { 0xf8, 0x01 },
1292 { 0xff, 0x01 },
1293 };
1294
1295 static const struct ov_i2c_regvals norm_6x20[] = {
1296 { 0x12, 0x80 }, /* reset */
1297 { 0x11, 0x01 },
1298 { 0x03, 0x60 },
1299 { 0x05, 0x7f }, /* For when autoadjust is off */
1300 { 0x07, 0xa8 },
1301 /* The ratio of 0x0c and 0x0d controls the white point */
1302 { 0x0c, 0x24 },
1303 { 0x0d, 0x24 },
1304 { 0x0f, 0x15 }, /* COMS */
1305 { 0x10, 0x75 }, /* AEC Exposure time */
1306 { 0x12, 0x24 }, /* Enable AGC */
1307 { 0x14, 0x04 },
1308 /* 0x16: 0x06 helps frame stability with moving objects */
1309 { 0x16, 0x06 },
1310 /* { 0x20, 0x30 }, * Aperture correction enable */
1311 { 0x26, 0xb2 }, /* BLC enable */
1312 /* 0x28: 0x05 Selects RGB format if RGB on */
1313 { 0x28, 0x05 },
1314 { 0x2a, 0x04 }, /* Disable framerate adjust */
1315 /* { 0x2b, 0xac }, * Framerate; Set 2a[7] first */
1316 { 0x2d, 0x85 },
1317 { 0x33, 0xa0 }, /* Color Processing Parameter */
1318 { 0x34, 0xd2 }, /* Max A/D range */
1319 { 0x38, 0x8b },
1320 { 0x39, 0x40 },
1321
1322 { 0x3c, 0x39 }, /* Enable AEC mode changing */
1323 { 0x3c, 0x3c }, /* Change AEC mode */
1324 { 0x3c, 0x24 }, /* Disable AEC mode changing */
1325
1326 { 0x3d, 0x80 },
1327 /* These next two registers (0x4a, 0x4b) are undocumented.
1328 * They control the color balance */
1329 { 0x4a, 0x80 },
1330 { 0x4b, 0x80 },
1331 { 0x4d, 0xd2 }, /* This reduces noise a bit */
1332 { 0x4e, 0xc1 },
1333 { 0x4f, 0x04 },
1334 /* Do 50-53 have any effect? */
1335 /* Toggle 0x12[2] off and on here? */
1336 };
1337
1338 static const struct ov_i2c_regvals norm_6x30[] = {
1339 { 0x12, 0x80 }, /* Reset */
1340 { 0x00, 0x1f }, /* Gain */
1341 { 0x01, 0x99 }, /* Blue gain */
1342 { 0x02, 0x7c }, /* Red gain */
1343 { 0x03, 0xc0 }, /* Saturation */
1344 { 0x05, 0x0a }, /* Contrast */
1345 { 0x06, 0x95 }, /* Brightness */
1346 { 0x07, 0x2d }, /* Sharpness */
1347 { 0x0c, 0x20 },
1348 { 0x0d, 0x20 },
1349 { 0x0e, 0xa0 }, /* Was 0x20, bit7 enables a 2x gain which we need */
1350 { 0x0f, 0x05 },
1351 { 0x10, 0x9a },
1352 { 0x11, 0x00 }, /* Pixel clock = fastest */
1353 { 0x12, 0x24 }, /* Enable AGC and AWB */
1354 { 0x13, 0x21 },
1355 { 0x14, 0x80 },
1356 { 0x15, 0x01 },
1357 { 0x16, 0x03 },
1358 { 0x17, 0x38 },
1359 { 0x18, 0xea },
1360 { 0x19, 0x04 },
1361 { 0x1a, 0x93 },
1362 { 0x1b, 0x00 },
1363 { 0x1e, 0xc4 },
1364 { 0x1f, 0x04 },
1365 { 0x20, 0x20 },
1366 { 0x21, 0x10 },
1367 { 0x22, 0x88 },
1368 { 0x23, 0xc0 }, /* Crystal circuit power level */
1369 { 0x25, 0x9a }, /* Increase AEC black ratio */
1370 { 0x26, 0xb2 }, /* BLC enable */
1371 { 0x27, 0xa2 },
1372 { 0x28, 0x00 },
1373 { 0x29, 0x00 },
1374 { 0x2a, 0x84 }, /* 60 Hz power */
1375 { 0x2b, 0xa8 }, /* 60 Hz power */
1376 { 0x2c, 0xa0 },
1377 { 0x2d, 0x95 }, /* Enable auto-brightness */
1378 { 0x2e, 0x88 },
1379 { 0x33, 0x26 },
1380 { 0x34, 0x03 },
1381 { 0x36, 0x8f },
1382 { 0x37, 0x80 },
1383 { 0x38, 0x83 },
1384 { 0x39, 0x80 },
1385 { 0x3a, 0x0f },
1386 { 0x3b, 0x3c },
1387 { 0x3c, 0x1a },
1388 { 0x3d, 0x80 },
1389 { 0x3e, 0x80 },
1390 { 0x3f, 0x0e },
1391 { 0x40, 0x00 }, /* White bal */
1392 { 0x41, 0x00 }, /* White bal */
1393 { 0x42, 0x80 },
1394 { 0x43, 0x3f }, /* White bal */
1395 { 0x44, 0x80 },
1396 { 0x45, 0x20 },
1397 { 0x46, 0x20 },
1398 { 0x47, 0x80 },
1399 { 0x48, 0x7f },
1400 { 0x49, 0x00 },
1401 { 0x4a, 0x00 },
1402 { 0x4b, 0x80 },
1403 { 0x4c, 0xd0 },
1404 { 0x4d, 0x10 }, /* U = 0.563u, V = 0.714v */
1405 { 0x4e, 0x40 },
1406 { 0x4f, 0x07 }, /* UV avg., col. killer: max */
1407 { 0x50, 0xff },
1408 { 0x54, 0x23 }, /* Max AGC gain: 18dB */
1409 { 0x55, 0xff },
1410 { 0x56, 0x12 },
1411 { 0x57, 0x81 },
1412 { 0x58, 0x75 },
1413 { 0x59, 0x01 }, /* AGC dark current comp.: +1 */
1414 { 0x5a, 0x2c },
1415 { 0x5b, 0x0f }, /* AWB chrominance levels */
1416 { 0x5c, 0x10 },
1417 { 0x3d, 0x80 },
1418 { 0x27, 0xa6 },
1419 { 0x12, 0x20 }, /* Toggle AWB */
1420 { 0x12, 0x24 },
1421 };
1422
1423 /* Lawrence Glaister <lg@jfm.bc.ca> reports:
1424 *
1425 * Register 0x0f in the 7610 has the following effects:
1426 *
1427 * 0x85 (AEC method 1): Best overall, good contrast range
1428 * 0x45 (AEC method 2): Very overexposed
1429 * 0xa5 (spec sheet default): Ok, but the black level is
1430 * shifted resulting in loss of contrast
1431 * 0x05 (old driver setting): very overexposed, too much
1432 * contrast
1433 */
1434 static const struct ov_i2c_regvals norm_7610[] = {
1435 { 0x10, 0xff },
1436 { 0x16, 0x06 },
1437 { 0x28, 0x24 },
1438 { 0x2b, 0xac },
1439 { 0x12, 0x00 },
1440 { 0x38, 0x81 },
1441 { 0x28, 0x24 }, /* 0c */
1442 { 0x0f, 0x85 }, /* lg's setting */
1443 { 0x15, 0x01 },
1444 { 0x20, 0x1c },
1445 { 0x23, 0x2a },
1446 { 0x24, 0x10 },
1447 { 0x25, 0x8a },
1448 { 0x26, 0xa2 },
1449 { 0x27, 0xc2 },
1450 { 0x2a, 0x04 },
1451 { 0x2c, 0xfe },
1452 { 0x2d, 0x93 },
1453 { 0x30, 0x71 },
1454 { 0x31, 0x60 },
1455 { 0x32, 0x26 },
1456 { 0x33, 0x20 },
1457 { 0x34, 0x48 },
1458 { 0x12, 0x24 },
1459 { 0x11, 0x01 },
1460 { 0x0c, 0x24 },
1461 { 0x0d, 0x24 },
1462 };
1463
1464 static const struct ov_i2c_regvals norm_7620[] = {
1465 { 0x12, 0x80 }, /* reset */
1466 { 0x00, 0x00 }, /* gain */
1467 { 0x01, 0x80 }, /* blue gain */
1468 { 0x02, 0x80 }, /* red gain */
1469 { 0x03, 0xc0 }, /* OV7670_R03_VREF */
1470 { 0x06, 0x60 },
1471 { 0x07, 0x00 },
1472 { 0x0c, 0x24 },
1473 { 0x0c, 0x24 },
1474 { 0x0d, 0x24 },
1475 { 0x11, 0x01 },
1476 { 0x12, 0x24 },
1477 { 0x13, 0x01 },
1478 { 0x14, 0x84 },
1479 { 0x15, 0x01 },
1480 { 0x16, 0x03 },
1481 { 0x17, 0x2f },
1482 { 0x18, 0xcf },
1483 { 0x19, 0x06 },
1484 { 0x1a, 0xf5 },
1485 { 0x1b, 0x00 },
1486 { 0x20, 0x18 },
1487 { 0x21, 0x80 },
1488 { 0x22, 0x80 },
1489 { 0x23, 0x00 },
1490 { 0x26, 0xa2 },
1491 { 0x27, 0xea },
1492 { 0x28, 0x22 }, /* Was 0x20, bit1 enables a 2x gain which we need */
1493 { 0x29, 0x00 },
1494 { 0x2a, 0x10 },
1495 { 0x2b, 0x00 },
1496 { 0x2c, 0x88 },
1497 { 0x2d, 0x91 },
1498 { 0x2e, 0x80 },
1499 { 0x2f, 0x44 },
1500 { 0x60, 0x27 },
1501 { 0x61, 0x02 },
1502 { 0x62, 0x5f },
1503 { 0x63, 0xd5 },
1504 { 0x64, 0x57 },
1505 { 0x65, 0x83 },
1506 { 0x66, 0x55 },
1507 { 0x67, 0x92 },
1508 { 0x68, 0xcf },
1509 { 0x69, 0x76 },
1510 { 0x6a, 0x22 },
1511 { 0x6b, 0x00 },
1512 { 0x6c, 0x02 },
1513 { 0x6d, 0x44 },
1514 { 0x6e, 0x80 },
1515 { 0x6f, 0x1d },
1516 { 0x70, 0x8b },
1517 { 0x71, 0x00 },
1518 { 0x72, 0x14 },
1519 { 0x73, 0x54 },
1520 { 0x74, 0x00 },
1521 { 0x75, 0x8e },
1522 { 0x76, 0x00 },
1523 { 0x77, 0xff },
1524 { 0x78, 0x80 },
1525 { 0x79, 0x80 },
1526 { 0x7a, 0x80 },
1527 { 0x7b, 0xe2 },
1528 { 0x7c, 0x00 },
1529 };
1530
1531 /* 7640 and 7648. The defaults should be OK for most registers. */
1532 static const struct ov_i2c_regvals norm_7640[] = {
1533 { 0x12, 0x80 },
1534 { 0x12, 0x14 },
1535 };
1536
1537 static const struct ov_regvals init_519_ov7660[] = {
1538 { 0x5d, 0x03 }, /* Turn off suspend mode */
1539 { 0x53, 0x9b }, /* 0x9f enables the (unused) microcontroller */
1540 { 0x54, 0x0f }, /* bit2 (jpeg enable) */
1541 { 0xa2, 0x20 }, /* a2-a5 are undocumented */
1542 { 0xa3, 0x18 },
1543 { 0xa4, 0x04 },
1544 { 0xa5, 0x28 },
1545 { 0x37, 0x00 }, /* SetUsbInit */
1546 { 0x55, 0x02 }, /* 4.096 Mhz audio clock */
1547 /* Enable both fields, YUV Input, disable defect comp (why?) */
1548 { 0x20, 0x0c }, /* 0x0d does U <-> V swap */
1549 { 0x21, 0x38 },
1550 { 0x22, 0x1d },
1551 { 0x17, 0x50 }, /* undocumented */
1552 { 0x37, 0x00 }, /* undocumented */
1553 { 0x40, 0xff }, /* I2C timeout counter */
1554 { 0x46, 0x00 }, /* I2C clock prescaler */
1555 };
1556 static const struct ov_i2c_regvals norm_7660[] = {
1557 {OV7670_R12_COM7, OV7670_COM7_RESET},
1558 {OV7670_R11_CLKRC, 0x81},
1559 {0x92, 0x00}, /* DM_LNL */
1560 {0x93, 0x00}, /* DM_LNH */
1561 {0x9d, 0x4c}, /* BD50ST */
1562 {0x9e, 0x3f}, /* BD60ST */
1563 {OV7670_R3B_COM11, 0x02},
1564 {OV7670_R13_COM8, 0xf5},
1565 {OV7670_R10_AECH, 0x00},
1566 {OV7670_R00_GAIN, 0x00},
1567 {OV7670_R01_BLUE, 0x7c},
1568 {OV7670_R02_RED, 0x9d},
1569 {OV7670_R12_COM7, 0x00},
1570 {OV7670_R04_COM1, 00},
1571 {OV7670_R18_HSTOP, 0x01},
1572 {OV7670_R17_HSTART, 0x13},
1573 {OV7670_R32_HREF, 0x92},
1574 {OV7670_R19_VSTART, 0x02},
1575 {OV7670_R1A_VSTOP, 0x7a},
1576 {OV7670_R03_VREF, 0x00},
1577 {OV7670_R0E_COM5, 0x04},
1578 {OV7670_R0F_COM6, 0x62},
1579 {OV7670_R15_COM10, 0x00},
1580 {0x16, 0x02}, /* RSVD */
1581 {0x1b, 0x00}, /* PSHFT */
1582 {OV7670_R1E_MVFP, 0x01},
1583 {0x29, 0x3c}, /* RSVD */
1584 {0x33, 0x00}, /* CHLF */
1585 {0x34, 0x07}, /* ARBLM */
1586 {0x35, 0x84}, /* RSVD */
1587 {0x36, 0x00}, /* RSVD */
1588 {0x37, 0x04}, /* ADC */
1589 {0x39, 0x43}, /* OFON */
1590 {OV7670_R3A_TSLB, 0x00},
1591 {OV7670_R3C_COM12, 0x6c},
1592 {OV7670_R3D_COM13, 0x98},
1593 {OV7670_R3F_EDGE, 0x23},
1594 {OV7670_R40_COM15, 0xc1},
1595 {OV7670_R41_COM16, 0x22},
1596 {0x6b, 0x0a}, /* DBLV */
1597 {0xa1, 0x08}, /* RSVD */
1598 {0x69, 0x80}, /* HV */
1599 {0x43, 0xf0}, /* RSVD.. */
1600 {0x44, 0x10},
1601 {0x45, 0x78},
1602 {0x46, 0xa8},
1603 {0x47, 0x60},
1604 {0x48, 0x80},
1605 {0x59, 0xba},
1606 {0x5a, 0x9a},
1607 {0x5b, 0x22},
1608 {0x5c, 0xb9},
1609 {0x5d, 0x9b},
1610 {0x5e, 0x10},
1611 {0x5f, 0xe0},
1612 {0x60, 0x85},
1613 {0x61, 0x60},
1614 {0x9f, 0x9d}, /* RSVD */
1615 {0xa0, 0xa0}, /* DSPC2 */
1616 {0x4f, 0x60}, /* matrix */
1617 {0x50, 0x64},
1618 {0x51, 0x04},
1619 {0x52, 0x18},
1620 {0x53, 0x3c},
1621 {0x54, 0x54},
1622 {0x55, 0x40},
1623 {0x56, 0x40},
1624 {0x57, 0x40},
1625 {0x58, 0x0d}, /* matrix sign */
1626 {0x8b, 0xcc}, /* RSVD */
1627 {0x8c, 0xcc},
1628 {0x8d, 0xcf},
1629 {0x6c, 0x40}, /* gamma curve */
1630 {0x6d, 0xe0},
1631 {0x6e, 0xa0},
1632 {0x6f, 0x80},
1633 {0x70, 0x70},
1634 {0x71, 0x80},
1635 {0x72, 0x60},
1636 {0x73, 0x60},
1637 {0x74, 0x50},
1638 {0x75, 0x40},
1639 {0x76, 0x38},
1640 {0x77, 0x3c},
1641 {0x78, 0x32},
1642 {0x79, 0x1a},
1643 {0x7a, 0x28},
1644 {0x7b, 0x24},
1645 {0x7c, 0x04}, /* gamma curve */
1646 {0x7d, 0x12},
1647 {0x7e, 0x26},
1648 {0x7f, 0x46},
1649 {0x80, 0x54},
1650 {0x81, 0x64},
1651 {0x82, 0x70},
1652 {0x83, 0x7c},
1653 {0x84, 0x86},
1654 {0x85, 0x8e},
1655 {0x86, 0x9c},
1656 {0x87, 0xab},
1657 {0x88, 0xc4},
1658 {0x89, 0xd1},
1659 {0x8a, 0xe5},
1660 {OV7670_R14_COM9, 0x1e},
1661 {OV7670_R24_AEW, 0x80},
1662 {OV7670_R25_AEB, 0x72},
1663 {OV7670_R26_VPT, 0xb3},
1664 {0x62, 0x80}, /* LCC1 */
1665 {0x63, 0x80}, /* LCC2 */
1666 {0x64, 0x06}, /* LCC3 */
1667 {0x65, 0x00}, /* LCC4 */
1668 {0x66, 0x01}, /* LCC5 */
1669 {0x94, 0x0e}, /* RSVD.. */
1670 {0x95, 0x14},
1671 {OV7670_R13_COM8, OV7670_COM8_FASTAEC
1672 | OV7670_COM8_AECSTEP
1673 | OV7670_COM8_BFILT
1674 | 0x10
1675 | OV7670_COM8_AGC
1676 | OV7670_COM8_AWB
1677 | OV7670_COM8_AEC},
1678 {0xa1, 0xc8}
1679 };
1680 static const struct ov_i2c_regvals norm_9600[] = {
1681 {0x12, 0x80},
1682 {0x0c, 0x28},
1683 {0x11, 0x80},
1684 {0x13, 0xb5},
1685 {0x14, 0x3e},
1686 {0x1b, 0x04},
1687 {0x24, 0xb0},
1688 {0x25, 0x90},
1689 {0x26, 0x94},
1690 {0x35, 0x90},
1691 {0x37, 0x07},
1692 {0x38, 0x08},
1693 {0x01, 0x8e},
1694 {0x02, 0x85}
1695 };
1696
1697 /* 7670. Defaults taken from OmniVision provided data,
1698 * as provided by Jonathan Corbet of OLPC */
1699 static const struct ov_i2c_regvals norm_7670[] = {
1700 { OV7670_R12_COM7, OV7670_COM7_RESET },
1701 { OV7670_R3A_TSLB, 0x04 }, /* OV */
1702 { OV7670_R12_COM7, OV7670_COM7_FMT_VGA }, /* VGA */
1703 { OV7670_R11_CLKRC, 0x01 },
1704 /*
1705 * Set the hardware window. These values from OV don't entirely
1706 * make sense - hstop is less than hstart. But they work...
1707 */
1708 { OV7670_R17_HSTART, 0x13 },
1709 { OV7670_R18_HSTOP, 0x01 },
1710 { OV7670_R32_HREF, 0xb6 },
1711 { OV7670_R19_VSTART, 0x02 },
1712 { OV7670_R1A_VSTOP, 0x7a },
1713 { OV7670_R03_VREF, 0x0a },
1714
1715 { OV7670_R0C_COM3, 0x00 },
1716 { OV7670_R3E_COM14, 0x00 },
1717 /* Mystery scaling numbers */
1718 { 0x70, 0x3a },
1719 { 0x71, 0x35 },
1720 { 0x72, 0x11 },
1721 { 0x73, 0xf0 },
1722 { 0xa2, 0x02 },
1723 /* { OV7670_R15_COM10, 0x0 }, */
1724
1725 /* Gamma curve values */
1726 { 0x7a, 0x20 },
1727 { 0x7b, 0x10 },
1728 { 0x7c, 0x1e },
1729 { 0x7d, 0x35 },
1730 { 0x7e, 0x5a },
1731 { 0x7f, 0x69 },
1732 { 0x80, 0x76 },
1733 { 0x81, 0x80 },
1734 { 0x82, 0x88 },
1735 { 0x83, 0x8f },
1736 { 0x84, 0x96 },
1737 { 0x85, 0xa3 },
1738 { 0x86, 0xaf },
1739 { 0x87, 0xc4 },
1740 { 0x88, 0xd7 },
1741 { 0x89, 0xe8 },
1742
1743 /* AGC and AEC parameters. Note we start by disabling those features,
1744 then turn them only after tweaking the values. */
1745 { OV7670_R13_COM8, OV7670_COM8_FASTAEC
1746 | OV7670_COM8_AECSTEP
1747 | OV7670_COM8_BFILT },
1748 { OV7670_R00_GAIN, 0x00 },
1749 { OV7670_R10_AECH, 0x00 },
1750 { OV7670_R0D_COM4, 0x40 }, /* magic reserved bit */
1751 { OV7670_R14_COM9, 0x18 }, /* 4x gain + magic rsvd bit */
1752 { OV7670_RA5_BD50MAX, 0x05 },
1753 { OV7670_RAB_BD60MAX, 0x07 },
1754 { OV7670_R24_AEW, 0x95 },
1755 { OV7670_R25_AEB, 0x33 },
1756 { OV7670_R26_VPT, 0xe3 },
1757 { OV7670_R9F_HAECC1, 0x78 },
1758 { OV7670_RA0_HAECC2, 0x68 },
1759 { 0xa1, 0x03 }, /* magic */
1760 { OV7670_RA6_HAECC3, 0xd8 },
1761 { OV7670_RA7_HAECC4, 0xd8 },
1762 { OV7670_RA8_HAECC5, 0xf0 },
1763 { OV7670_RA9_HAECC6, 0x90 },
1764 { OV7670_RAA_HAECC7, 0x94 },
1765 { OV7670_R13_COM8, OV7670_COM8_FASTAEC
1766 | OV7670_COM8_AECSTEP
1767 | OV7670_COM8_BFILT
1768 | OV7670_COM8_AGC
1769 | OV7670_COM8_AEC },
1770
1771 /* Almost all of these are magic "reserved" values. */
1772 { OV7670_R0E_COM5, 0x61 },
1773 { OV7670_R0F_COM6, 0x4b },
1774 { 0x16, 0x02 },
1775 { OV7670_R1E_MVFP, 0x07 },
1776 { 0x21, 0x02 },
1777 { 0x22, 0x91 },
1778 { 0x29, 0x07 },
1779 { 0x33, 0x0b },
1780 { 0x35, 0x0b },
1781 { 0x37, 0x1d },
1782 { 0x38, 0x71 },
1783 { 0x39, 0x2a },
1784 { OV7670_R3C_COM12, 0x78 },
1785 { 0x4d, 0x40 },
1786 { 0x4e, 0x20 },
1787 { OV7670_R69_GFIX, 0x00 },
1788 { 0x6b, 0x4a },
1789 { 0x74, 0x10 },
1790 { 0x8d, 0x4f },
1791 { 0x8e, 0x00 },
1792 { 0x8f, 0x00 },
1793 { 0x90, 0x00 },
1794 { 0x91, 0x00 },
1795 { 0x96, 0x00 },
1796 { 0x9a, 0x00 },
1797 { 0xb0, 0x84 },
1798 { 0xb1, 0x0c },
1799 { 0xb2, 0x0e },
1800 { 0xb3, 0x82 },
1801 { 0xb8, 0x0a },
1802
1803 /* More reserved magic, some of which tweaks white balance */
1804 { 0x43, 0x0a },
1805 { 0x44, 0xf0 },
1806 { 0x45, 0x34 },
1807 { 0x46, 0x58 },
1808 { 0x47, 0x28 },
1809 { 0x48, 0x3a },
1810 { 0x59, 0x88 },
1811 { 0x5a, 0x88 },
1812 { 0x5b, 0x44 },
1813 { 0x5c, 0x67 },
1814 { 0x5d, 0x49 },
1815 { 0x5e, 0x0e },
1816 { 0x6c, 0x0a },
1817 { 0x6d, 0x55 },
1818 { 0x6e, 0x11 },
1819 { 0x6f, 0x9f }, /* "9e for advance AWB" */
1820 { 0x6a, 0x40 },
1821 { OV7670_R01_BLUE, 0x40 },
1822 { OV7670_R02_RED, 0x60 },
1823 { OV7670_R13_COM8, OV7670_COM8_FASTAEC
1824 | OV7670_COM8_AECSTEP
1825 | OV7670_COM8_BFILT
1826 | OV7670_COM8_AGC
1827 | OV7670_COM8_AEC
1828 | OV7670_COM8_AWB },
1829
1830 /* Matrix coefficients */
1831 { 0x4f, 0x80 },
1832 { 0x50, 0x80 },
1833 { 0x51, 0x00 },
1834 { 0x52, 0x22 },
1835 { 0x53, 0x5e },
1836 { 0x54, 0x80 },
1837 { 0x58, 0x9e },
1838
1839 { OV7670_R41_COM16, OV7670_COM16_AWBGAIN },
1840 { OV7670_R3F_EDGE, 0x00 },
1841 { 0x75, 0x05 },
1842 { 0x76, 0xe1 },
1843 { 0x4c, 0x00 },
1844 { 0x77, 0x01 },
1845 { OV7670_R3D_COM13, OV7670_COM13_GAMMA
1846 | OV7670_COM13_UVSAT
1847 | 2}, /* was 3 */
1848 { 0x4b, 0x09 },
1849 { 0xc9, 0x60 },
1850 { OV7670_R41_COM16, 0x38 },
1851 { 0x56, 0x40 },
1852
1853 { 0x34, 0x11 },
1854 { OV7670_R3B_COM11, OV7670_COM11_EXP|OV7670_COM11_HZAUTO },
1855 { 0xa4, 0x88 },
1856 { 0x96, 0x00 },
1857 { 0x97, 0x30 },
1858 { 0x98, 0x20 },
1859 { 0x99, 0x30 },
1860 { 0x9a, 0x84 },
1861 { 0x9b, 0x29 },
1862 { 0x9c, 0x03 },
1863 { 0x9d, 0x4c },
1864 { 0x9e, 0x3f },
1865 { 0x78, 0x04 },
1866
1867 /* Extra-weird stuff. Some sort of multiplexor register */
1868 { 0x79, 0x01 },
1869 { 0xc8, 0xf0 },
1870 { 0x79, 0x0f },
1871 { 0xc8, 0x00 },
1872 { 0x79, 0x10 },
1873 { 0xc8, 0x7e },
1874 { 0x79, 0x0a },
1875 { 0xc8, 0x80 },
1876 { 0x79, 0x0b },
1877 { 0xc8, 0x01 },
1878 { 0x79, 0x0c },
1879 { 0xc8, 0x0f },
1880 { 0x79, 0x0d },
1881 { 0xc8, 0x20 },
1882 { 0x79, 0x09 },
1883 { 0xc8, 0x80 },
1884 { 0x79, 0x02 },
1885 { 0xc8, 0xc0 },
1886 { 0x79, 0x03 },
1887 { 0xc8, 0x40 },
1888 { 0x79, 0x05 },
1889 { 0xc8, 0x30 },
1890 { 0x79, 0x26 },
1891 };
1892
1893 static const struct ov_i2c_regvals norm_8610[] = {
1894 { 0x12, 0x80 },
1895 { 0x00, 0x00 },
1896 { 0x01, 0x80 },
1897 { 0x02, 0x80 },
1898 { 0x03, 0xc0 },
1899 { 0x04, 0x30 },
1900 { 0x05, 0x30 }, /* was 0x10, new from windrv 090403 */
1901 { 0x06, 0x70 }, /* was 0x80, new from windrv 090403 */
1902 { 0x0a, 0x86 },
1903 { 0x0b, 0xb0 },
1904 { 0x0c, 0x20 },
1905 { 0x0d, 0x20 },
1906 { 0x11, 0x01 },
1907 { 0x12, 0x25 },
1908 { 0x13, 0x01 },
1909 { 0x14, 0x04 },
1910 { 0x15, 0x01 }, /* Lin and Win think different about UV order */
1911 { 0x16, 0x03 },
1912 { 0x17, 0x38 }, /* was 0x2f, new from windrv 090403 */
1913 { 0x18, 0xea }, /* was 0xcf, new from windrv 090403 */
1914 { 0x19, 0x02 }, /* was 0x06, new from windrv 090403 */
1915 { 0x1a, 0xf5 },
1916 { 0x1b, 0x00 },
1917 { 0x20, 0xd0 }, /* was 0x90, new from windrv 090403 */
1918 { 0x23, 0xc0 }, /* was 0x00, new from windrv 090403 */
1919 { 0x24, 0x30 }, /* was 0x1d, new from windrv 090403 */
1920 { 0x25, 0x50 }, /* was 0x57, new from windrv 090403 */
1921 { 0x26, 0xa2 },
1922 { 0x27, 0xea },
1923 { 0x28, 0x00 },
1924 { 0x29, 0x00 },
1925 { 0x2a, 0x80 },
1926 { 0x2b, 0xc8 }, /* was 0xcc, new from windrv 090403 */
1927 { 0x2c, 0xac },
1928 { 0x2d, 0x45 }, /* was 0xd5, new from windrv 090403 */
1929 { 0x2e, 0x80 },
1930 { 0x2f, 0x14 }, /* was 0x01, new from windrv 090403 */
1931 { 0x4c, 0x00 },
1932 { 0x4d, 0x30 }, /* was 0x10, new from windrv 090403 */
1933 { 0x60, 0x02 }, /* was 0x01, new from windrv 090403 */
1934 { 0x61, 0x00 }, /* was 0x09, new from windrv 090403 */
1935 { 0x62, 0x5f }, /* was 0xd7, new from windrv 090403 */
1936 { 0x63, 0xff },
1937 { 0x64, 0x53 }, /* new windrv 090403 says 0x57,
1938 * maybe that's wrong */
1939 { 0x65, 0x00 },
1940 { 0x66, 0x55 },
1941 { 0x67, 0xb0 },
1942 { 0x68, 0xc0 }, /* was 0xaf, new from windrv 090403 */
1943 { 0x69, 0x02 },
1944 { 0x6a, 0x22 },
1945 { 0x6b, 0x00 },
1946 { 0x6c, 0x99 }, /* was 0x80, old windrv says 0x00, but
1947 * deleting bit7 colors the first images red */
1948 { 0x6d, 0x11 }, /* was 0x00, new from windrv 090403 */
1949 { 0x6e, 0x11 }, /* was 0x00, new from windrv 090403 */
1950 { 0x6f, 0x01 },
1951 { 0x70, 0x8b },
1952 { 0x71, 0x00 },
1953 { 0x72, 0x14 },
1954 { 0x73, 0x54 },
1955 { 0x74, 0x00 },/* 0x60? - was 0x00, new from windrv 090403 */
1956 { 0x75, 0x0e },
1957 { 0x76, 0x02 }, /* was 0x02, new from windrv 090403 */
1958 { 0x77, 0xff },
1959 { 0x78, 0x80 },
1960 { 0x79, 0x80 },
1961 { 0x7a, 0x80 },
1962 { 0x7b, 0x10 }, /* was 0x13, new from windrv 090403 */
1963 { 0x7c, 0x00 },
1964 { 0x7d, 0x08 }, /* was 0x09, new from windrv 090403 */
1965 { 0x7e, 0x08 }, /* was 0xc0, new from windrv 090403 */
1966 { 0x7f, 0xfb },
1967 { 0x80, 0x28 },
1968 { 0x81, 0x00 },
1969 { 0x82, 0x23 },
1970 { 0x83, 0x0b },
1971 { 0x84, 0x00 },
1972 { 0x85, 0x62 }, /* was 0x61, new from windrv 090403 */
1973 { 0x86, 0xc9 },
1974 { 0x87, 0x00 },
1975 { 0x88, 0x00 },
1976 { 0x89, 0x01 },
1977 { 0x12, 0x20 },
1978 { 0x12, 0x25 }, /* was 0x24, new from windrv 090403 */
1979 };
1980
ov7670_abs_to_sm(unsigned char v)1981 static unsigned char ov7670_abs_to_sm(unsigned char v)
1982 {
1983 if (v > 127)
1984 return v & 0x7f;
1985 return (128 - v) | 0x80;
1986 }
1987
1988 /* Write a OV519 register */
reg_w(struct sd * sd,u16 index,u16 value)1989 static void reg_w(struct sd *sd, u16 index, u16 value)
1990 {
1991 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
1992 int ret, req = 0;
1993
1994 if (sd->gspca_dev.usb_err < 0)
1995 return;
1996
1997 /* Avoid things going to fast for the bridge with a xhci host */
1998 udelay(150);
1999
2000 switch (sd->bridge) {
2001 case BRIDGE_OV511:
2002 case BRIDGE_OV511PLUS:
2003 req = 2;
2004 break;
2005 case BRIDGE_OVFX2:
2006 req = 0x0a;
2007 fallthrough;
2008 case BRIDGE_W9968CF:
2009 gspca_dbg(gspca_dev, D_USBO, "SET %02x %04x %04x\n",
2010 req, value, index);
2011 ret = usb_control_msg(sd->gspca_dev.dev,
2012 usb_sndctrlpipe(sd->gspca_dev.dev, 0),
2013 req,
2014 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2015 value, index, NULL, 0, 500);
2016 goto leave;
2017 default:
2018 req = 1;
2019 }
2020
2021 gspca_dbg(gspca_dev, D_USBO, "SET %02x 0000 %04x %02x\n",
2022 req, index, value);
2023 sd->gspca_dev.usb_buf[0] = value;
2024 ret = usb_control_msg(sd->gspca_dev.dev,
2025 usb_sndctrlpipe(sd->gspca_dev.dev, 0),
2026 req,
2027 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2028 0, index,
2029 sd->gspca_dev.usb_buf, 1, 500);
2030 leave:
2031 if (ret < 0) {
2032 gspca_err(gspca_dev, "reg_w %02x failed %d\n", index, ret);
2033 sd->gspca_dev.usb_err = ret;
2034 return;
2035 }
2036 }
2037
2038 /* Read from a OV519 register, note not valid for the w9968cf!! */
2039 /* returns: negative is error, pos or zero is data */
reg_r(struct sd * sd,u16 index)2040 static int reg_r(struct sd *sd, u16 index)
2041 {
2042 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2043 int ret;
2044 int req;
2045
2046 if (sd->gspca_dev.usb_err < 0)
2047 return -1;
2048
2049 switch (sd->bridge) {
2050 case BRIDGE_OV511:
2051 case BRIDGE_OV511PLUS:
2052 req = 3;
2053 break;
2054 case BRIDGE_OVFX2:
2055 req = 0x0b;
2056 break;
2057 default:
2058 req = 1;
2059 }
2060
2061 /* Avoid things going to fast for the bridge with a xhci host */
2062 udelay(150);
2063 ret = usb_control_msg(sd->gspca_dev.dev,
2064 usb_rcvctrlpipe(sd->gspca_dev.dev, 0),
2065 req,
2066 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2067 0, index, sd->gspca_dev.usb_buf, 1, 500);
2068
2069 if (ret >= 0) {
2070 ret = sd->gspca_dev.usb_buf[0];
2071 gspca_dbg(gspca_dev, D_USBI, "GET %02x 0000 %04x %02x\n",
2072 req, index, ret);
2073 } else {
2074 gspca_err(gspca_dev, "reg_r %02x failed %d\n", index, ret);
2075 sd->gspca_dev.usb_err = ret;
2076 /*
2077 * Make sure the result is zeroed to avoid uninitialized
2078 * values.
2079 */
2080 gspca_dev->usb_buf[0] = 0;
2081 }
2082
2083 return ret;
2084 }
2085
2086 /* Read 8 values from a OV519 register */
reg_r8(struct sd * sd,u16 index)2087 static int reg_r8(struct sd *sd,
2088 u16 index)
2089 {
2090 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2091 int ret;
2092
2093 if (sd->gspca_dev.usb_err < 0)
2094 return -1;
2095
2096 /* Avoid things going to fast for the bridge with a xhci host */
2097 udelay(150);
2098 ret = usb_control_msg(sd->gspca_dev.dev,
2099 usb_rcvctrlpipe(sd->gspca_dev.dev, 0),
2100 1, /* REQ_IO */
2101 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2102 0, index, sd->gspca_dev.usb_buf, 8, 500);
2103
2104 if (ret >= 0) {
2105 ret = sd->gspca_dev.usb_buf[0];
2106 } else {
2107 gspca_err(gspca_dev, "reg_r8 %02x failed %d\n", index, ret);
2108 sd->gspca_dev.usb_err = ret;
2109 /*
2110 * Make sure the buffer is zeroed to avoid uninitialized
2111 * values.
2112 */
2113 memset(gspca_dev->usb_buf, 0, 8);
2114 }
2115
2116 return ret;
2117 }
2118
2119 /*
2120 * Writes bits at positions specified by mask to an OV51x reg. Bits that are in
2121 * the same position as 1's in "mask" are cleared and set to "value". Bits
2122 * that are in the same position as 0's in "mask" are preserved, regardless
2123 * of their respective state in "value".
2124 */
reg_w_mask(struct sd * sd,u16 index,u8 value,u8 mask)2125 static void reg_w_mask(struct sd *sd,
2126 u16 index,
2127 u8 value,
2128 u8 mask)
2129 {
2130 int ret;
2131 u8 oldval;
2132
2133 if (mask != 0xff) {
2134 value &= mask; /* Enforce mask on value */
2135 ret = reg_r(sd, index);
2136 if (ret < 0)
2137 return;
2138
2139 oldval = ret & ~mask; /* Clear the masked bits */
2140 value |= oldval; /* Set the desired bits */
2141 }
2142 reg_w(sd, index, value);
2143 }
2144
2145 /*
2146 * Writes multiple (n) byte value to a single register. Only valid with certain
2147 * registers (0x30 and 0xc4 - 0xce).
2148 */
ov518_reg_w32(struct sd * sd,u16 index,u32 value,int n)2149 static void ov518_reg_w32(struct sd *sd, u16 index, u32 value, int n)
2150 {
2151 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2152 int ret;
2153
2154 if (sd->gspca_dev.usb_err < 0)
2155 return;
2156
2157 *((__le32 *) sd->gspca_dev.usb_buf) = __cpu_to_le32(value);
2158
2159 /* Avoid things going to fast for the bridge with a xhci host */
2160 udelay(150);
2161 ret = usb_control_msg(sd->gspca_dev.dev,
2162 usb_sndctrlpipe(sd->gspca_dev.dev, 0),
2163 1 /* REG_IO */,
2164 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2165 0, index,
2166 sd->gspca_dev.usb_buf, n, 500);
2167 if (ret < 0) {
2168 gspca_err(gspca_dev, "reg_w32 %02x failed %d\n", index, ret);
2169 sd->gspca_dev.usb_err = ret;
2170 }
2171 }
2172
ov511_i2c_w(struct sd * sd,u8 reg,u8 value)2173 static void ov511_i2c_w(struct sd *sd, u8 reg, u8 value)
2174 {
2175 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2176 int rc, retries;
2177
2178 gspca_dbg(gspca_dev, D_USBO, "ov511_i2c_w %02x %02x\n", reg, value);
2179
2180 /* Three byte write cycle */
2181 for (retries = 6; ; ) {
2182 /* Select camera register */
2183 reg_w(sd, R51x_I2C_SADDR_3, reg);
2184
2185 /* Write "value" to I2C data port of OV511 */
2186 reg_w(sd, R51x_I2C_DATA, value);
2187
2188 /* Initiate 3-byte write cycle */
2189 reg_w(sd, R511_I2C_CTL, 0x01);
2190
2191 do {
2192 rc = reg_r(sd, R511_I2C_CTL);
2193 } while (rc > 0 && ((rc & 1) == 0)); /* Retry until idle */
2194
2195 if (rc < 0)
2196 return;
2197
2198 if ((rc & 2) == 0) /* Ack? */
2199 break;
2200 if (--retries < 0) {
2201 gspca_dbg(gspca_dev, D_USBO, "i2c write retries exhausted\n");
2202 return;
2203 }
2204 }
2205 }
2206
ov511_i2c_r(struct sd * sd,u8 reg)2207 static int ov511_i2c_r(struct sd *sd, u8 reg)
2208 {
2209 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2210 int rc, value, retries;
2211
2212 /* Two byte write cycle */
2213 for (retries = 6; ; ) {
2214 /* Select camera register */
2215 reg_w(sd, R51x_I2C_SADDR_2, reg);
2216
2217 /* Initiate 2-byte write cycle */
2218 reg_w(sd, R511_I2C_CTL, 0x03);
2219
2220 do {
2221 rc = reg_r(sd, R511_I2C_CTL);
2222 } while (rc > 0 && ((rc & 1) == 0)); /* Retry until idle */
2223
2224 if (rc < 0)
2225 return rc;
2226
2227 if ((rc & 2) == 0) /* Ack? */
2228 break;
2229
2230 /* I2C abort */
2231 reg_w(sd, R511_I2C_CTL, 0x10);
2232
2233 if (--retries < 0) {
2234 gspca_dbg(gspca_dev, D_USBI, "i2c write retries exhausted\n");
2235 return -1;
2236 }
2237 }
2238
2239 /* Two byte read cycle */
2240 for (retries = 6; ; ) {
2241 /* Initiate 2-byte read cycle */
2242 reg_w(sd, R511_I2C_CTL, 0x05);
2243
2244 do {
2245 rc = reg_r(sd, R511_I2C_CTL);
2246 } while (rc > 0 && ((rc & 1) == 0)); /* Retry until idle */
2247
2248 if (rc < 0)
2249 return rc;
2250
2251 if ((rc & 2) == 0) /* Ack? */
2252 break;
2253
2254 /* I2C abort */
2255 reg_w(sd, R511_I2C_CTL, 0x10);
2256
2257 if (--retries < 0) {
2258 gspca_dbg(gspca_dev, D_USBI, "i2c read retries exhausted\n");
2259 return -1;
2260 }
2261 }
2262
2263 value = reg_r(sd, R51x_I2C_DATA);
2264
2265 gspca_dbg(gspca_dev, D_USBI, "ov511_i2c_r %02x %02x\n", reg, value);
2266
2267 /* This is needed to make i2c_w() work */
2268 reg_w(sd, R511_I2C_CTL, 0x05);
2269
2270 return value;
2271 }
2272
2273 /*
2274 * The OV518 I2C I/O procedure is different, hence, this function.
2275 * This is normally only called from i2c_w(). Note that this function
2276 * always succeeds regardless of whether the sensor is present and working.
2277 */
ov518_i2c_w(struct sd * sd,u8 reg,u8 value)2278 static void ov518_i2c_w(struct sd *sd,
2279 u8 reg,
2280 u8 value)
2281 {
2282 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2283
2284 gspca_dbg(gspca_dev, D_USBO, "ov518_i2c_w %02x %02x\n", reg, value);
2285
2286 /* Select camera register */
2287 reg_w(sd, R51x_I2C_SADDR_3, reg);
2288
2289 /* Write "value" to I2C data port of OV511 */
2290 reg_w(sd, R51x_I2C_DATA, value);
2291
2292 /* Initiate 3-byte write cycle */
2293 reg_w(sd, R518_I2C_CTL, 0x01);
2294
2295 /* wait for write complete */
2296 msleep(4);
2297 reg_r8(sd, R518_I2C_CTL);
2298 }
2299
2300 /*
2301 * returns: negative is error, pos or zero is data
2302 *
2303 * The OV518 I2C I/O procedure is different, hence, this function.
2304 * This is normally only called from i2c_r(). Note that this function
2305 * always succeeds regardless of whether the sensor is present and working.
2306 */
ov518_i2c_r(struct sd * sd,u8 reg)2307 static int ov518_i2c_r(struct sd *sd, u8 reg)
2308 {
2309 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2310 int value;
2311
2312 /* Select camera register */
2313 reg_w(sd, R51x_I2C_SADDR_2, reg);
2314
2315 /* Initiate 2-byte write cycle */
2316 reg_w(sd, R518_I2C_CTL, 0x03);
2317 reg_r8(sd, R518_I2C_CTL);
2318
2319 /* Initiate 2-byte read cycle */
2320 reg_w(sd, R518_I2C_CTL, 0x05);
2321 reg_r8(sd, R518_I2C_CTL);
2322
2323 value = reg_r(sd, R51x_I2C_DATA);
2324 gspca_dbg(gspca_dev, D_USBI, "ov518_i2c_r %02x %02x\n", reg, value);
2325 return value;
2326 }
2327
ovfx2_i2c_w(struct sd * sd,u8 reg,u8 value)2328 static void ovfx2_i2c_w(struct sd *sd, u8 reg, u8 value)
2329 {
2330 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2331 int ret;
2332
2333 if (sd->gspca_dev.usb_err < 0)
2334 return;
2335
2336 ret = usb_control_msg(sd->gspca_dev.dev,
2337 usb_sndctrlpipe(sd->gspca_dev.dev, 0),
2338 0x02,
2339 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2340 (u16) value, (u16) reg, NULL, 0, 500);
2341
2342 if (ret < 0) {
2343 gspca_err(gspca_dev, "ovfx2_i2c_w %02x failed %d\n", reg, ret);
2344 sd->gspca_dev.usb_err = ret;
2345 }
2346
2347 gspca_dbg(gspca_dev, D_USBO, "ovfx2_i2c_w %02x %02x\n", reg, value);
2348 }
2349
ovfx2_i2c_r(struct sd * sd,u8 reg)2350 static int ovfx2_i2c_r(struct sd *sd, u8 reg)
2351 {
2352 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2353 int ret;
2354
2355 if (sd->gspca_dev.usb_err < 0)
2356 return -1;
2357
2358 ret = usb_control_msg(sd->gspca_dev.dev,
2359 usb_rcvctrlpipe(sd->gspca_dev.dev, 0),
2360 0x03,
2361 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
2362 0, (u16) reg, sd->gspca_dev.usb_buf, 1, 500);
2363
2364 if (ret >= 0) {
2365 ret = sd->gspca_dev.usb_buf[0];
2366 gspca_dbg(gspca_dev, D_USBI, "ovfx2_i2c_r %02x %02x\n",
2367 reg, ret);
2368 } else {
2369 gspca_err(gspca_dev, "ovfx2_i2c_r %02x failed %d\n", reg, ret);
2370 sd->gspca_dev.usb_err = ret;
2371 }
2372
2373 return ret;
2374 }
2375
i2c_w(struct sd * sd,u8 reg,u8 value)2376 static void i2c_w(struct sd *sd, u8 reg, u8 value)
2377 {
2378 if (sd->sensor_reg_cache[reg] == value)
2379 return;
2380
2381 switch (sd->bridge) {
2382 case BRIDGE_OV511:
2383 case BRIDGE_OV511PLUS:
2384 ov511_i2c_w(sd, reg, value);
2385 break;
2386 case BRIDGE_OV518:
2387 case BRIDGE_OV518PLUS:
2388 case BRIDGE_OV519:
2389 ov518_i2c_w(sd, reg, value);
2390 break;
2391 case BRIDGE_OVFX2:
2392 ovfx2_i2c_w(sd, reg, value);
2393 break;
2394 case BRIDGE_W9968CF:
2395 w9968cf_i2c_w(sd, reg, value);
2396 break;
2397 }
2398
2399 if (sd->gspca_dev.usb_err >= 0) {
2400 /* Up on sensor reset empty the register cache */
2401 if (reg == 0x12 && (value & 0x80))
2402 memset(sd->sensor_reg_cache, -1,
2403 sizeof(sd->sensor_reg_cache));
2404 else
2405 sd->sensor_reg_cache[reg] = value;
2406 }
2407 }
2408
i2c_r(struct sd * sd,u8 reg)2409 static int i2c_r(struct sd *sd, u8 reg)
2410 {
2411 int ret = -1;
2412
2413 if (sd->sensor_reg_cache[reg] != -1)
2414 return sd->sensor_reg_cache[reg];
2415
2416 switch (sd->bridge) {
2417 case BRIDGE_OV511:
2418 case BRIDGE_OV511PLUS:
2419 ret = ov511_i2c_r(sd, reg);
2420 break;
2421 case BRIDGE_OV518:
2422 case BRIDGE_OV518PLUS:
2423 case BRIDGE_OV519:
2424 ret = ov518_i2c_r(sd, reg);
2425 break;
2426 case BRIDGE_OVFX2:
2427 ret = ovfx2_i2c_r(sd, reg);
2428 break;
2429 case BRIDGE_W9968CF:
2430 ret = w9968cf_i2c_r(sd, reg);
2431 break;
2432 }
2433
2434 if (ret >= 0)
2435 sd->sensor_reg_cache[reg] = ret;
2436
2437 return ret;
2438 }
2439
2440 /* Writes bits at positions specified by mask to an I2C reg. Bits that are in
2441 * the same position as 1's in "mask" are cleared and set to "value". Bits
2442 * that are in the same position as 0's in "mask" are preserved, regardless
2443 * of their respective state in "value".
2444 */
i2c_w_mask(struct sd * sd,u8 reg,u8 value,u8 mask)2445 static void i2c_w_mask(struct sd *sd,
2446 u8 reg,
2447 u8 value,
2448 u8 mask)
2449 {
2450 int rc;
2451 u8 oldval;
2452
2453 value &= mask; /* Enforce mask on value */
2454 rc = i2c_r(sd, reg);
2455 if (rc < 0)
2456 return;
2457 oldval = rc & ~mask; /* Clear the masked bits */
2458 value |= oldval; /* Set the desired bits */
2459 i2c_w(sd, reg, value);
2460 }
2461
2462 /* Temporarily stops OV511 from functioning. Must do this before changing
2463 * registers while the camera is streaming */
ov51x_stop(struct sd * sd)2464 static inline void ov51x_stop(struct sd *sd)
2465 {
2466 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2467
2468 gspca_dbg(gspca_dev, D_STREAM, "stopping\n");
2469 sd->stopped = 1;
2470 switch (sd->bridge) {
2471 case BRIDGE_OV511:
2472 case BRIDGE_OV511PLUS:
2473 reg_w(sd, R51x_SYS_RESET, 0x3d);
2474 break;
2475 case BRIDGE_OV518:
2476 case BRIDGE_OV518PLUS:
2477 reg_w_mask(sd, R51x_SYS_RESET, 0x3a, 0x3a);
2478 break;
2479 case BRIDGE_OV519:
2480 reg_w(sd, OV519_R51_RESET1, 0x0f);
2481 reg_w(sd, OV519_R51_RESET1, 0x00);
2482 reg_w(sd, 0x22, 0x00); /* FRAR */
2483 break;
2484 case BRIDGE_OVFX2:
2485 reg_w_mask(sd, 0x0f, 0x00, 0x02);
2486 break;
2487 case BRIDGE_W9968CF:
2488 reg_w(sd, 0x3c, 0x0a05); /* stop USB transfer */
2489 break;
2490 }
2491 }
2492
2493 /* Restarts OV511 after ov511_stop() is called. Has no effect if it is not
2494 * actually stopped (for performance). */
ov51x_restart(struct sd * sd)2495 static inline void ov51x_restart(struct sd *sd)
2496 {
2497 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2498
2499 gspca_dbg(gspca_dev, D_STREAM, "restarting\n");
2500 if (!sd->stopped)
2501 return;
2502 sd->stopped = 0;
2503
2504 /* Reinitialize the stream */
2505 switch (sd->bridge) {
2506 case BRIDGE_OV511:
2507 case BRIDGE_OV511PLUS:
2508 reg_w(sd, R51x_SYS_RESET, 0x00);
2509 break;
2510 case BRIDGE_OV518:
2511 case BRIDGE_OV518PLUS:
2512 reg_w(sd, 0x2f, 0x80);
2513 reg_w(sd, R51x_SYS_RESET, 0x00);
2514 break;
2515 case BRIDGE_OV519:
2516 reg_w(sd, OV519_R51_RESET1, 0x0f);
2517 reg_w(sd, OV519_R51_RESET1, 0x00);
2518 reg_w(sd, 0x22, 0x1d); /* FRAR */
2519 break;
2520 case BRIDGE_OVFX2:
2521 reg_w_mask(sd, 0x0f, 0x02, 0x02);
2522 break;
2523 case BRIDGE_W9968CF:
2524 reg_w(sd, 0x3c, 0x8a05); /* USB FIFO enable */
2525 break;
2526 }
2527 }
2528
2529 static void ov51x_set_slave_ids(struct sd *sd, u8 slave);
2530
2531 /* This does an initial reset of an OmniVision sensor and ensures that I2C
2532 * is synchronized. Returns <0 on failure.
2533 */
init_ov_sensor(struct sd * sd,u8 slave)2534 static int init_ov_sensor(struct sd *sd, u8 slave)
2535 {
2536 int i;
2537 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2538
2539 ov51x_set_slave_ids(sd, slave);
2540
2541 /* Reset the sensor */
2542 i2c_w(sd, 0x12, 0x80);
2543
2544 /* Wait for it to initialize */
2545 msleep(150);
2546
2547 for (i = 0; i < i2c_detect_tries; i++) {
2548 if (i2c_r(sd, OV7610_REG_ID_HIGH) == 0x7f &&
2549 i2c_r(sd, OV7610_REG_ID_LOW) == 0xa2) {
2550 gspca_dbg(gspca_dev, D_PROBE, "I2C synced in %d attempt(s)\n",
2551 i);
2552 return 0;
2553 }
2554
2555 /* Reset the sensor */
2556 i2c_w(sd, 0x12, 0x80);
2557
2558 /* Wait for it to initialize */
2559 msleep(150);
2560
2561 /* Dummy read to sync I2C */
2562 if (i2c_r(sd, 0x00) < 0)
2563 return -1;
2564 }
2565 return -1;
2566 }
2567
2568 /* Set the read and write slave IDs. The "slave" argument is the write slave,
2569 * and the read slave will be set to (slave + 1).
2570 * This should not be called from outside the i2c I/O functions.
2571 * Sets I2C read and write slave IDs. Returns <0 for error
2572 */
ov51x_set_slave_ids(struct sd * sd,u8 slave)2573 static void ov51x_set_slave_ids(struct sd *sd,
2574 u8 slave)
2575 {
2576 switch (sd->bridge) {
2577 case BRIDGE_OVFX2:
2578 reg_w(sd, OVFX2_I2C_ADDR, slave);
2579 return;
2580 case BRIDGE_W9968CF:
2581 sd->sensor_addr = slave;
2582 return;
2583 }
2584
2585 reg_w(sd, R51x_I2C_W_SID, slave);
2586 reg_w(sd, R51x_I2C_R_SID, slave + 1);
2587 }
2588
write_regvals(struct sd * sd,const struct ov_regvals * regvals,int n)2589 static void write_regvals(struct sd *sd,
2590 const struct ov_regvals *regvals,
2591 int n)
2592 {
2593 while (--n >= 0) {
2594 reg_w(sd, regvals->reg, regvals->val);
2595 regvals++;
2596 }
2597 }
2598
write_i2c_regvals(struct sd * sd,const struct ov_i2c_regvals * regvals,int n)2599 static void write_i2c_regvals(struct sd *sd,
2600 const struct ov_i2c_regvals *regvals,
2601 int n)
2602 {
2603 while (--n >= 0) {
2604 i2c_w(sd, regvals->reg, regvals->val);
2605 regvals++;
2606 }
2607 }
2608
2609 /****************************************************************************
2610 *
2611 * OV511 and sensor configuration
2612 *
2613 ***************************************************************************/
2614
2615 /* This initializes the OV2x10 / OV3610 / OV3620 / OV9600 */
ov_hires_configure(struct sd * sd)2616 static void ov_hires_configure(struct sd *sd)
2617 {
2618 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2619 int high, low;
2620
2621 if (sd->bridge != BRIDGE_OVFX2) {
2622 gspca_err(gspca_dev, "error hires sensors only supported with ovfx2\n");
2623 return;
2624 }
2625
2626 gspca_dbg(gspca_dev, D_PROBE, "starting ov hires configuration\n");
2627
2628 /* Detect sensor (sub)type */
2629 high = i2c_r(sd, 0x0a);
2630 low = i2c_r(sd, 0x0b);
2631 /* info("%x, %x", high, low); */
2632 switch (high) {
2633 case 0x96:
2634 switch (low) {
2635 case 0x40:
2636 gspca_dbg(gspca_dev, D_PROBE, "Sensor is a OV2610\n");
2637 sd->sensor = SEN_OV2610;
2638 return;
2639 case 0x41:
2640 gspca_dbg(gspca_dev, D_PROBE, "Sensor is a OV2610AE\n");
2641 sd->sensor = SEN_OV2610AE;
2642 return;
2643 case 0xb1:
2644 gspca_dbg(gspca_dev, D_PROBE, "Sensor is a OV9600\n");
2645 sd->sensor = SEN_OV9600;
2646 return;
2647 }
2648 break;
2649 case 0x36:
2650 if ((low & 0x0f) == 0x00) {
2651 gspca_dbg(gspca_dev, D_PROBE, "Sensor is a OV3610\n");
2652 sd->sensor = SEN_OV3610;
2653 return;
2654 }
2655 break;
2656 }
2657 gspca_err(gspca_dev, "Error unknown sensor type: %02x%02x\n",
2658 high, low);
2659 }
2660
2661 /* This initializes the OV8110, OV8610 sensor. The OV8110 uses
2662 * the same register settings as the OV8610, since they are very similar.
2663 */
ov8xx0_configure(struct sd * sd)2664 static void ov8xx0_configure(struct sd *sd)
2665 {
2666 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2667 int rc;
2668
2669 gspca_dbg(gspca_dev, D_PROBE, "starting ov8xx0 configuration\n");
2670
2671 /* Detect sensor (sub)type */
2672 rc = i2c_r(sd, OV7610_REG_COM_I);
2673 if (rc < 0) {
2674 gspca_err(gspca_dev, "Error detecting sensor type\n");
2675 return;
2676 }
2677 if ((rc & 3) == 1)
2678 sd->sensor = SEN_OV8610;
2679 else
2680 gspca_err(gspca_dev, "Unknown image sensor version: %d\n",
2681 rc & 3);
2682 }
2683
2684 /* This initializes the OV7610, OV7620, or OV76BE sensor. The OV76BE uses
2685 * the same register settings as the OV7610, since they are very similar.
2686 */
ov7xx0_configure(struct sd * sd)2687 static void ov7xx0_configure(struct sd *sd)
2688 {
2689 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2690 int rc, high, low;
2691
2692 gspca_dbg(gspca_dev, D_PROBE, "starting OV7xx0 configuration\n");
2693
2694 /* Detect sensor (sub)type */
2695 rc = i2c_r(sd, OV7610_REG_COM_I);
2696
2697 /* add OV7670 here
2698 * it appears to be wrongly detected as a 7610 by default */
2699 if (rc < 0) {
2700 gspca_err(gspca_dev, "Error detecting sensor type\n");
2701 return;
2702 }
2703 if ((rc & 3) == 3) {
2704 /* quick hack to make OV7670s work */
2705 high = i2c_r(sd, 0x0a);
2706 low = i2c_r(sd, 0x0b);
2707 /* info("%x, %x", high, low); */
2708 if (high == 0x76 && (low & 0xf0) == 0x70) {
2709 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV76%02x\n",
2710 low);
2711 sd->sensor = SEN_OV7670;
2712 } else {
2713 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV7610\n");
2714 sd->sensor = SEN_OV7610;
2715 }
2716 } else if ((rc & 3) == 1) {
2717 /* I don't know what's different about the 76BE yet. */
2718 if (i2c_r(sd, 0x15) & 1) {
2719 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV7620AE\n");
2720 sd->sensor = SEN_OV7620AE;
2721 } else {
2722 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV76BE\n");
2723 sd->sensor = SEN_OV76BE;
2724 }
2725 } else if ((rc & 3) == 0) {
2726 /* try to read product id registers */
2727 high = i2c_r(sd, 0x0a);
2728 if (high < 0) {
2729 gspca_err(gspca_dev, "Error detecting camera chip PID\n");
2730 return;
2731 }
2732 low = i2c_r(sd, 0x0b);
2733 if (low < 0) {
2734 gspca_err(gspca_dev, "Error detecting camera chip VER\n");
2735 return;
2736 }
2737 if (high == 0x76) {
2738 switch (low) {
2739 case 0x30:
2740 gspca_err(gspca_dev, "Sensor is an OV7630/OV7635\n");
2741 gspca_err(gspca_dev, "7630 is not supported by this driver\n");
2742 return;
2743 case 0x40:
2744 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV7645\n");
2745 sd->sensor = SEN_OV7640; /* FIXME */
2746 break;
2747 case 0x45:
2748 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV7645B\n");
2749 sd->sensor = SEN_OV7640; /* FIXME */
2750 break;
2751 case 0x48:
2752 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV7648\n");
2753 sd->sensor = SEN_OV7648;
2754 break;
2755 case 0x60:
2756 gspca_dbg(gspca_dev, D_PROBE, "Sensor is a OV7660\n");
2757 sd->sensor = SEN_OV7660;
2758 break;
2759 default:
2760 gspca_err(gspca_dev, "Unknown sensor: 0x76%02x\n",
2761 low);
2762 return;
2763 }
2764 } else {
2765 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV7620\n");
2766 sd->sensor = SEN_OV7620;
2767 }
2768 } else {
2769 gspca_err(gspca_dev, "Unknown image sensor version: %d\n",
2770 rc & 3);
2771 }
2772 }
2773
2774 /* This initializes the OV6620, OV6630, OV6630AE, or OV6630AF sensor. */
ov6xx0_configure(struct sd * sd)2775 static void ov6xx0_configure(struct sd *sd)
2776 {
2777 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2778 int rc;
2779
2780 gspca_dbg(gspca_dev, D_PROBE, "starting OV6xx0 configuration\n");
2781
2782 /* Detect sensor (sub)type */
2783 rc = i2c_r(sd, OV7610_REG_COM_I);
2784 if (rc < 0) {
2785 gspca_err(gspca_dev, "Error detecting sensor type\n");
2786 return;
2787 }
2788
2789 /* Ugh. The first two bits are the version bits, but
2790 * the entire register value must be used. I guess OVT
2791 * underestimated how many variants they would make. */
2792 switch (rc) {
2793 case 0x00:
2794 sd->sensor = SEN_OV6630;
2795 pr_warn("WARNING: Sensor is an OV66308. Your camera may have been misdetected in previous driver versions.\n");
2796 break;
2797 case 0x01:
2798 sd->sensor = SEN_OV6620;
2799 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV6620\n");
2800 break;
2801 case 0x02:
2802 sd->sensor = SEN_OV6630;
2803 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV66308AE\n");
2804 break;
2805 case 0x03:
2806 sd->sensor = SEN_OV66308AF;
2807 gspca_dbg(gspca_dev, D_PROBE, "Sensor is an OV66308AF\n");
2808 break;
2809 case 0x90:
2810 sd->sensor = SEN_OV6630;
2811 pr_warn("WARNING: Sensor is an OV66307. Your camera may have been misdetected in previous driver versions.\n");
2812 break;
2813 default:
2814 gspca_err(gspca_dev, "FATAL: Unknown sensor version: 0x%02x\n",
2815 rc);
2816 return;
2817 }
2818
2819 /* Set sensor-specific vars */
2820 sd->sif = 1;
2821 }
2822
2823 /* Turns on or off the LED. Only has an effect with OV511+/OV518(+)/OV519 */
ov51x_led_control(struct sd * sd,int on)2824 static void ov51x_led_control(struct sd *sd, int on)
2825 {
2826 if (sd->invert_led)
2827 on = !on;
2828
2829 switch (sd->bridge) {
2830 /* OV511 has no LED control */
2831 case BRIDGE_OV511PLUS:
2832 reg_w(sd, R511_SYS_LED_CTL, on);
2833 break;
2834 case BRIDGE_OV518:
2835 case BRIDGE_OV518PLUS:
2836 reg_w_mask(sd, R518_GPIO_OUT, 0x02 * on, 0x02);
2837 break;
2838 case BRIDGE_OV519:
2839 reg_w_mask(sd, OV519_GPIO_DATA_OUT0, on, 1);
2840 break;
2841 }
2842 }
2843
sd_reset_snapshot(struct gspca_dev * gspca_dev)2844 static void sd_reset_snapshot(struct gspca_dev *gspca_dev)
2845 {
2846 struct sd *sd = (struct sd *) gspca_dev;
2847
2848 if (!sd->snapshot_needs_reset)
2849 return;
2850
2851 /* Note it is important that we clear sd->snapshot_needs_reset,
2852 before actually clearing the snapshot state in the bridge
2853 otherwise we might race with the pkt_scan interrupt handler */
2854 sd->snapshot_needs_reset = 0;
2855
2856 switch (sd->bridge) {
2857 case BRIDGE_OV511:
2858 case BRIDGE_OV511PLUS:
2859 reg_w(sd, R51x_SYS_SNAP, 0x02);
2860 reg_w(sd, R51x_SYS_SNAP, 0x00);
2861 break;
2862 case BRIDGE_OV518:
2863 case BRIDGE_OV518PLUS:
2864 reg_w(sd, R51x_SYS_SNAP, 0x02); /* Reset */
2865 reg_w(sd, R51x_SYS_SNAP, 0x01); /* Enable */
2866 break;
2867 case BRIDGE_OV519:
2868 reg_w(sd, R51x_SYS_RESET, 0x40);
2869 reg_w(sd, R51x_SYS_RESET, 0x00);
2870 break;
2871 }
2872 }
2873
ov51x_upload_quan_tables(struct sd * sd)2874 static void ov51x_upload_quan_tables(struct sd *sd)
2875 {
2876 static const unsigned char yQuanTable511[] = {
2877 0, 1, 1, 2, 2, 3, 3, 4,
2878 1, 1, 1, 2, 2, 3, 4, 4,
2879 1, 1, 2, 2, 3, 4, 4, 4,
2880 2, 2, 2, 3, 4, 4, 4, 4,
2881 2, 2, 3, 4, 4, 5, 5, 5,
2882 3, 3, 4, 4, 5, 5, 5, 5,
2883 3, 4, 4, 4, 5, 5, 5, 5,
2884 4, 4, 4, 4, 5, 5, 5, 5
2885 };
2886
2887 static const unsigned char uvQuanTable511[] = {
2888 0, 2, 2, 3, 4, 4, 4, 4,
2889 2, 2, 2, 4, 4, 4, 4, 4,
2890 2, 2, 3, 4, 4, 4, 4, 4,
2891 3, 4, 4, 4, 4, 4, 4, 4,
2892 4, 4, 4, 4, 4, 4, 4, 4,
2893 4, 4, 4, 4, 4, 4, 4, 4,
2894 4, 4, 4, 4, 4, 4, 4, 4,
2895 4, 4, 4, 4, 4, 4, 4, 4
2896 };
2897
2898 /* OV518 quantization tables are 8x4 (instead of 8x8) */
2899 static const unsigned char yQuanTable518[] = {
2900 5, 4, 5, 6, 6, 7, 7, 7,
2901 5, 5, 5, 5, 6, 7, 7, 7,
2902 6, 6, 6, 6, 7, 7, 7, 8,
2903 7, 7, 6, 7, 7, 7, 8, 8
2904 };
2905 static const unsigned char uvQuanTable518[] = {
2906 6, 6, 6, 7, 7, 7, 7, 7,
2907 6, 6, 6, 7, 7, 7, 7, 7,
2908 6, 6, 6, 7, 7, 7, 7, 8,
2909 7, 7, 7, 7, 7, 7, 8, 8
2910 };
2911
2912 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
2913 const unsigned char *pYTable, *pUVTable;
2914 unsigned char val0, val1;
2915 int i, size, reg = R51x_COMP_LUT_BEGIN;
2916
2917 gspca_dbg(gspca_dev, D_PROBE, "Uploading quantization tables\n");
2918
2919 if (sd->bridge == BRIDGE_OV511 || sd->bridge == BRIDGE_OV511PLUS) {
2920 pYTable = yQuanTable511;
2921 pUVTable = uvQuanTable511;
2922 size = 32;
2923 } else {
2924 pYTable = yQuanTable518;
2925 pUVTable = uvQuanTable518;
2926 size = 16;
2927 }
2928
2929 for (i = 0; i < size; i++) {
2930 val0 = *pYTable++;
2931 val1 = *pYTable++;
2932 val0 &= 0x0f;
2933 val1 &= 0x0f;
2934 val0 |= val1 << 4;
2935 reg_w(sd, reg, val0);
2936
2937 val0 = *pUVTable++;
2938 val1 = *pUVTable++;
2939 val0 &= 0x0f;
2940 val1 &= 0x0f;
2941 val0 |= val1 << 4;
2942 reg_w(sd, reg + size, val0);
2943
2944 reg++;
2945 }
2946 }
2947
2948 /* This initializes the OV511/OV511+ and the sensor */
ov511_configure(struct gspca_dev * gspca_dev)2949 static void ov511_configure(struct gspca_dev *gspca_dev)
2950 {
2951 struct sd *sd = (struct sd *) gspca_dev;
2952
2953 /* For 511 and 511+ */
2954 static const struct ov_regvals init_511[] = {
2955 { R51x_SYS_RESET, 0x7f },
2956 { R51x_SYS_INIT, 0x01 },
2957 { R51x_SYS_RESET, 0x7f },
2958 { R51x_SYS_INIT, 0x01 },
2959 { R51x_SYS_RESET, 0x3f },
2960 { R51x_SYS_INIT, 0x01 },
2961 { R51x_SYS_RESET, 0x3d },
2962 };
2963
2964 static const struct ov_regvals norm_511[] = {
2965 { R511_DRAM_FLOW_CTL, 0x01 },
2966 { R51x_SYS_SNAP, 0x00 },
2967 { R51x_SYS_SNAP, 0x02 },
2968 { R51x_SYS_SNAP, 0x00 },
2969 { R511_FIFO_OPTS, 0x1f },
2970 { R511_COMP_EN, 0x00 },
2971 { R511_COMP_LUT_EN, 0x03 },
2972 };
2973
2974 static const struct ov_regvals norm_511_p[] = {
2975 { R511_DRAM_FLOW_CTL, 0xff },
2976 { R51x_SYS_SNAP, 0x00 },
2977 { R51x_SYS_SNAP, 0x02 },
2978 { R51x_SYS_SNAP, 0x00 },
2979 { R511_FIFO_OPTS, 0xff },
2980 { R511_COMP_EN, 0x00 },
2981 { R511_COMP_LUT_EN, 0x03 },
2982 };
2983
2984 static const struct ov_regvals compress_511[] = {
2985 { 0x70, 0x1f },
2986 { 0x71, 0x05 },
2987 { 0x72, 0x06 },
2988 { 0x73, 0x06 },
2989 { 0x74, 0x14 },
2990 { 0x75, 0x03 },
2991 { 0x76, 0x04 },
2992 { 0x77, 0x04 },
2993 };
2994
2995 gspca_dbg(gspca_dev, D_PROBE, "Device custom id %x\n",
2996 reg_r(sd, R51x_SYS_CUST_ID));
2997
2998 write_regvals(sd, init_511, ARRAY_SIZE(init_511));
2999
3000 switch (sd->bridge) {
3001 case BRIDGE_OV511:
3002 write_regvals(sd, norm_511, ARRAY_SIZE(norm_511));
3003 break;
3004 case BRIDGE_OV511PLUS:
3005 write_regvals(sd, norm_511_p, ARRAY_SIZE(norm_511_p));
3006 break;
3007 }
3008
3009 /* Init compression */
3010 write_regvals(sd, compress_511, ARRAY_SIZE(compress_511));
3011
3012 ov51x_upload_quan_tables(sd);
3013 }
3014
3015 /* This initializes the OV518/OV518+ and the sensor */
ov518_configure(struct gspca_dev * gspca_dev)3016 static void ov518_configure(struct gspca_dev *gspca_dev)
3017 {
3018 struct sd *sd = (struct sd *) gspca_dev;
3019
3020 /* For 518 and 518+ */
3021 static const struct ov_regvals init_518[] = {
3022 { R51x_SYS_RESET, 0x40 },
3023 { R51x_SYS_INIT, 0xe1 },
3024 { R51x_SYS_RESET, 0x3e },
3025 { R51x_SYS_INIT, 0xe1 },
3026 { R51x_SYS_RESET, 0x00 },
3027 { R51x_SYS_INIT, 0xe1 },
3028 { 0x46, 0x00 },
3029 { 0x5d, 0x03 },
3030 };
3031
3032 static const struct ov_regvals norm_518[] = {
3033 { R51x_SYS_SNAP, 0x02 }, /* Reset */
3034 { R51x_SYS_SNAP, 0x01 }, /* Enable */
3035 { 0x31, 0x0f },
3036 { 0x5d, 0x03 },
3037 { 0x24, 0x9f },
3038 { 0x25, 0x90 },
3039 { 0x20, 0x00 },
3040 { 0x51, 0x04 },
3041 { 0x71, 0x19 },
3042 { 0x2f, 0x80 },
3043 };
3044
3045 static const struct ov_regvals norm_518_p[] = {
3046 { R51x_SYS_SNAP, 0x02 }, /* Reset */
3047 { R51x_SYS_SNAP, 0x01 }, /* Enable */
3048 { 0x31, 0x0f },
3049 { 0x5d, 0x03 },
3050 { 0x24, 0x9f },
3051 { 0x25, 0x90 },
3052 { 0x20, 0x60 },
3053 { 0x51, 0x02 },
3054 { 0x71, 0x19 },
3055 { 0x40, 0xff },
3056 { 0x41, 0x42 },
3057 { 0x46, 0x00 },
3058 { 0x33, 0x04 },
3059 { 0x21, 0x19 },
3060 { 0x3f, 0x10 },
3061 { 0x2f, 0x80 },
3062 };
3063
3064 /* First 5 bits of custom ID reg are a revision ID on OV518 */
3065 sd->revision = reg_r(sd, R51x_SYS_CUST_ID) & 0x1f;
3066 gspca_dbg(gspca_dev, D_PROBE, "Device revision %d\n", sd->revision);
3067
3068 write_regvals(sd, init_518, ARRAY_SIZE(init_518));
3069
3070 /* Set LED GPIO pin to output mode */
3071 reg_w_mask(sd, R518_GPIO_CTL, 0x00, 0x02);
3072
3073 switch (sd->bridge) {
3074 case BRIDGE_OV518:
3075 write_regvals(sd, norm_518, ARRAY_SIZE(norm_518));
3076 break;
3077 case BRIDGE_OV518PLUS:
3078 write_regvals(sd, norm_518_p, ARRAY_SIZE(norm_518_p));
3079 break;
3080 }
3081
3082 ov51x_upload_quan_tables(sd);
3083
3084 reg_w(sd, 0x2f, 0x80);
3085 }
3086
ov519_configure(struct sd * sd)3087 static void ov519_configure(struct sd *sd)
3088 {
3089 static const struct ov_regvals init_519[] = {
3090 { 0x5a, 0x6d }, /* EnableSystem */
3091 { 0x53, 0x9b }, /* don't enable the microcontroller */
3092 { OV519_R54_EN_CLK1, 0xff }, /* set bit2 to enable jpeg */
3093 { 0x5d, 0x03 },
3094 { 0x49, 0x01 },
3095 { 0x48, 0x00 },
3096 /* Set LED pin to output mode. Bit 4 must be cleared or sensor
3097 * detection will fail. This deserves further investigation. */
3098 { OV519_GPIO_IO_CTRL0, 0xee },
3099 { OV519_R51_RESET1, 0x0f },
3100 { OV519_R51_RESET1, 0x00 },
3101 { 0x22, 0x00 },
3102 /* windows reads 0x55 at this point*/
3103 };
3104
3105 write_regvals(sd, init_519, ARRAY_SIZE(init_519));
3106 }
3107
ovfx2_configure(struct sd * sd)3108 static void ovfx2_configure(struct sd *sd)
3109 {
3110 static const struct ov_regvals init_fx2[] = {
3111 { 0x00, 0x60 },
3112 { 0x02, 0x01 },
3113 { 0x0f, 0x1d },
3114 { 0xe9, 0x82 },
3115 { 0xea, 0xc7 },
3116 { 0xeb, 0x10 },
3117 { 0xec, 0xf6 },
3118 };
3119
3120 sd->stopped = 1;
3121
3122 write_regvals(sd, init_fx2, ARRAY_SIZE(init_fx2));
3123 }
3124
3125 /* set the mode */
3126 /* This function works for ov7660 only */
ov519_set_mode(struct sd * sd)3127 static void ov519_set_mode(struct sd *sd)
3128 {
3129 static const struct ov_regvals bridge_ov7660[2][10] = {
3130 {{0x10, 0x14}, {0x11, 0x1e}, {0x12, 0x00}, {0x13, 0x00},
3131 {0x14, 0x00}, {0x15, 0x00}, {0x16, 0x00}, {0x20, 0x0c},
3132 {0x25, 0x01}, {0x26, 0x00}},
3133 {{0x10, 0x28}, {0x11, 0x3c}, {0x12, 0x00}, {0x13, 0x00},
3134 {0x14, 0x00}, {0x15, 0x00}, {0x16, 0x00}, {0x20, 0x0c},
3135 {0x25, 0x03}, {0x26, 0x00}}
3136 };
3137 static const struct ov_i2c_regvals sensor_ov7660[2][3] = {
3138 {{0x12, 0x00}, {0x24, 0x00}, {0x0c, 0x0c}},
3139 {{0x12, 0x00}, {0x04, 0x00}, {0x0c, 0x00}}
3140 };
3141 static const struct ov_i2c_regvals sensor_ov7660_2[] = {
3142 {OV7670_R17_HSTART, 0x13},
3143 {OV7670_R18_HSTOP, 0x01},
3144 {OV7670_R32_HREF, 0x92},
3145 {OV7670_R19_VSTART, 0x02},
3146 {OV7670_R1A_VSTOP, 0x7a},
3147 {OV7670_R03_VREF, 0x00},
3148 /* {0x33, 0x00}, */
3149 /* {0x34, 0x07}, */
3150 /* {0x36, 0x00}, */
3151 /* {0x6b, 0x0a}, */
3152 };
3153
3154 write_regvals(sd, bridge_ov7660[sd->gspca_dev.curr_mode],
3155 ARRAY_SIZE(bridge_ov7660[0]));
3156 write_i2c_regvals(sd, sensor_ov7660[sd->gspca_dev.curr_mode],
3157 ARRAY_SIZE(sensor_ov7660[0]));
3158 write_i2c_regvals(sd, sensor_ov7660_2,
3159 ARRAY_SIZE(sensor_ov7660_2));
3160 }
3161
3162 /* set the frame rate */
3163 /* This function works for sensors ov7640, ov7648 ov7660 and ov7670 only */
ov519_set_fr(struct sd * sd)3164 static void ov519_set_fr(struct sd *sd)
3165 {
3166 int fr;
3167 u8 clock;
3168 /* frame rate table with indices:
3169 * - mode = 0: 320x240, 1: 640x480
3170 * - fr rate = 0: 30, 1: 25, 2: 20, 3: 15, 4: 10, 5: 5
3171 * - reg = 0: bridge a4, 1: bridge 23, 2: sensor 11 (clock)
3172 */
3173 static const u8 fr_tb[2][6][3] = {
3174 {{0x04, 0xff, 0x00},
3175 {0x04, 0x1f, 0x00},
3176 {0x04, 0x1b, 0x00},
3177 {0x04, 0x15, 0x00},
3178 {0x04, 0x09, 0x00},
3179 {0x04, 0x01, 0x00}},
3180 {{0x0c, 0xff, 0x00},
3181 {0x0c, 0x1f, 0x00},
3182 {0x0c, 0x1b, 0x00},
3183 {0x04, 0xff, 0x01},
3184 {0x04, 0x1f, 0x01},
3185 {0x04, 0x1b, 0x01}},
3186 };
3187
3188 if (frame_rate > 0)
3189 sd->frame_rate = frame_rate;
3190 if (sd->frame_rate >= 30)
3191 fr = 0;
3192 else if (sd->frame_rate >= 25)
3193 fr = 1;
3194 else if (sd->frame_rate >= 20)
3195 fr = 2;
3196 else if (sd->frame_rate >= 15)
3197 fr = 3;
3198 else if (sd->frame_rate >= 10)
3199 fr = 4;
3200 else
3201 fr = 5;
3202 reg_w(sd, 0xa4, fr_tb[sd->gspca_dev.curr_mode][fr][0]);
3203 reg_w(sd, 0x23, fr_tb[sd->gspca_dev.curr_mode][fr][1]);
3204 clock = fr_tb[sd->gspca_dev.curr_mode][fr][2];
3205 if (sd->sensor == SEN_OV7660)
3206 clock |= 0x80; /* enable double clock */
3207 ov518_i2c_w(sd, OV7670_R11_CLKRC, clock);
3208 }
3209
setautogain(struct gspca_dev * gspca_dev,s32 val)3210 static void setautogain(struct gspca_dev *gspca_dev, s32 val)
3211 {
3212 struct sd *sd = (struct sd *) gspca_dev;
3213
3214 i2c_w_mask(sd, 0x13, val ? 0x05 : 0x00, 0x05);
3215 }
3216
3217 /* this function is called at probe time */
sd_config(struct gspca_dev * gspca_dev,const struct usb_device_id * id)3218 static int sd_config(struct gspca_dev *gspca_dev,
3219 const struct usb_device_id *id)
3220 {
3221 struct sd *sd = (struct sd *) gspca_dev;
3222 struct cam *cam = &gspca_dev->cam;
3223
3224 sd->bridge = id->driver_info & BRIDGE_MASK;
3225 sd->invert_led = (id->driver_info & BRIDGE_INVERT_LED) != 0;
3226
3227 switch (sd->bridge) {
3228 case BRIDGE_OV511:
3229 case BRIDGE_OV511PLUS:
3230 cam->cam_mode = ov511_vga_mode;
3231 cam->nmodes = ARRAY_SIZE(ov511_vga_mode);
3232 break;
3233 case BRIDGE_OV518:
3234 case BRIDGE_OV518PLUS:
3235 cam->cam_mode = ov518_vga_mode;
3236 cam->nmodes = ARRAY_SIZE(ov518_vga_mode);
3237 break;
3238 case BRIDGE_OV519:
3239 cam->cam_mode = ov519_vga_mode;
3240 cam->nmodes = ARRAY_SIZE(ov519_vga_mode);
3241 break;
3242 case BRIDGE_OVFX2:
3243 cam->cam_mode = ov519_vga_mode;
3244 cam->nmodes = ARRAY_SIZE(ov519_vga_mode);
3245 cam->bulk_size = OVFX2_BULK_SIZE;
3246 cam->bulk_nurbs = MAX_NURBS;
3247 cam->bulk = 1;
3248 break;
3249 case BRIDGE_W9968CF:
3250 cam->cam_mode = w9968cf_vga_mode;
3251 cam->nmodes = ARRAY_SIZE(w9968cf_vga_mode);
3252 break;
3253 }
3254
3255 sd->frame_rate = 15;
3256
3257 return 0;
3258 }
3259
3260 /* this function is called at probe and resume time */
sd_init(struct gspca_dev * gspca_dev)3261 static int sd_init(struct gspca_dev *gspca_dev)
3262 {
3263 struct sd *sd = (struct sd *) gspca_dev;
3264 struct cam *cam = &gspca_dev->cam;
3265
3266 switch (sd->bridge) {
3267 case BRIDGE_OV511:
3268 case BRIDGE_OV511PLUS:
3269 ov511_configure(gspca_dev);
3270 break;
3271 case BRIDGE_OV518:
3272 case BRIDGE_OV518PLUS:
3273 ov518_configure(gspca_dev);
3274 break;
3275 case BRIDGE_OV519:
3276 ov519_configure(sd);
3277 break;
3278 case BRIDGE_OVFX2:
3279 ovfx2_configure(sd);
3280 break;
3281 case BRIDGE_W9968CF:
3282 w9968cf_configure(sd);
3283 break;
3284 }
3285
3286 /* The OV519 must be more aggressive about sensor detection since
3287 * I2C write will never fail if the sensor is not present. We have
3288 * to try to initialize the sensor to detect its presence */
3289 sd->sensor = -1;
3290
3291 /* Test for 76xx */
3292 if (init_ov_sensor(sd, OV7xx0_SID) >= 0) {
3293 ov7xx0_configure(sd);
3294
3295 /* Test for 6xx0 */
3296 } else if (init_ov_sensor(sd, OV6xx0_SID) >= 0) {
3297 ov6xx0_configure(sd);
3298
3299 /* Test for 8xx0 */
3300 } else if (init_ov_sensor(sd, OV8xx0_SID) >= 0) {
3301 ov8xx0_configure(sd);
3302
3303 /* Test for 3xxx / 2xxx */
3304 } else if (init_ov_sensor(sd, OV_HIRES_SID) >= 0) {
3305 ov_hires_configure(sd);
3306 } else {
3307 gspca_err(gspca_dev, "Can't determine sensor slave IDs\n");
3308 goto error;
3309 }
3310
3311 if (sd->sensor < 0)
3312 goto error;
3313
3314 ov51x_led_control(sd, 0); /* turn LED off */
3315
3316 switch (sd->bridge) {
3317 case BRIDGE_OV511:
3318 case BRIDGE_OV511PLUS:
3319 if (sd->sif) {
3320 cam->cam_mode = ov511_sif_mode;
3321 cam->nmodes = ARRAY_SIZE(ov511_sif_mode);
3322 }
3323 break;
3324 case BRIDGE_OV518:
3325 case BRIDGE_OV518PLUS:
3326 if (sd->sif) {
3327 cam->cam_mode = ov518_sif_mode;
3328 cam->nmodes = ARRAY_SIZE(ov518_sif_mode);
3329 }
3330 break;
3331 case BRIDGE_OV519:
3332 if (sd->sif) {
3333 cam->cam_mode = ov519_sif_mode;
3334 cam->nmodes = ARRAY_SIZE(ov519_sif_mode);
3335 }
3336 break;
3337 case BRIDGE_OVFX2:
3338 switch (sd->sensor) {
3339 case SEN_OV2610:
3340 case SEN_OV2610AE:
3341 cam->cam_mode = ovfx2_ov2610_mode;
3342 cam->nmodes = ARRAY_SIZE(ovfx2_ov2610_mode);
3343 break;
3344 case SEN_OV3610:
3345 cam->cam_mode = ovfx2_ov3610_mode;
3346 cam->nmodes = ARRAY_SIZE(ovfx2_ov3610_mode);
3347 break;
3348 case SEN_OV9600:
3349 cam->cam_mode = ovfx2_ov9600_mode;
3350 cam->nmodes = ARRAY_SIZE(ovfx2_ov9600_mode);
3351 break;
3352 default:
3353 if (sd->sif) {
3354 cam->cam_mode = ov519_sif_mode;
3355 cam->nmodes = ARRAY_SIZE(ov519_sif_mode);
3356 }
3357 break;
3358 }
3359 break;
3360 case BRIDGE_W9968CF:
3361 if (sd->sif)
3362 cam->nmodes = ARRAY_SIZE(w9968cf_vga_mode) - 1;
3363
3364 /* w9968cf needs initialisation once the sensor is known */
3365 w9968cf_init(sd);
3366 break;
3367 }
3368
3369 /* initialize the sensor */
3370 switch (sd->sensor) {
3371 case SEN_OV2610:
3372 write_i2c_regvals(sd, norm_2610, ARRAY_SIZE(norm_2610));
3373
3374 /* Enable autogain, autoexpo, awb, bandfilter */
3375 i2c_w_mask(sd, 0x13, 0x27, 0x27);
3376 break;
3377 case SEN_OV2610AE:
3378 write_i2c_regvals(sd, norm_2610ae, ARRAY_SIZE(norm_2610ae));
3379
3380 /* enable autoexpo */
3381 i2c_w_mask(sd, 0x13, 0x05, 0x05);
3382 break;
3383 case SEN_OV3610:
3384 write_i2c_regvals(sd, norm_3620b, ARRAY_SIZE(norm_3620b));
3385
3386 /* Enable autogain, autoexpo, awb, bandfilter */
3387 i2c_w_mask(sd, 0x13, 0x27, 0x27);
3388 break;
3389 case SEN_OV6620:
3390 write_i2c_regvals(sd, norm_6x20, ARRAY_SIZE(norm_6x20));
3391 break;
3392 case SEN_OV6630:
3393 case SEN_OV66308AF:
3394 write_i2c_regvals(sd, norm_6x30, ARRAY_SIZE(norm_6x30));
3395 break;
3396 default:
3397 /* case SEN_OV7610: */
3398 /* case SEN_OV76BE: */
3399 write_i2c_regvals(sd, norm_7610, ARRAY_SIZE(norm_7610));
3400 i2c_w_mask(sd, 0x0e, 0x00, 0x40);
3401 break;
3402 case SEN_OV7620:
3403 case SEN_OV7620AE:
3404 write_i2c_regvals(sd, norm_7620, ARRAY_SIZE(norm_7620));
3405 break;
3406 case SEN_OV7640:
3407 case SEN_OV7648:
3408 write_i2c_regvals(sd, norm_7640, ARRAY_SIZE(norm_7640));
3409 break;
3410 case SEN_OV7660:
3411 i2c_w(sd, OV7670_R12_COM7, OV7670_COM7_RESET);
3412 msleep(14);
3413 reg_w(sd, OV519_R57_SNAPSHOT, 0x23);
3414 write_regvals(sd, init_519_ov7660,
3415 ARRAY_SIZE(init_519_ov7660));
3416 write_i2c_regvals(sd, norm_7660, ARRAY_SIZE(norm_7660));
3417 sd->gspca_dev.curr_mode = 1; /* 640x480 */
3418 ov519_set_mode(sd);
3419 ov519_set_fr(sd);
3420 sd_reset_snapshot(gspca_dev);
3421 ov51x_restart(sd);
3422 ov51x_stop(sd); /* not in win traces */
3423 ov51x_led_control(sd, 0);
3424 break;
3425 case SEN_OV7670:
3426 write_i2c_regvals(sd, norm_7670, ARRAY_SIZE(norm_7670));
3427 break;
3428 case SEN_OV8610:
3429 write_i2c_regvals(sd, norm_8610, ARRAY_SIZE(norm_8610));
3430 break;
3431 case SEN_OV9600:
3432 write_i2c_regvals(sd, norm_9600, ARRAY_SIZE(norm_9600));
3433
3434 /* enable autoexpo */
3435 /* i2c_w_mask(sd, 0x13, 0x05, 0x05); */
3436 break;
3437 }
3438 return gspca_dev->usb_err;
3439 error:
3440 gspca_err(gspca_dev, "OV519 Config failed\n");
3441 return -EINVAL;
3442 }
3443
3444 /* function called at start time before URB creation */
sd_isoc_init(struct gspca_dev * gspca_dev)3445 static int sd_isoc_init(struct gspca_dev *gspca_dev)
3446 {
3447 struct sd *sd = (struct sd *) gspca_dev;
3448
3449 switch (sd->bridge) {
3450 case BRIDGE_OVFX2:
3451 if (gspca_dev->pixfmt.width != 800)
3452 gspca_dev->cam.bulk_size = OVFX2_BULK_SIZE;
3453 else
3454 gspca_dev->cam.bulk_size = 7 * 4096;
3455 break;
3456 }
3457 return 0;
3458 }
3459
3460 /* Set up the OV511/OV511+ with the given image parameters.
3461 *
3462 * Do not put any sensor-specific code in here (including I2C I/O functions)
3463 */
ov511_mode_init_regs(struct sd * sd)3464 static void ov511_mode_init_regs(struct sd *sd)
3465 {
3466 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
3467 int hsegs, vsegs, packet_size, fps, needed;
3468 int interlaced = 0;
3469 struct usb_host_interface *alt;
3470 struct usb_interface *intf;
3471
3472 intf = usb_ifnum_to_if(sd->gspca_dev.dev, sd->gspca_dev.iface);
3473 alt = usb_altnum_to_altsetting(intf, sd->gspca_dev.alt);
3474 if (!alt) {
3475 gspca_err(gspca_dev, "Couldn't get altsetting\n");
3476 sd->gspca_dev.usb_err = -EIO;
3477 return;
3478 }
3479
3480 if (alt->desc.bNumEndpoints < 1) {
3481 sd->gspca_dev.usb_err = -ENODEV;
3482 return;
3483 }
3484
3485 packet_size = le16_to_cpu(alt->endpoint[0].desc.wMaxPacketSize);
3486 reg_w(sd, R51x_FIFO_PSIZE, packet_size >> 5);
3487
3488 reg_w(sd, R511_CAM_UV_EN, 0x01);
3489 reg_w(sd, R511_SNAP_UV_EN, 0x01);
3490 reg_w(sd, R511_SNAP_OPTS, 0x03);
3491
3492 /* Here I'm assuming that snapshot size == image size.
3493 * I hope that's always true. --claudio
3494 */
3495 hsegs = (sd->gspca_dev.pixfmt.width >> 3) - 1;
3496 vsegs = (sd->gspca_dev.pixfmt.height >> 3) - 1;
3497
3498 reg_w(sd, R511_CAM_PXCNT, hsegs);
3499 reg_w(sd, R511_CAM_LNCNT, vsegs);
3500 reg_w(sd, R511_CAM_PXDIV, 0x00);
3501 reg_w(sd, R511_CAM_LNDIV, 0x00);
3502
3503 /* YUV420, low pass filter on */
3504 reg_w(sd, R511_CAM_OPTS, 0x03);
3505
3506 /* Snapshot additions */
3507 reg_w(sd, R511_SNAP_PXCNT, hsegs);
3508 reg_w(sd, R511_SNAP_LNCNT, vsegs);
3509 reg_w(sd, R511_SNAP_PXDIV, 0x00);
3510 reg_w(sd, R511_SNAP_LNDIV, 0x00);
3511
3512 /******** Set the framerate ********/
3513 if (frame_rate > 0)
3514 sd->frame_rate = frame_rate;
3515
3516 switch (sd->sensor) {
3517 case SEN_OV6620:
3518 /* No framerate control, doesn't like higher rates yet */
3519 sd->clockdiv = 3;
3520 break;
3521
3522 /* Note once the FIXME's in mode_init_ov_sensor_regs() are fixed
3523 for more sensors we need to do this for them too */
3524 case SEN_OV7620:
3525 case SEN_OV7620AE:
3526 case SEN_OV7640:
3527 case SEN_OV7648:
3528 case SEN_OV76BE:
3529 if (sd->gspca_dev.pixfmt.width == 320)
3530 interlaced = 1;
3531 fallthrough;
3532 case SEN_OV6630:
3533 case SEN_OV7610:
3534 case SEN_OV7670:
3535 switch (sd->frame_rate) {
3536 case 30:
3537 case 25:
3538 /* Not enough bandwidth to do 640x480 @ 30 fps */
3539 if (sd->gspca_dev.pixfmt.width != 640) {
3540 sd->clockdiv = 0;
3541 break;
3542 }
3543 /* For 640x480 case */
3544 fallthrough;
3545 default:
3546 /* case 20: */
3547 /* case 15: */
3548 sd->clockdiv = 1;
3549 break;
3550 case 10:
3551 sd->clockdiv = 2;
3552 break;
3553 case 5:
3554 sd->clockdiv = 5;
3555 break;
3556 }
3557 if (interlaced) {
3558 sd->clockdiv = (sd->clockdiv + 1) * 2 - 1;
3559 /* Higher then 10 does not work */
3560 if (sd->clockdiv > 10)
3561 sd->clockdiv = 10;
3562 }
3563 break;
3564
3565 case SEN_OV8610:
3566 /* No framerate control ?? */
3567 sd->clockdiv = 0;
3568 break;
3569 }
3570
3571 /* Check if we have enough bandwidth to disable compression */
3572 fps = (interlaced ? 60 : 30) / (sd->clockdiv + 1) + 1;
3573 needed = fps * sd->gspca_dev.pixfmt.width *
3574 sd->gspca_dev.pixfmt.height * 3 / 2;
3575 /* 1000 isoc packets/sec */
3576 if (needed > 1000 * packet_size) {
3577 /* Enable Y and UV quantization and compression */
3578 reg_w(sd, R511_COMP_EN, 0x07);
3579 reg_w(sd, R511_COMP_LUT_EN, 0x03);
3580 } else {
3581 reg_w(sd, R511_COMP_EN, 0x06);
3582 reg_w(sd, R511_COMP_LUT_EN, 0x00);
3583 }
3584
3585 reg_w(sd, R51x_SYS_RESET, OV511_RESET_OMNICE);
3586 reg_w(sd, R51x_SYS_RESET, 0);
3587 }
3588
3589 /* Sets up the OV518/OV518+ with the given image parameters
3590 *
3591 * OV518 needs a completely different approach, until we can figure out what
3592 * the individual registers do. Also, only 15 FPS is supported now.
3593 *
3594 * Do not put any sensor-specific code in here (including I2C I/O functions)
3595 */
ov518_mode_init_regs(struct sd * sd)3596 static void ov518_mode_init_regs(struct sd *sd)
3597 {
3598 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
3599 int hsegs, vsegs, packet_size;
3600 struct usb_host_interface *alt;
3601 struct usb_interface *intf;
3602
3603 intf = usb_ifnum_to_if(sd->gspca_dev.dev, sd->gspca_dev.iface);
3604 alt = usb_altnum_to_altsetting(intf, sd->gspca_dev.alt);
3605 if (!alt) {
3606 gspca_err(gspca_dev, "Couldn't get altsetting\n");
3607 sd->gspca_dev.usb_err = -EIO;
3608 return;
3609 }
3610
3611 if (alt->desc.bNumEndpoints < 1) {
3612 sd->gspca_dev.usb_err = -ENODEV;
3613 return;
3614 }
3615
3616 packet_size = le16_to_cpu(alt->endpoint[0].desc.wMaxPacketSize);
3617 ov518_reg_w32(sd, R51x_FIFO_PSIZE, packet_size & ~7, 2);
3618
3619 /******** Set the mode ********/
3620 reg_w(sd, 0x2b, 0);
3621 reg_w(sd, 0x2c, 0);
3622 reg_w(sd, 0x2d, 0);
3623 reg_w(sd, 0x2e, 0);
3624 reg_w(sd, 0x3b, 0);
3625 reg_w(sd, 0x3c, 0);
3626 reg_w(sd, 0x3d, 0);
3627 reg_w(sd, 0x3e, 0);
3628
3629 if (sd->bridge == BRIDGE_OV518) {
3630 /* Set 8-bit (YVYU) input format */
3631 reg_w_mask(sd, 0x20, 0x08, 0x08);
3632
3633 /* Set 12-bit (4:2:0) output format */
3634 reg_w_mask(sd, 0x28, 0x80, 0xf0);
3635 reg_w_mask(sd, 0x38, 0x80, 0xf0);
3636 } else {
3637 reg_w(sd, 0x28, 0x80);
3638 reg_w(sd, 0x38, 0x80);
3639 }
3640
3641 hsegs = sd->gspca_dev.pixfmt.width / 16;
3642 vsegs = sd->gspca_dev.pixfmt.height / 4;
3643
3644 reg_w(sd, 0x29, hsegs);
3645 reg_w(sd, 0x2a, vsegs);
3646
3647 reg_w(sd, 0x39, hsegs);
3648 reg_w(sd, 0x3a, vsegs);
3649
3650 /* Windows driver does this here; who knows why */
3651 reg_w(sd, 0x2f, 0x80);
3652
3653 /******** Set the framerate ********/
3654 if (sd->bridge == BRIDGE_OV518PLUS && sd->revision == 0 &&
3655 sd->sensor == SEN_OV7620AE)
3656 sd->clockdiv = 0;
3657 else
3658 sd->clockdiv = 1;
3659
3660 /* Mode independent, but framerate dependent, regs */
3661 /* 0x51: Clock divider; Only works on some cams which use 2 crystals */
3662 reg_w(sd, 0x51, 0x04);
3663 reg_w(sd, 0x22, 0x18);
3664 reg_w(sd, 0x23, 0xff);
3665
3666 if (sd->bridge == BRIDGE_OV518PLUS) {
3667 switch (sd->sensor) {
3668 case SEN_OV7620AE:
3669 /*
3670 * HdG: 640x480 needs special handling on device
3671 * revision 2, we check for device revision > 0 to
3672 * avoid regressions, as we don't know the correct
3673 * thing todo for revision 1.
3674 *
3675 * Also this likely means we don't need to
3676 * differentiate between the OV7620 and OV7620AE,
3677 * earlier testing hitting this same problem likely
3678 * happened to be with revision < 2 cams using an
3679 * OV7620 and revision 2 cams using an OV7620AE.
3680 */
3681 if (sd->revision > 0 &&
3682 sd->gspca_dev.pixfmt.width == 640) {
3683 reg_w(sd, 0x20, 0x60);
3684 reg_w(sd, 0x21, 0x1f);
3685 } else {
3686 reg_w(sd, 0x20, 0x00);
3687 reg_w(sd, 0x21, 0x19);
3688 }
3689 break;
3690 case SEN_OV7620:
3691 reg_w(sd, 0x20, 0x00);
3692 reg_w(sd, 0x21, 0x19);
3693 break;
3694 default:
3695 reg_w(sd, 0x21, 0x19);
3696 }
3697 } else
3698 reg_w(sd, 0x71, 0x17); /* Compression-related? */
3699
3700 /* FIXME: Sensor-specific */
3701 /* Bit 5 is what matters here. Of course, it is "reserved" */
3702 i2c_w(sd, 0x54, 0x23);
3703
3704 reg_w(sd, 0x2f, 0x80);
3705
3706 if (sd->bridge == BRIDGE_OV518PLUS) {
3707 reg_w(sd, 0x24, 0x94);
3708 reg_w(sd, 0x25, 0x90);
3709 ov518_reg_w32(sd, 0xc4, 400, 2); /* 190h */
3710 ov518_reg_w32(sd, 0xc6, 540, 2); /* 21ch */
3711 ov518_reg_w32(sd, 0xc7, 540, 2); /* 21ch */
3712 ov518_reg_w32(sd, 0xc8, 108, 2); /* 6ch */
3713 ov518_reg_w32(sd, 0xca, 131098, 3); /* 2001ah */
3714 ov518_reg_w32(sd, 0xcb, 532, 2); /* 214h */
3715 ov518_reg_w32(sd, 0xcc, 2400, 2); /* 960h */
3716 ov518_reg_w32(sd, 0xcd, 32, 2); /* 20h */
3717 ov518_reg_w32(sd, 0xce, 608, 2); /* 260h */
3718 } else {
3719 reg_w(sd, 0x24, 0x9f);
3720 reg_w(sd, 0x25, 0x90);
3721 ov518_reg_w32(sd, 0xc4, 400, 2); /* 190h */
3722 ov518_reg_w32(sd, 0xc6, 381, 2); /* 17dh */
3723 ov518_reg_w32(sd, 0xc7, 381, 2); /* 17dh */
3724 ov518_reg_w32(sd, 0xc8, 128, 2); /* 80h */
3725 ov518_reg_w32(sd, 0xca, 183331, 3); /* 2cc23h */
3726 ov518_reg_w32(sd, 0xcb, 746, 2); /* 2eah */
3727 ov518_reg_w32(sd, 0xcc, 1750, 2); /* 6d6h */
3728 ov518_reg_w32(sd, 0xcd, 45, 2); /* 2dh */
3729 ov518_reg_w32(sd, 0xce, 851, 2); /* 353h */
3730 }
3731
3732 reg_w(sd, 0x2f, 0x80);
3733 }
3734
3735 /* Sets up the OV519 with the given image parameters
3736 *
3737 * OV519 needs a completely different approach, until we can figure out what
3738 * the individual registers do.
3739 *
3740 * Do not put any sensor-specific code in here (including I2C I/O functions)
3741 */
ov519_mode_init_regs(struct sd * sd)3742 static void ov519_mode_init_regs(struct sd *sd)
3743 {
3744 static const struct ov_regvals mode_init_519_ov7670[] = {
3745 { 0x5d, 0x03 }, /* Turn off suspend mode */
3746 { 0x53, 0x9f }, /* was 9b in 1.65-1.08 */
3747 { OV519_R54_EN_CLK1, 0x0f }, /* bit2 (jpeg enable) */
3748 { 0xa2, 0x20 }, /* a2-a5 are undocumented */
3749 { 0xa3, 0x18 },
3750 { 0xa4, 0x04 },
3751 { 0xa5, 0x28 },
3752 { 0x37, 0x00 }, /* SetUsbInit */
3753 { 0x55, 0x02 }, /* 4.096 Mhz audio clock */
3754 /* Enable both fields, YUV Input, disable defect comp (why?) */
3755 { 0x20, 0x0c },
3756 { 0x21, 0x38 },
3757 { 0x22, 0x1d },
3758 { 0x17, 0x50 }, /* undocumented */
3759 { 0x37, 0x00 }, /* undocumented */
3760 { 0x40, 0xff }, /* I2C timeout counter */
3761 { 0x46, 0x00 }, /* I2C clock prescaler */
3762 { 0x59, 0x04 }, /* new from windrv 090403 */
3763 { 0xff, 0x00 }, /* undocumented */
3764 /* windows reads 0x55 at this point, why? */
3765 };
3766
3767 static const struct ov_regvals mode_init_519[] = {
3768 { 0x5d, 0x03 }, /* Turn off suspend mode */
3769 { 0x53, 0x9f }, /* was 9b in 1.65-1.08 */
3770 { OV519_R54_EN_CLK1, 0x0f }, /* bit2 (jpeg enable) */
3771 { 0xa2, 0x20 }, /* a2-a5 are undocumented */
3772 { 0xa3, 0x18 },
3773 { 0xa4, 0x04 },
3774 { 0xa5, 0x28 },
3775 { 0x37, 0x00 }, /* SetUsbInit */
3776 { 0x55, 0x02 }, /* 4.096 Mhz audio clock */
3777 /* Enable both fields, YUV Input, disable defect comp (why?) */
3778 { 0x22, 0x1d },
3779 { 0x17, 0x50 }, /* undocumented */
3780 { 0x37, 0x00 }, /* undocumented */
3781 { 0x40, 0xff }, /* I2C timeout counter */
3782 { 0x46, 0x00 }, /* I2C clock prescaler */
3783 { 0x59, 0x04 }, /* new from windrv 090403 */
3784 { 0xff, 0x00 }, /* undocumented */
3785 /* windows reads 0x55 at this point, why? */
3786 };
3787
3788 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
3789
3790 /******** Set the mode ********/
3791 switch (sd->sensor) {
3792 default:
3793 write_regvals(sd, mode_init_519, ARRAY_SIZE(mode_init_519));
3794 if (sd->sensor == SEN_OV7640 ||
3795 sd->sensor == SEN_OV7648) {
3796 /* Select 8-bit input mode */
3797 reg_w_mask(sd, OV519_R20_DFR, 0x10, 0x10);
3798 }
3799 break;
3800 case SEN_OV7660:
3801 return; /* done by ov519_set_mode/fr() */
3802 case SEN_OV7670:
3803 write_regvals(sd, mode_init_519_ov7670,
3804 ARRAY_SIZE(mode_init_519_ov7670));
3805 break;
3806 }
3807
3808 reg_w(sd, OV519_R10_H_SIZE, sd->gspca_dev.pixfmt.width >> 4);
3809 reg_w(sd, OV519_R11_V_SIZE, sd->gspca_dev.pixfmt.height >> 3);
3810 if (sd->sensor == SEN_OV7670 &&
3811 sd->gspca_dev.cam.cam_mode[sd->gspca_dev.curr_mode].priv)
3812 reg_w(sd, OV519_R12_X_OFFSETL, 0x04);
3813 else if (sd->sensor == SEN_OV7648 &&
3814 sd->gspca_dev.cam.cam_mode[sd->gspca_dev.curr_mode].priv)
3815 reg_w(sd, OV519_R12_X_OFFSETL, 0x01);
3816 else
3817 reg_w(sd, OV519_R12_X_OFFSETL, 0x00);
3818 reg_w(sd, OV519_R13_X_OFFSETH, 0x00);
3819 reg_w(sd, OV519_R14_Y_OFFSETL, 0x00);
3820 reg_w(sd, OV519_R15_Y_OFFSETH, 0x00);
3821 reg_w(sd, OV519_R16_DIVIDER, 0x00);
3822 reg_w(sd, OV519_R25_FORMAT, 0x03); /* YUV422 */
3823 reg_w(sd, 0x26, 0x00); /* Undocumented */
3824
3825 /******** Set the framerate ********/
3826 if (frame_rate > 0)
3827 sd->frame_rate = frame_rate;
3828
3829 /* FIXME: These are only valid at the max resolution. */
3830 sd->clockdiv = 0;
3831 switch (sd->sensor) {
3832 case SEN_OV7640:
3833 case SEN_OV7648:
3834 switch (sd->frame_rate) {
3835 default:
3836 /* case 30: */
3837 reg_w(sd, 0xa4, 0x0c);
3838 reg_w(sd, 0x23, 0xff);
3839 break;
3840 case 25:
3841 reg_w(sd, 0xa4, 0x0c);
3842 reg_w(sd, 0x23, 0x1f);
3843 break;
3844 case 20:
3845 reg_w(sd, 0xa4, 0x0c);
3846 reg_w(sd, 0x23, 0x1b);
3847 break;
3848 case 15:
3849 reg_w(sd, 0xa4, 0x04);
3850 reg_w(sd, 0x23, 0xff);
3851 sd->clockdiv = 1;
3852 break;
3853 case 10:
3854 reg_w(sd, 0xa4, 0x04);
3855 reg_w(sd, 0x23, 0x1f);
3856 sd->clockdiv = 1;
3857 break;
3858 case 5:
3859 reg_w(sd, 0xa4, 0x04);
3860 reg_w(sd, 0x23, 0x1b);
3861 sd->clockdiv = 1;
3862 break;
3863 }
3864 break;
3865 case SEN_OV8610:
3866 switch (sd->frame_rate) {
3867 default: /* 15 fps */
3868 /* case 15: */
3869 reg_w(sd, 0xa4, 0x06);
3870 reg_w(sd, 0x23, 0xff);
3871 break;
3872 case 10:
3873 reg_w(sd, 0xa4, 0x06);
3874 reg_w(sd, 0x23, 0x1f);
3875 break;
3876 case 5:
3877 reg_w(sd, 0xa4, 0x06);
3878 reg_w(sd, 0x23, 0x1b);
3879 break;
3880 }
3881 break;
3882 case SEN_OV7670: /* guesses, based on 7640 */
3883 gspca_dbg(gspca_dev, D_STREAM, "Setting framerate to %d fps\n",
3884 (sd->frame_rate == 0) ? 15 : sd->frame_rate);
3885 reg_w(sd, 0xa4, 0x10);
3886 switch (sd->frame_rate) {
3887 case 30:
3888 reg_w(sd, 0x23, 0xff);
3889 break;
3890 case 20:
3891 reg_w(sd, 0x23, 0x1b);
3892 break;
3893 default:
3894 /* case 15: */
3895 reg_w(sd, 0x23, 0xff);
3896 sd->clockdiv = 1;
3897 break;
3898 }
3899 break;
3900 }
3901 }
3902
mode_init_ov_sensor_regs(struct sd * sd)3903 static void mode_init_ov_sensor_regs(struct sd *sd)
3904 {
3905 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
3906 int qvga, xstart, xend, ystart, yend;
3907 u8 v;
3908
3909 qvga = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv & 1;
3910
3911 /******** Mode (VGA/QVGA) and sensor specific regs ********/
3912 switch (sd->sensor) {
3913 case SEN_OV2610:
3914 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
3915 i2c_w_mask(sd, 0x28, qvga ? 0x00 : 0x20, 0x20);
3916 i2c_w(sd, 0x24, qvga ? 0x20 : 0x3a);
3917 i2c_w(sd, 0x25, qvga ? 0x30 : 0x60);
3918 i2c_w_mask(sd, 0x2d, qvga ? 0x40 : 0x00, 0x40);
3919 i2c_w_mask(sd, 0x67, qvga ? 0xf0 : 0x90, 0xf0);
3920 i2c_w_mask(sd, 0x74, qvga ? 0x20 : 0x00, 0x20);
3921 return;
3922 case SEN_OV2610AE: {
3923 u8 v;
3924
3925 /* frame rates:
3926 * 10fps / 5 fps for 1600x1200
3927 * 40fps / 20fps for 800x600
3928 */
3929 v = 80;
3930 if (qvga) {
3931 if (sd->frame_rate < 25)
3932 v = 0x81;
3933 } else {
3934 if (sd->frame_rate < 10)
3935 v = 0x81;
3936 }
3937 i2c_w(sd, 0x11, v);
3938 i2c_w(sd, 0x12, qvga ? 0x60 : 0x20);
3939 return;
3940 }
3941 case SEN_OV3610:
3942 if (qvga) {
3943 xstart = (1040 - gspca_dev->pixfmt.width) / 2 +
3944 (0x1f << 4);
3945 ystart = (776 - gspca_dev->pixfmt.height) / 2;
3946 } else {
3947 xstart = (2076 - gspca_dev->pixfmt.width) / 2 +
3948 (0x10 << 4);
3949 ystart = (1544 - gspca_dev->pixfmt.height) / 2;
3950 }
3951 xend = xstart + gspca_dev->pixfmt.width;
3952 yend = ystart + gspca_dev->pixfmt.height;
3953 /* Writing to the COMH register resets the other windowing regs
3954 to their default values, so we must do this first. */
3955 i2c_w_mask(sd, 0x12, qvga ? 0x40 : 0x00, 0xf0);
3956 i2c_w_mask(sd, 0x32,
3957 (((xend >> 1) & 7) << 3) | ((xstart >> 1) & 7),
3958 0x3f);
3959 i2c_w_mask(sd, 0x03,
3960 (((yend >> 1) & 3) << 2) | ((ystart >> 1) & 3),
3961 0x0f);
3962 i2c_w(sd, 0x17, xstart >> 4);
3963 i2c_w(sd, 0x18, xend >> 4);
3964 i2c_w(sd, 0x19, ystart >> 3);
3965 i2c_w(sd, 0x1a, yend >> 3);
3966 return;
3967 case SEN_OV8610:
3968 /* For OV8610 qvga means qsvga */
3969 i2c_w_mask(sd, OV7610_REG_COM_C, qvga ? (1 << 5) : 0, 1 << 5);
3970 i2c_w_mask(sd, 0x13, 0x00, 0x20); /* Select 16 bit data bus */
3971 i2c_w_mask(sd, 0x12, 0x04, 0x06); /* AWB: 1 Test pattern: 0 */
3972 i2c_w_mask(sd, 0x2d, 0x00, 0x40); /* from windrv 090403 */
3973 i2c_w_mask(sd, 0x28, 0x20, 0x20); /* progressive mode on */
3974 break;
3975 case SEN_OV7610:
3976 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
3977 i2c_w(sd, 0x35, qvga ? 0x1e : 0x9e);
3978 i2c_w_mask(sd, 0x13, 0x00, 0x20); /* Select 16 bit data bus */
3979 i2c_w_mask(sd, 0x12, 0x04, 0x06); /* AWB: 1 Test pattern: 0 */
3980 break;
3981 case SEN_OV7620:
3982 case SEN_OV7620AE:
3983 case SEN_OV76BE:
3984 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
3985 i2c_w_mask(sd, 0x28, qvga ? 0x00 : 0x20, 0x20);
3986 i2c_w(sd, 0x24, qvga ? 0x20 : 0x3a);
3987 i2c_w(sd, 0x25, qvga ? 0x30 : 0x60);
3988 i2c_w_mask(sd, 0x2d, qvga ? 0x40 : 0x00, 0x40);
3989 i2c_w_mask(sd, 0x67, qvga ? 0xb0 : 0x90, 0xf0);
3990 i2c_w_mask(sd, 0x74, qvga ? 0x20 : 0x00, 0x20);
3991 i2c_w_mask(sd, 0x13, 0x00, 0x20); /* Select 16 bit data bus */
3992 i2c_w_mask(sd, 0x12, 0x04, 0x06); /* AWB: 1 Test pattern: 0 */
3993 if (sd->sensor == SEN_OV76BE)
3994 i2c_w(sd, 0x35, qvga ? 0x1e : 0x9e);
3995 break;
3996 case SEN_OV7640:
3997 case SEN_OV7648:
3998 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
3999 i2c_w_mask(sd, 0x28, qvga ? 0x00 : 0x20, 0x20);
4000 /* Setting this undocumented bit in qvga mode removes a very
4001 annoying vertical shaking of the image */
4002 i2c_w_mask(sd, 0x2d, qvga ? 0x40 : 0x00, 0x40);
4003 /* Unknown */
4004 i2c_w_mask(sd, 0x67, qvga ? 0xf0 : 0x90, 0xf0);
4005 /* Allow higher automatic gain (to allow higher framerates) */
4006 i2c_w_mask(sd, 0x74, qvga ? 0x20 : 0x00, 0x20);
4007 i2c_w_mask(sd, 0x12, 0x04, 0x04); /* AWB: 1 */
4008 break;
4009 case SEN_OV7670:
4010 /* set COM7_FMT_VGA or COM7_FMT_QVGA
4011 * do we need to set anything else?
4012 * HSTART etc are set in set_ov_sensor_window itself */
4013 i2c_w_mask(sd, OV7670_R12_COM7,
4014 qvga ? OV7670_COM7_FMT_QVGA : OV7670_COM7_FMT_VGA,
4015 OV7670_COM7_FMT_MASK);
4016 i2c_w_mask(sd, 0x13, 0x00, 0x20); /* Select 16 bit data bus */
4017 i2c_w_mask(sd, OV7670_R13_COM8, OV7670_COM8_AWB,
4018 OV7670_COM8_AWB);
4019 if (qvga) { /* QVGA from ov7670.c by
4020 * Jonathan Corbet */
4021 xstart = 164;
4022 xend = 28;
4023 ystart = 14;
4024 yend = 494;
4025 } else { /* VGA */
4026 xstart = 158;
4027 xend = 14;
4028 ystart = 10;
4029 yend = 490;
4030 }
4031 /* OV7670 hardware window registers are split across
4032 * multiple locations */
4033 i2c_w(sd, OV7670_R17_HSTART, xstart >> 3);
4034 i2c_w(sd, OV7670_R18_HSTOP, xend >> 3);
4035 v = i2c_r(sd, OV7670_R32_HREF);
4036 v = (v & 0xc0) | ((xend & 0x7) << 3) | (xstart & 0x07);
4037 msleep(10); /* need to sleep between read and write to
4038 * same reg! */
4039 i2c_w(sd, OV7670_R32_HREF, v);
4040
4041 i2c_w(sd, OV7670_R19_VSTART, ystart >> 2);
4042 i2c_w(sd, OV7670_R1A_VSTOP, yend >> 2);
4043 v = i2c_r(sd, OV7670_R03_VREF);
4044 v = (v & 0xc0) | ((yend & 0x3) << 2) | (ystart & 0x03);
4045 msleep(10); /* need to sleep between read and write to
4046 * same reg! */
4047 i2c_w(sd, OV7670_R03_VREF, v);
4048 break;
4049 case SEN_OV6620:
4050 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
4051 i2c_w_mask(sd, 0x13, 0x00, 0x20); /* Select 16 bit data bus */
4052 i2c_w_mask(sd, 0x12, 0x04, 0x06); /* AWB: 1 Test pattern: 0 */
4053 break;
4054 case SEN_OV6630:
4055 case SEN_OV66308AF:
4056 i2c_w_mask(sd, 0x14, qvga ? 0x20 : 0x00, 0x20);
4057 i2c_w_mask(sd, 0x12, 0x04, 0x06); /* AWB: 1 Test pattern: 0 */
4058 break;
4059 case SEN_OV9600: {
4060 const struct ov_i2c_regvals *vals;
4061 static const struct ov_i2c_regvals sxga_15[] = {
4062 {0x11, 0x80}, {0x14, 0x3e}, {0x24, 0x85}, {0x25, 0x75}
4063 };
4064 static const struct ov_i2c_regvals sxga_7_5[] = {
4065 {0x11, 0x81}, {0x14, 0x3e}, {0x24, 0x85}, {0x25, 0x75}
4066 };
4067 static const struct ov_i2c_regvals vga_30[] = {
4068 {0x11, 0x81}, {0x14, 0x7e}, {0x24, 0x70}, {0x25, 0x60}
4069 };
4070 static const struct ov_i2c_regvals vga_15[] = {
4071 {0x11, 0x83}, {0x14, 0x3e}, {0x24, 0x80}, {0x25, 0x70}
4072 };
4073
4074 /* frame rates:
4075 * 15fps / 7.5 fps for 1280x1024
4076 * 30fps / 15fps for 640x480
4077 */
4078 i2c_w_mask(sd, 0x12, qvga ? 0x40 : 0x00, 0x40);
4079 if (qvga)
4080 vals = sd->frame_rate < 30 ? vga_15 : vga_30;
4081 else
4082 vals = sd->frame_rate < 15 ? sxga_7_5 : sxga_15;
4083 write_i2c_regvals(sd, vals, ARRAY_SIZE(sxga_15));
4084 return;
4085 }
4086 default:
4087 return;
4088 }
4089
4090 /******** Clock programming ********/
4091 i2c_w(sd, 0x11, sd->clockdiv);
4092 }
4093
4094 /* this function works for bridge ov519 and sensors ov7660 and ov7670 only */
sethvflip(struct gspca_dev * gspca_dev,s32 hflip,s32 vflip)4095 static void sethvflip(struct gspca_dev *gspca_dev, s32 hflip, s32 vflip)
4096 {
4097 struct sd *sd = (struct sd *) gspca_dev;
4098
4099 if (sd->gspca_dev.streaming)
4100 reg_w(sd, OV519_R51_RESET1, 0x0f); /* block stream */
4101 i2c_w_mask(sd, OV7670_R1E_MVFP,
4102 OV7670_MVFP_MIRROR * hflip | OV7670_MVFP_VFLIP * vflip,
4103 OV7670_MVFP_MIRROR | OV7670_MVFP_VFLIP);
4104 if (sd->gspca_dev.streaming)
4105 reg_w(sd, OV519_R51_RESET1, 0x00); /* restart stream */
4106 }
4107
set_ov_sensor_window(struct sd * sd)4108 static void set_ov_sensor_window(struct sd *sd)
4109 {
4110 struct gspca_dev *gspca_dev;
4111 int qvga, crop;
4112 int hwsbase, hwebase, vwsbase, vwebase, hwscale, vwscale;
4113
4114 /* mode setup is fully handled in mode_init_ov_sensor_regs for these */
4115 switch (sd->sensor) {
4116 case SEN_OV2610:
4117 case SEN_OV2610AE:
4118 case SEN_OV3610:
4119 case SEN_OV7670:
4120 case SEN_OV9600:
4121 mode_init_ov_sensor_regs(sd);
4122 return;
4123 case SEN_OV7660:
4124 ov519_set_mode(sd);
4125 ov519_set_fr(sd);
4126 return;
4127 }
4128
4129 gspca_dev = &sd->gspca_dev;
4130 qvga = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv & 1;
4131 crop = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv & 2;
4132
4133 /* The different sensor ICs handle setting up of window differently.
4134 * IF YOU SET IT WRONG, YOU WILL GET ALL ZERO ISOC DATA FROM OV51x!! */
4135 switch (sd->sensor) {
4136 case SEN_OV8610:
4137 hwsbase = 0x1e;
4138 hwebase = 0x1e;
4139 vwsbase = 0x02;
4140 vwebase = 0x02;
4141 break;
4142 case SEN_OV7610:
4143 case SEN_OV76BE:
4144 hwsbase = 0x38;
4145 hwebase = 0x3a;
4146 vwsbase = vwebase = 0x05;
4147 break;
4148 case SEN_OV6620:
4149 case SEN_OV6630:
4150 case SEN_OV66308AF:
4151 hwsbase = 0x38;
4152 hwebase = 0x3a;
4153 vwsbase = 0x05;
4154 vwebase = 0x06;
4155 if (sd->sensor == SEN_OV66308AF && qvga)
4156 /* HDG: this fixes U and V getting swapped */
4157 hwsbase++;
4158 if (crop) {
4159 hwsbase += 8;
4160 hwebase += 8;
4161 vwsbase += 11;
4162 vwebase += 11;
4163 }
4164 break;
4165 case SEN_OV7620:
4166 case SEN_OV7620AE:
4167 hwsbase = 0x2f; /* From 7620.SET (spec is wrong) */
4168 hwebase = 0x2f;
4169 vwsbase = vwebase = 0x05;
4170 break;
4171 case SEN_OV7640:
4172 case SEN_OV7648:
4173 hwsbase = 0x1a;
4174 hwebase = 0x1a;
4175 vwsbase = vwebase = 0x03;
4176 break;
4177 default:
4178 return;
4179 }
4180
4181 switch (sd->sensor) {
4182 case SEN_OV6620:
4183 case SEN_OV6630:
4184 case SEN_OV66308AF:
4185 if (qvga) { /* QCIF */
4186 hwscale = 0;
4187 vwscale = 0;
4188 } else { /* CIF */
4189 hwscale = 1;
4190 vwscale = 1; /* The datasheet says 0;
4191 * it's wrong */
4192 }
4193 break;
4194 case SEN_OV8610:
4195 if (qvga) { /* QSVGA */
4196 hwscale = 1;
4197 vwscale = 1;
4198 } else { /* SVGA */
4199 hwscale = 2;
4200 vwscale = 2;
4201 }
4202 break;
4203 default: /* SEN_OV7xx0 */
4204 if (qvga) { /* QVGA */
4205 hwscale = 1;
4206 vwscale = 0;
4207 } else { /* VGA */
4208 hwscale = 2;
4209 vwscale = 1;
4210 }
4211 }
4212
4213 mode_init_ov_sensor_regs(sd);
4214
4215 i2c_w(sd, 0x17, hwsbase);
4216 i2c_w(sd, 0x18, hwebase + (sd->sensor_width >> hwscale));
4217 i2c_w(sd, 0x19, vwsbase);
4218 i2c_w(sd, 0x1a, vwebase + (sd->sensor_height >> vwscale));
4219 }
4220
4221 /* -- start the camera -- */
sd_start(struct gspca_dev * gspca_dev)4222 static int sd_start(struct gspca_dev *gspca_dev)
4223 {
4224 struct sd *sd = (struct sd *) gspca_dev;
4225
4226 /* Default for most bridges, allow bridge_mode_init_regs to override */
4227 sd->sensor_width = sd->gspca_dev.pixfmt.width;
4228 sd->sensor_height = sd->gspca_dev.pixfmt.height;
4229
4230 switch (sd->bridge) {
4231 case BRIDGE_OV511:
4232 case BRIDGE_OV511PLUS:
4233 ov511_mode_init_regs(sd);
4234 break;
4235 case BRIDGE_OV518:
4236 case BRIDGE_OV518PLUS:
4237 ov518_mode_init_regs(sd);
4238 break;
4239 case BRIDGE_OV519:
4240 ov519_mode_init_regs(sd);
4241 break;
4242 /* case BRIDGE_OVFX2: nothing to do */
4243 case BRIDGE_W9968CF:
4244 w9968cf_mode_init_regs(sd);
4245 break;
4246 }
4247
4248 set_ov_sensor_window(sd);
4249
4250 /* Force clear snapshot state in case the snapshot button was
4251 pressed while we weren't streaming */
4252 sd->snapshot_needs_reset = 1;
4253 sd_reset_snapshot(gspca_dev);
4254
4255 sd->first_frame = 3;
4256
4257 ov51x_restart(sd);
4258 ov51x_led_control(sd, 1);
4259 return gspca_dev->usb_err;
4260 }
4261
sd_stopN(struct gspca_dev * gspca_dev)4262 static void sd_stopN(struct gspca_dev *gspca_dev)
4263 {
4264 struct sd *sd = (struct sd *) gspca_dev;
4265
4266 ov51x_stop(sd);
4267 ov51x_led_control(sd, 0);
4268 }
4269
sd_stop0(struct gspca_dev * gspca_dev)4270 static void sd_stop0(struct gspca_dev *gspca_dev)
4271 {
4272 struct sd *sd = (struct sd *) gspca_dev;
4273
4274 if (!sd->gspca_dev.present)
4275 return;
4276 if (sd->bridge == BRIDGE_W9968CF)
4277 w9968cf_stop0(sd);
4278
4279 #if IS_ENABLED(CONFIG_INPUT)
4280 /* If the last button state is pressed, release it now! */
4281 if (sd->snapshot_pressed) {
4282 input_report_key(gspca_dev->input_dev, KEY_CAMERA, 0);
4283 input_sync(gspca_dev->input_dev);
4284 sd->snapshot_pressed = 0;
4285 }
4286 #endif
4287 if (sd->bridge == BRIDGE_OV519)
4288 reg_w(sd, OV519_R57_SNAPSHOT, 0x23);
4289 }
4290
ov51x_handle_button(struct gspca_dev * gspca_dev,u8 state)4291 static void ov51x_handle_button(struct gspca_dev *gspca_dev, u8 state)
4292 {
4293 struct sd *sd = (struct sd *) gspca_dev;
4294
4295 if (sd->snapshot_pressed != state) {
4296 #if IS_ENABLED(CONFIG_INPUT)
4297 input_report_key(gspca_dev->input_dev, KEY_CAMERA, state);
4298 input_sync(gspca_dev->input_dev);
4299 #endif
4300 if (state)
4301 sd->snapshot_needs_reset = 1;
4302
4303 sd->snapshot_pressed = state;
4304 } else {
4305 /* On the ov511 / ov519 we need to reset the button state
4306 multiple times, as resetting does not work as long as the
4307 button stays pressed */
4308 switch (sd->bridge) {
4309 case BRIDGE_OV511:
4310 case BRIDGE_OV511PLUS:
4311 case BRIDGE_OV519:
4312 if (state)
4313 sd->snapshot_needs_reset = 1;
4314 break;
4315 }
4316 }
4317 }
4318
ov511_pkt_scan(struct gspca_dev * gspca_dev,u8 * in,int len)4319 static void ov511_pkt_scan(struct gspca_dev *gspca_dev,
4320 u8 *in, /* isoc packet */
4321 int len) /* iso packet length */
4322 {
4323 struct sd *sd = (struct sd *) gspca_dev;
4324
4325 /* SOF/EOF packets have 1st to 8th bytes zeroed and the 9th
4326 * byte non-zero. The EOF packet has image width/height in the
4327 * 10th and 11th bytes. The 9th byte is given as follows:
4328 *
4329 * bit 7: EOF
4330 * 6: compression enabled
4331 * 5: 422/420/400 modes
4332 * 4: 422/420/400 modes
4333 * 3: 1
4334 * 2: snapshot button on
4335 * 1: snapshot frame
4336 * 0: even/odd field
4337 */
4338 if (!(in[0] | in[1] | in[2] | in[3] | in[4] | in[5] | in[6] | in[7]) &&
4339 (in[8] & 0x08)) {
4340 ov51x_handle_button(gspca_dev, (in[8] >> 2) & 1);
4341 if (in[8] & 0x80) {
4342 /* Frame end */
4343 if ((in[9] + 1) * 8 != gspca_dev->pixfmt.width ||
4344 (in[10] + 1) * 8 != gspca_dev->pixfmt.height) {
4345 gspca_err(gspca_dev, "Invalid frame size, got: %dx%d, requested: %dx%d\n",
4346 (in[9] + 1) * 8, (in[10] + 1) * 8,
4347 gspca_dev->pixfmt.width,
4348 gspca_dev->pixfmt.height);
4349 gspca_dev->last_packet_type = DISCARD_PACKET;
4350 return;
4351 }
4352 /* Add 11 byte footer to frame, might be useful */
4353 gspca_frame_add(gspca_dev, LAST_PACKET, in, 11);
4354 return;
4355 } else {
4356 /* Frame start */
4357 gspca_frame_add(gspca_dev, FIRST_PACKET, in, 0);
4358 sd->packet_nr = 0;
4359 }
4360 }
4361
4362 /* Ignore the packet number */
4363 len--;
4364
4365 /* intermediate packet */
4366 gspca_frame_add(gspca_dev, INTER_PACKET, in, len);
4367 }
4368
ov518_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)4369 static void ov518_pkt_scan(struct gspca_dev *gspca_dev,
4370 u8 *data, /* isoc packet */
4371 int len) /* iso packet length */
4372 {
4373 struct sd *sd = (struct sd *) gspca_dev;
4374
4375 /* A false positive here is likely, until OVT gives me
4376 * the definitive SOF/EOF format */
4377 if ((!(data[0] | data[1] | data[2] | data[3] | data[5])) && data[6]) {
4378 ov51x_handle_button(gspca_dev, (data[6] >> 1) & 1);
4379 gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
4380 gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
4381 sd->packet_nr = 0;
4382 }
4383
4384 if (gspca_dev->last_packet_type == DISCARD_PACKET)
4385 return;
4386
4387 /* Does this device use packet numbers ? */
4388 if (len & 7) {
4389 len--;
4390 if (sd->packet_nr == data[len])
4391 sd->packet_nr++;
4392 /* The last few packets of the frame (which are all 0's
4393 except that they may contain part of the footer), are
4394 numbered 0 */
4395 else if (sd->packet_nr == 0 || data[len]) {
4396 gspca_err(gspca_dev, "Invalid packet nr: %d (expect: %d)\n",
4397 (int)data[len], (int)sd->packet_nr);
4398 gspca_dev->last_packet_type = DISCARD_PACKET;
4399 return;
4400 }
4401 }
4402
4403 /* intermediate packet */
4404 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
4405 }
4406
ov519_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)4407 static void ov519_pkt_scan(struct gspca_dev *gspca_dev,
4408 u8 *data, /* isoc packet */
4409 int len) /* iso packet length */
4410 {
4411 /* Header of ov519 is 16 bytes:
4412 * Byte Value Description
4413 * 0 0xff magic
4414 * 1 0xff magic
4415 * 2 0xff magic
4416 * 3 0xXX 0x50 = SOF, 0x51 = EOF
4417 * 9 0xXX 0x01 initial frame without data,
4418 * 0x00 standard frame with image
4419 * 14 Lo in EOF: length of image data / 8
4420 * 15 Hi
4421 */
4422
4423 if (data[0] == 0xff && data[1] == 0xff && data[2] == 0xff) {
4424 switch (data[3]) {
4425 case 0x50: /* start of frame */
4426 /* Don't check the button state here, as the state
4427 usually (always ?) changes at EOF and checking it
4428 here leads to unnecessary snapshot state resets. */
4429 #define HDRSZ 16
4430 data += HDRSZ;
4431 len -= HDRSZ;
4432 #undef HDRSZ
4433 if (data[0] == 0xff || data[1] == 0xd8)
4434 gspca_frame_add(gspca_dev, FIRST_PACKET,
4435 data, len);
4436 else
4437 gspca_dev->last_packet_type = DISCARD_PACKET;
4438 return;
4439 case 0x51: /* end of frame */
4440 ov51x_handle_button(gspca_dev, data[11] & 1);
4441 if (data[9] != 0)
4442 gspca_dev->last_packet_type = DISCARD_PACKET;
4443 gspca_frame_add(gspca_dev, LAST_PACKET,
4444 NULL, 0);
4445 return;
4446 }
4447 }
4448
4449 /* intermediate packet */
4450 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
4451 }
4452
ovfx2_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)4453 static void ovfx2_pkt_scan(struct gspca_dev *gspca_dev,
4454 u8 *data, /* isoc packet */
4455 int len) /* iso packet length */
4456 {
4457 struct sd *sd = (struct sd *) gspca_dev;
4458
4459 gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
4460
4461 /* A short read signals EOF */
4462 if (len < gspca_dev->cam.bulk_size) {
4463 /* If the frame is short, and it is one of the first ones
4464 the sensor and bridge are still syncing, so drop it. */
4465 if (sd->first_frame) {
4466 sd->first_frame--;
4467 if (gspca_dev->image_len <
4468 sd->gspca_dev.pixfmt.width *
4469 sd->gspca_dev.pixfmt.height)
4470 gspca_dev->last_packet_type = DISCARD_PACKET;
4471 }
4472 gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
4473 gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
4474 }
4475 }
4476
sd_pkt_scan(struct gspca_dev * gspca_dev,u8 * data,int len)4477 static void sd_pkt_scan(struct gspca_dev *gspca_dev,
4478 u8 *data, /* isoc packet */
4479 int len) /* iso packet length */
4480 {
4481 struct sd *sd = (struct sd *) gspca_dev;
4482
4483 switch (sd->bridge) {
4484 case BRIDGE_OV511:
4485 case BRIDGE_OV511PLUS:
4486 ov511_pkt_scan(gspca_dev, data, len);
4487 break;
4488 case BRIDGE_OV518:
4489 case BRIDGE_OV518PLUS:
4490 ov518_pkt_scan(gspca_dev, data, len);
4491 break;
4492 case BRIDGE_OV519:
4493 ov519_pkt_scan(gspca_dev, data, len);
4494 break;
4495 case BRIDGE_OVFX2:
4496 ovfx2_pkt_scan(gspca_dev, data, len);
4497 break;
4498 case BRIDGE_W9968CF:
4499 w9968cf_pkt_scan(gspca_dev, data, len);
4500 break;
4501 }
4502 }
4503
4504 /* -- management routines -- */
4505
setbrightness(struct gspca_dev * gspca_dev,s32 val)4506 static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
4507 {
4508 struct sd *sd = (struct sd *) gspca_dev;
4509 static const struct ov_i2c_regvals brit_7660[][7] = {
4510 {{0x0f, 0x6a}, {0x24, 0x40}, {0x25, 0x2b}, {0x26, 0x90},
4511 {0x27, 0xe0}, {0x28, 0xe0}, {0x2c, 0xe0}},
4512 {{0x0f, 0x6a}, {0x24, 0x50}, {0x25, 0x40}, {0x26, 0xa1},
4513 {0x27, 0xc0}, {0x28, 0xc0}, {0x2c, 0xc0}},
4514 {{0x0f, 0x6a}, {0x24, 0x68}, {0x25, 0x58}, {0x26, 0xc2},
4515 {0x27, 0xa0}, {0x28, 0xa0}, {0x2c, 0xa0}},
4516 {{0x0f, 0x6a}, {0x24, 0x70}, {0x25, 0x68}, {0x26, 0xd3},
4517 {0x27, 0x80}, {0x28, 0x80}, {0x2c, 0x80}},
4518 {{0x0f, 0x6a}, {0x24, 0x80}, {0x25, 0x70}, {0x26, 0xd3},
4519 {0x27, 0x20}, {0x28, 0x20}, {0x2c, 0x20}},
4520 {{0x0f, 0x6a}, {0x24, 0x88}, {0x25, 0x78}, {0x26, 0xd3},
4521 {0x27, 0x40}, {0x28, 0x40}, {0x2c, 0x40}},
4522 {{0x0f, 0x6a}, {0x24, 0x90}, {0x25, 0x80}, {0x26, 0xd4},
4523 {0x27, 0x60}, {0x28, 0x60}, {0x2c, 0x60}}
4524 };
4525
4526 switch (sd->sensor) {
4527 case SEN_OV8610:
4528 case SEN_OV7610:
4529 case SEN_OV76BE:
4530 case SEN_OV6620:
4531 case SEN_OV6630:
4532 case SEN_OV66308AF:
4533 case SEN_OV7640:
4534 case SEN_OV7648:
4535 i2c_w(sd, OV7610_REG_BRT, val);
4536 break;
4537 case SEN_OV7620:
4538 case SEN_OV7620AE:
4539 i2c_w(sd, OV7610_REG_BRT, val);
4540 break;
4541 case SEN_OV7660:
4542 write_i2c_regvals(sd, brit_7660[val],
4543 ARRAY_SIZE(brit_7660[0]));
4544 break;
4545 case SEN_OV7670:
4546 /*win trace
4547 * i2c_w_mask(sd, OV7670_R13_COM8, 0, OV7670_COM8_AEC); */
4548 i2c_w(sd, OV7670_R55_BRIGHT, ov7670_abs_to_sm(val));
4549 break;
4550 }
4551 }
4552
setcontrast(struct gspca_dev * gspca_dev,s32 val)4553 static void setcontrast(struct gspca_dev *gspca_dev, s32 val)
4554 {
4555 struct sd *sd = (struct sd *) gspca_dev;
4556 static const struct ov_i2c_regvals contrast_7660[][31] = {
4557 {{0x6c, 0xf0}, {0x6d, 0xf0}, {0x6e, 0xf8}, {0x6f, 0xa0},
4558 {0x70, 0x58}, {0x71, 0x38}, {0x72, 0x30}, {0x73, 0x30},
4559 {0x74, 0x28}, {0x75, 0x28}, {0x76, 0x24}, {0x77, 0x24},
4560 {0x78, 0x22}, {0x79, 0x28}, {0x7a, 0x2a}, {0x7b, 0x34},
4561 {0x7c, 0x0f}, {0x7d, 0x1e}, {0x7e, 0x3d}, {0x7f, 0x65},
4562 {0x80, 0x70}, {0x81, 0x77}, {0x82, 0x7d}, {0x83, 0x83},
4563 {0x84, 0x88}, {0x85, 0x8d}, {0x86, 0x96}, {0x87, 0x9f},
4564 {0x88, 0xb0}, {0x89, 0xc4}, {0x8a, 0xd9}},
4565 {{0x6c, 0xf0}, {0x6d, 0xf0}, {0x6e, 0xf8}, {0x6f, 0x94},
4566 {0x70, 0x58}, {0x71, 0x40}, {0x72, 0x30}, {0x73, 0x30},
4567 {0x74, 0x30}, {0x75, 0x30}, {0x76, 0x2c}, {0x77, 0x24},
4568 {0x78, 0x22}, {0x79, 0x28}, {0x7a, 0x2a}, {0x7b, 0x31},
4569 {0x7c, 0x0f}, {0x7d, 0x1e}, {0x7e, 0x3d}, {0x7f, 0x62},
4570 {0x80, 0x6d}, {0x81, 0x75}, {0x82, 0x7b}, {0x83, 0x81},
4571 {0x84, 0x87}, {0x85, 0x8d}, {0x86, 0x98}, {0x87, 0xa1},
4572 {0x88, 0xb2}, {0x89, 0xc6}, {0x8a, 0xdb}},
4573 {{0x6c, 0xf0}, {0x6d, 0xf0}, {0x6e, 0xf0}, {0x6f, 0x84},
4574 {0x70, 0x58}, {0x71, 0x48}, {0x72, 0x40}, {0x73, 0x40},
4575 {0x74, 0x28}, {0x75, 0x28}, {0x76, 0x28}, {0x77, 0x24},
4576 {0x78, 0x26}, {0x79, 0x28}, {0x7a, 0x28}, {0x7b, 0x34},
4577 {0x7c, 0x0f}, {0x7d, 0x1e}, {0x7e, 0x3c}, {0x7f, 0x5d},
4578 {0x80, 0x68}, {0x81, 0x71}, {0x82, 0x79}, {0x83, 0x81},
4579 {0x84, 0x86}, {0x85, 0x8b}, {0x86, 0x95}, {0x87, 0x9e},
4580 {0x88, 0xb1}, {0x89, 0xc5}, {0x8a, 0xd9}},
4581 {{0x6c, 0xf0}, {0x6d, 0xf0}, {0x6e, 0xf0}, {0x6f, 0x70},
4582 {0x70, 0x58}, {0x71, 0x58}, {0x72, 0x48}, {0x73, 0x48},
4583 {0x74, 0x38}, {0x75, 0x40}, {0x76, 0x34}, {0x77, 0x34},
4584 {0x78, 0x2e}, {0x79, 0x28}, {0x7a, 0x24}, {0x7b, 0x22},
4585 {0x7c, 0x0f}, {0x7d, 0x1e}, {0x7e, 0x3c}, {0x7f, 0x58},
4586 {0x80, 0x63}, {0x81, 0x6e}, {0x82, 0x77}, {0x83, 0x80},
4587 {0x84, 0x87}, {0x85, 0x8f}, {0x86, 0x9c}, {0x87, 0xa9},
4588 {0x88, 0xc0}, {0x89, 0xd4}, {0x8a, 0xe6}},
4589 {{0x6c, 0xa0}, {0x6d, 0xf0}, {0x6e, 0x90}, {0x6f, 0x80},
4590 {0x70, 0x70}, {0x71, 0x80}, {0x72, 0x60}, {0x73, 0x60},
4591 {0x74, 0x58}, {0x75, 0x60}, {0x76, 0x4c}, {0x77, 0x38},
4592 {0x78, 0x38}, {0x79, 0x2a}, {0x7a, 0x20}, {0x7b, 0x0e},
4593 {0x7c, 0x0a}, {0x7d, 0x14}, {0x7e, 0x26}, {0x7f, 0x46},
4594 {0x80, 0x54}, {0x81, 0x64}, {0x82, 0x70}, {0x83, 0x7c},
4595 {0x84, 0x87}, {0x85, 0x93}, {0x86, 0xa6}, {0x87, 0xb4},
4596 {0x88, 0xd0}, {0x89, 0xe5}, {0x8a, 0xf5}},
4597 {{0x6c, 0x60}, {0x6d, 0x80}, {0x6e, 0x60}, {0x6f, 0x80},
4598 {0x70, 0x80}, {0x71, 0x80}, {0x72, 0x88}, {0x73, 0x30},
4599 {0x74, 0x70}, {0x75, 0x68}, {0x76, 0x64}, {0x77, 0x50},
4600 {0x78, 0x3c}, {0x79, 0x22}, {0x7a, 0x10}, {0x7b, 0x08},
4601 {0x7c, 0x06}, {0x7d, 0x0e}, {0x7e, 0x1a}, {0x7f, 0x3a},
4602 {0x80, 0x4a}, {0x81, 0x5a}, {0x82, 0x6b}, {0x83, 0x7b},
4603 {0x84, 0x89}, {0x85, 0x96}, {0x86, 0xaf}, {0x87, 0xc3},
4604 {0x88, 0xe1}, {0x89, 0xf2}, {0x8a, 0xfa}},
4605 {{0x6c, 0x20}, {0x6d, 0x40}, {0x6e, 0x20}, {0x6f, 0x60},
4606 {0x70, 0x88}, {0x71, 0xc8}, {0x72, 0xc0}, {0x73, 0xb8},
4607 {0x74, 0xa8}, {0x75, 0xb8}, {0x76, 0x80}, {0x77, 0x5c},
4608 {0x78, 0x26}, {0x79, 0x10}, {0x7a, 0x08}, {0x7b, 0x04},
4609 {0x7c, 0x02}, {0x7d, 0x06}, {0x7e, 0x0a}, {0x7f, 0x22},
4610 {0x80, 0x33}, {0x81, 0x4c}, {0x82, 0x64}, {0x83, 0x7b},
4611 {0x84, 0x90}, {0x85, 0xa7}, {0x86, 0xc7}, {0x87, 0xde},
4612 {0x88, 0xf1}, {0x89, 0xf9}, {0x8a, 0xfd}},
4613 };
4614
4615 switch (sd->sensor) {
4616 case SEN_OV7610:
4617 case SEN_OV6620:
4618 i2c_w(sd, OV7610_REG_CNT, val);
4619 break;
4620 case SEN_OV6630:
4621 case SEN_OV66308AF:
4622 i2c_w_mask(sd, OV7610_REG_CNT, val >> 4, 0x0f);
4623 break;
4624 case SEN_OV8610: {
4625 static const u8 ctab[] = {
4626 0x03, 0x09, 0x0b, 0x0f, 0x53, 0x6f, 0x35, 0x7f
4627 };
4628
4629 /* Use Y gamma control instead. Bit 0 enables it. */
4630 i2c_w(sd, 0x64, ctab[val >> 5]);
4631 break;
4632 }
4633 case SEN_OV7620:
4634 case SEN_OV7620AE: {
4635 static const u8 ctab[] = {
4636 0x01, 0x05, 0x09, 0x11, 0x15, 0x35, 0x37, 0x57,
4637 0x5b, 0xa5, 0xa7, 0xc7, 0xc9, 0xcf, 0xef, 0xff
4638 };
4639
4640 /* Use Y gamma control instead. Bit 0 enables it. */
4641 i2c_w(sd, 0x64, ctab[val >> 4]);
4642 break;
4643 }
4644 case SEN_OV7660:
4645 write_i2c_regvals(sd, contrast_7660[val],
4646 ARRAY_SIZE(contrast_7660[0]));
4647 break;
4648 case SEN_OV7670:
4649 /* check that this isn't just the same as ov7610 */
4650 i2c_w(sd, OV7670_R56_CONTRAS, val >> 1);
4651 break;
4652 }
4653 }
4654
setexposure(struct gspca_dev * gspca_dev,s32 val)4655 static void setexposure(struct gspca_dev *gspca_dev, s32 val)
4656 {
4657 struct sd *sd = (struct sd *) gspca_dev;
4658
4659 i2c_w(sd, 0x10, val);
4660 }
4661
setcolors(struct gspca_dev * gspca_dev,s32 val)4662 static void setcolors(struct gspca_dev *gspca_dev, s32 val)
4663 {
4664 struct sd *sd = (struct sd *) gspca_dev;
4665 static const struct ov_i2c_regvals colors_7660[][6] = {
4666 {{0x4f, 0x28}, {0x50, 0x2a}, {0x51, 0x02}, {0x52, 0x0a},
4667 {0x53, 0x19}, {0x54, 0x23}},
4668 {{0x4f, 0x47}, {0x50, 0x4a}, {0x51, 0x03}, {0x52, 0x11},
4669 {0x53, 0x2c}, {0x54, 0x3e}},
4670 {{0x4f, 0x66}, {0x50, 0x6b}, {0x51, 0x05}, {0x52, 0x19},
4671 {0x53, 0x40}, {0x54, 0x59}},
4672 {{0x4f, 0x84}, {0x50, 0x8b}, {0x51, 0x06}, {0x52, 0x20},
4673 {0x53, 0x53}, {0x54, 0x73}},
4674 {{0x4f, 0xa3}, {0x50, 0xab}, {0x51, 0x08}, {0x52, 0x28},
4675 {0x53, 0x66}, {0x54, 0x8e}},
4676 };
4677
4678 switch (sd->sensor) {
4679 case SEN_OV8610:
4680 case SEN_OV7610:
4681 case SEN_OV76BE:
4682 case SEN_OV6620:
4683 case SEN_OV6630:
4684 case SEN_OV66308AF:
4685 i2c_w(sd, OV7610_REG_SAT, val);
4686 break;
4687 case SEN_OV7620:
4688 case SEN_OV7620AE:
4689 /* Use UV gamma control instead. Bits 0 & 7 are reserved. */
4690 /* rc = ov_i2c_write(sd->dev, 0x62, (val >> 9) & 0x7e);
4691 if (rc < 0)
4692 goto out; */
4693 i2c_w(sd, OV7610_REG_SAT, val);
4694 break;
4695 case SEN_OV7640:
4696 case SEN_OV7648:
4697 i2c_w(sd, OV7610_REG_SAT, val & 0xf0);
4698 break;
4699 case SEN_OV7660:
4700 write_i2c_regvals(sd, colors_7660[val],
4701 ARRAY_SIZE(colors_7660[0]));
4702 break;
4703 case SEN_OV7670:
4704 /* supported later once I work out how to do it
4705 * transparently fail now! */
4706 /* set REG_COM13 values for UV sat auto mode */
4707 break;
4708 }
4709 }
4710
setautobright(struct gspca_dev * gspca_dev,s32 val)4711 static void setautobright(struct gspca_dev *gspca_dev, s32 val)
4712 {
4713 struct sd *sd = (struct sd *) gspca_dev;
4714
4715 i2c_w_mask(sd, 0x2d, val ? 0x10 : 0x00, 0x10);
4716 }
4717
setfreq_i(struct sd * sd,s32 val)4718 static void setfreq_i(struct sd *sd, s32 val)
4719 {
4720 if (sd->sensor == SEN_OV7660
4721 || sd->sensor == SEN_OV7670) {
4722 switch (val) {
4723 case 0: /* Banding filter disabled */
4724 i2c_w_mask(sd, OV7670_R13_COM8, 0, OV7670_COM8_BFILT);
4725 break;
4726 case 1: /* 50 hz */
4727 i2c_w_mask(sd, OV7670_R13_COM8, OV7670_COM8_BFILT,
4728 OV7670_COM8_BFILT);
4729 i2c_w_mask(sd, OV7670_R3B_COM11, 0x08, 0x18);
4730 break;
4731 case 2: /* 60 hz */
4732 i2c_w_mask(sd, OV7670_R13_COM8, OV7670_COM8_BFILT,
4733 OV7670_COM8_BFILT);
4734 i2c_w_mask(sd, OV7670_R3B_COM11, 0x00, 0x18);
4735 break;
4736 case 3: /* Auto hz - ov7670 only */
4737 i2c_w_mask(sd, OV7670_R13_COM8, OV7670_COM8_BFILT,
4738 OV7670_COM8_BFILT);
4739 i2c_w_mask(sd, OV7670_R3B_COM11, OV7670_COM11_HZAUTO,
4740 0x18);
4741 break;
4742 }
4743 } else {
4744 switch (val) {
4745 case 0: /* Banding filter disabled */
4746 i2c_w_mask(sd, 0x2d, 0x00, 0x04);
4747 i2c_w_mask(sd, 0x2a, 0x00, 0x80);
4748 break;
4749 case 1: /* 50 hz (filter on and framerate adj) */
4750 i2c_w_mask(sd, 0x2d, 0x04, 0x04);
4751 i2c_w_mask(sd, 0x2a, 0x80, 0x80);
4752 /* 20 fps -> 16.667 fps */
4753 if (sd->sensor == SEN_OV6620 ||
4754 sd->sensor == SEN_OV6630 ||
4755 sd->sensor == SEN_OV66308AF)
4756 i2c_w(sd, 0x2b, 0x5e);
4757 else
4758 i2c_w(sd, 0x2b, 0xac);
4759 break;
4760 case 2: /* 60 hz (filter on, ...) */
4761 i2c_w_mask(sd, 0x2d, 0x04, 0x04);
4762 if (sd->sensor == SEN_OV6620 ||
4763 sd->sensor == SEN_OV6630 ||
4764 sd->sensor == SEN_OV66308AF) {
4765 /* 20 fps -> 15 fps */
4766 i2c_w_mask(sd, 0x2a, 0x80, 0x80);
4767 i2c_w(sd, 0x2b, 0xa8);
4768 } else {
4769 /* no framerate adj. */
4770 i2c_w_mask(sd, 0x2a, 0x00, 0x80);
4771 }
4772 break;
4773 }
4774 }
4775 }
4776
setfreq(struct gspca_dev * gspca_dev,s32 val)4777 static void setfreq(struct gspca_dev *gspca_dev, s32 val)
4778 {
4779 struct sd *sd = (struct sd *) gspca_dev;
4780
4781 setfreq_i(sd, val);
4782
4783 /* Ugly but necessary */
4784 if (sd->bridge == BRIDGE_W9968CF)
4785 w9968cf_set_crop_window(sd);
4786 }
4787
sd_get_jcomp(struct gspca_dev * gspca_dev,struct v4l2_jpegcompression * jcomp)4788 static int sd_get_jcomp(struct gspca_dev *gspca_dev,
4789 struct v4l2_jpegcompression *jcomp)
4790 {
4791 struct sd *sd = (struct sd *) gspca_dev;
4792
4793 if (sd->bridge != BRIDGE_W9968CF)
4794 return -ENOTTY;
4795
4796 memset(jcomp, 0, sizeof *jcomp);
4797 jcomp->quality = v4l2_ctrl_g_ctrl(sd->jpegqual);
4798 jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT | V4L2_JPEG_MARKER_DQT |
4799 V4L2_JPEG_MARKER_DRI;
4800 return 0;
4801 }
4802
sd_set_jcomp(struct gspca_dev * gspca_dev,const struct v4l2_jpegcompression * jcomp)4803 static int sd_set_jcomp(struct gspca_dev *gspca_dev,
4804 const struct v4l2_jpegcompression *jcomp)
4805 {
4806 struct sd *sd = (struct sd *) gspca_dev;
4807
4808 if (sd->bridge != BRIDGE_W9968CF)
4809 return -ENOTTY;
4810
4811 v4l2_ctrl_s_ctrl(sd->jpegqual, jcomp->quality);
4812 return 0;
4813 }
4814
sd_g_volatile_ctrl(struct v4l2_ctrl * ctrl)4815 static int sd_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
4816 {
4817 struct gspca_dev *gspca_dev =
4818 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
4819 struct sd *sd = (struct sd *)gspca_dev;
4820
4821 gspca_dev->usb_err = 0;
4822
4823 switch (ctrl->id) {
4824 case V4L2_CID_AUTOGAIN:
4825 gspca_dev->exposure->val = i2c_r(sd, 0x10);
4826 break;
4827 }
4828 return 0;
4829 }
4830
sd_s_ctrl(struct v4l2_ctrl * ctrl)4831 static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
4832 {
4833 struct gspca_dev *gspca_dev =
4834 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
4835 struct sd *sd = (struct sd *)gspca_dev;
4836
4837 gspca_dev->usb_err = 0;
4838
4839 if (!gspca_dev->streaming)
4840 return 0;
4841
4842 switch (ctrl->id) {
4843 case V4L2_CID_BRIGHTNESS:
4844 setbrightness(gspca_dev, ctrl->val);
4845 break;
4846 case V4L2_CID_CONTRAST:
4847 setcontrast(gspca_dev, ctrl->val);
4848 break;
4849 case V4L2_CID_POWER_LINE_FREQUENCY:
4850 setfreq(gspca_dev, ctrl->val);
4851 break;
4852 case V4L2_CID_AUTOBRIGHTNESS:
4853 if (ctrl->is_new)
4854 setautobright(gspca_dev, ctrl->val);
4855 if (!ctrl->val && sd->brightness->is_new)
4856 setbrightness(gspca_dev, sd->brightness->val);
4857 break;
4858 case V4L2_CID_SATURATION:
4859 setcolors(gspca_dev, ctrl->val);
4860 break;
4861 case V4L2_CID_HFLIP:
4862 sethvflip(gspca_dev, ctrl->val, sd->vflip->val);
4863 break;
4864 case V4L2_CID_AUTOGAIN:
4865 if (ctrl->is_new)
4866 setautogain(gspca_dev, ctrl->val);
4867 if (!ctrl->val && gspca_dev->exposure->is_new)
4868 setexposure(gspca_dev, gspca_dev->exposure->val);
4869 break;
4870 case V4L2_CID_JPEG_COMPRESSION_QUALITY:
4871 return -EBUSY; /* Should never happen, as we grab the ctrl */
4872 }
4873 return gspca_dev->usb_err;
4874 }
4875
4876 static const struct v4l2_ctrl_ops sd_ctrl_ops = {
4877 .g_volatile_ctrl = sd_g_volatile_ctrl,
4878 .s_ctrl = sd_s_ctrl,
4879 };
4880
sd_init_controls(struct gspca_dev * gspca_dev)4881 static int sd_init_controls(struct gspca_dev *gspca_dev)
4882 {
4883 struct sd *sd = (struct sd *)gspca_dev;
4884 struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
4885
4886 gspca_dev->vdev.ctrl_handler = hdl;
4887 v4l2_ctrl_handler_init(hdl, 10);
4888 if (valid_controls[sd->sensor].has_brightness)
4889 sd->brightness = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4890 V4L2_CID_BRIGHTNESS, 0,
4891 sd->sensor == SEN_OV7660 ? 6 : 255, 1,
4892 sd->sensor == SEN_OV7660 ? 3 : 127);
4893 if (valid_controls[sd->sensor].has_contrast) {
4894 if (sd->sensor == SEN_OV7660)
4895 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4896 V4L2_CID_CONTRAST, 0, 6, 1, 3);
4897 else
4898 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4899 V4L2_CID_CONTRAST, 0, 255, 1,
4900 (sd->sensor == SEN_OV6630 ||
4901 sd->sensor == SEN_OV66308AF) ? 200 : 127);
4902 }
4903 if (valid_controls[sd->sensor].has_sat)
4904 v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4905 V4L2_CID_SATURATION, 0,
4906 sd->sensor == SEN_OV7660 ? 4 : 255, 1,
4907 sd->sensor == SEN_OV7660 ? 2 : 127);
4908 if (valid_controls[sd->sensor].has_exposure)
4909 gspca_dev->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4910 V4L2_CID_EXPOSURE, 0, 255, 1, 127);
4911 if (valid_controls[sd->sensor].has_hvflip) {
4912 sd->hflip = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4913 V4L2_CID_HFLIP, 0, 1, 1, 0);
4914 sd->vflip = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4915 V4L2_CID_VFLIP, 0, 1, 1, 0);
4916 }
4917 if (valid_controls[sd->sensor].has_autobright)
4918 sd->autobright = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4919 V4L2_CID_AUTOBRIGHTNESS, 0, 1, 1, 1);
4920 if (valid_controls[sd->sensor].has_autogain)
4921 gspca_dev->autogain = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4922 V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
4923 if (valid_controls[sd->sensor].has_freq) {
4924 if (sd->sensor == SEN_OV7670)
4925 sd->freq = v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
4926 V4L2_CID_POWER_LINE_FREQUENCY,
4927 V4L2_CID_POWER_LINE_FREQUENCY_AUTO, 0,
4928 V4L2_CID_POWER_LINE_FREQUENCY_AUTO);
4929 else
4930 sd->freq = v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
4931 V4L2_CID_POWER_LINE_FREQUENCY,
4932 V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 0, 0);
4933 }
4934 if (sd->bridge == BRIDGE_W9968CF)
4935 sd->jpegqual = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
4936 V4L2_CID_JPEG_COMPRESSION_QUALITY,
4937 QUALITY_MIN, QUALITY_MAX, 1, QUALITY_DEF);
4938
4939 if (hdl->error) {
4940 gspca_err(gspca_dev, "Could not initialize controls\n");
4941 return hdl->error;
4942 }
4943 if (gspca_dev->autogain)
4944 v4l2_ctrl_auto_cluster(3, &gspca_dev->autogain, 0, true);
4945 if (sd->autobright)
4946 v4l2_ctrl_auto_cluster(2, &sd->autobright, 0, false);
4947 if (sd->hflip)
4948 v4l2_ctrl_cluster(2, &sd->hflip);
4949 return 0;
4950 }
4951
4952 /* sub-driver description */
4953 static const struct sd_desc sd_desc = {
4954 .name = MODULE_NAME,
4955 .config = sd_config,
4956 .init = sd_init,
4957 .init_controls = sd_init_controls,
4958 .isoc_init = sd_isoc_init,
4959 .start = sd_start,
4960 .stopN = sd_stopN,
4961 .stop0 = sd_stop0,
4962 .pkt_scan = sd_pkt_scan,
4963 .dq_callback = sd_reset_snapshot,
4964 .get_jcomp = sd_get_jcomp,
4965 .set_jcomp = sd_set_jcomp,
4966 #if IS_ENABLED(CONFIG_INPUT)
4967 .other_input = 1,
4968 #endif
4969 };
4970
4971 /* -- module initialisation -- */
4972 static const struct usb_device_id device_table[] = {
4973 {USB_DEVICE(0x041e, 0x4003), .driver_info = BRIDGE_W9968CF },
4974 {USB_DEVICE(0x041e, 0x4052),
4975 .driver_info = BRIDGE_OV519 | BRIDGE_INVERT_LED },
4976 {USB_DEVICE(0x041e, 0x405f), .driver_info = BRIDGE_OV519 },
4977 {USB_DEVICE(0x041e, 0x4060), .driver_info = BRIDGE_OV519 },
4978 {USB_DEVICE(0x041e, 0x4061), .driver_info = BRIDGE_OV519 },
4979 {USB_DEVICE(0x041e, 0x4064), .driver_info = BRIDGE_OV519 },
4980 {USB_DEVICE(0x041e, 0x4067), .driver_info = BRIDGE_OV519 },
4981 {USB_DEVICE(0x041e, 0x4068), .driver_info = BRIDGE_OV519 },
4982 {USB_DEVICE(0x045e, 0x028c),
4983 .driver_info = BRIDGE_OV519 | BRIDGE_INVERT_LED },
4984 {USB_DEVICE(0x054c, 0x0154), .driver_info = BRIDGE_OV519 },
4985 {USB_DEVICE(0x054c, 0x0155), .driver_info = BRIDGE_OV519 },
4986 {USB_DEVICE(0x05a9, 0x0511), .driver_info = BRIDGE_OV511 },
4987 {USB_DEVICE(0x05a9, 0x0518), .driver_info = BRIDGE_OV518 },
4988 {USB_DEVICE(0x05a9, 0x0519),
4989 .driver_info = BRIDGE_OV519 | BRIDGE_INVERT_LED },
4990 {USB_DEVICE(0x05a9, 0x0530),
4991 .driver_info = BRIDGE_OV519 | BRIDGE_INVERT_LED },
4992 {USB_DEVICE(0x05a9, 0x2800), .driver_info = BRIDGE_OVFX2 },
4993 {USB_DEVICE(0x05a9, 0x4519), .driver_info = BRIDGE_OV519 },
4994 {USB_DEVICE(0x05a9, 0x8519), .driver_info = BRIDGE_OV519 },
4995 {USB_DEVICE(0x05a9, 0xa511), .driver_info = BRIDGE_OV511PLUS },
4996 {USB_DEVICE(0x05a9, 0xa518), .driver_info = BRIDGE_OV518PLUS },
4997 {USB_DEVICE(0x0813, 0x0002), .driver_info = BRIDGE_OV511PLUS },
4998 {USB_DEVICE(0x0b62, 0x0059), .driver_info = BRIDGE_OVFX2 },
4999 {USB_DEVICE(0x0e96, 0xc001), .driver_info = BRIDGE_OVFX2 },
5000 {USB_DEVICE(0x1046, 0x9967), .driver_info = BRIDGE_W9968CF },
5001 {USB_DEVICE(0x8020, 0xef04), .driver_info = BRIDGE_OVFX2 },
5002 {}
5003 };
5004
5005 MODULE_DEVICE_TABLE(usb, device_table);
5006
5007 /* -- device connect -- */
sd_probe(struct usb_interface * intf,const struct usb_device_id * id)5008 static int sd_probe(struct usb_interface *intf,
5009 const struct usb_device_id *id)
5010 {
5011 return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
5012 THIS_MODULE);
5013 }
5014
5015 static struct usb_driver sd_driver = {
5016 .name = MODULE_NAME,
5017 .id_table = device_table,
5018 .probe = sd_probe,
5019 .disconnect = gspca_disconnect,
5020 #ifdef CONFIG_PM
5021 .suspend = gspca_suspend,
5022 .resume = gspca_resume,
5023 .reset_resume = gspca_resume,
5024 #endif
5025 };
5026
5027 module_usb_driver(sd_driver);
5028
5029 module_param(frame_rate, int, 0644);
5030 MODULE_PARM_DESC(frame_rate, "Frame rate (5, 10, 15, 20 or 30 fps)");
5031