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