[PATCH] USB: convert a bunch of USB semaphores to mutexes
[linux-3.10.git] / drivers / usb / media / ov511.c
1 /*
2  * OmniVision OV511 Camera-to-USB Bridge Driver
3  *
4  * Copyright (c) 1999-2003 Mark W. McClelland
5  * Original decompression code Copyright 1998-2000 OmniVision Technologies
6  * Many improvements by Bret Wallach <bwallac1@san.rr.com>
7  * Color fixes by by Orion Sky Lawlor <olawlor@acm.org> (2/26/2000)
8  * Snapshot code by Kevin Moore
9  * OV7620 fixes by Charl P. Botha <cpbotha@ieee.org>
10  * Changes by Claudio Matsuoka <claudio@conectiva.com>
11  * Original SAA7111A code by Dave Perks <dperks@ibm.net>
12  * URB error messages from pwc driver by Nemosoft
13  * generic_ioctl() code from videodev.c by Gerd Knorr and Alan Cox
14  * Memory management (rvmalloc) code from bttv driver, by Gerd Knorr and others
15  *
16  * Based on the Linux CPiA driver written by Peter Pregler,
17  * Scott J. Bertin and Johannes Erdfelt.
18  * 
19  * Please see the file: Documentation/usb/ov511.txt
20  * and the website at:  http://alpha.dyndns.org/ov511
21  * for more info.
22  *
23  * This program is free software; you can redistribute it and/or modify it
24  * under the terms of the GNU General Public License as published by the
25  * Free Software Foundation; either version 2 of the License, or (at your
26  * option) any later version.
27  *
28  * This program is distributed in the hope that it will be useful, but
29  * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
30  * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
31  * for more details.
32  *
33  * You should have received a copy of the GNU General Public License
34  * along with this program; if not, write to the Free Software Foundation,
35  * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
36  */
37
38 #include <linux/config.h>
39 #include <linux/module.h>
40 #include <linux/init.h>
41 #include <linux/vmalloc.h>
42 #include <linux/slab.h>
43 #include <linux/ctype.h>
44 #include <linux/pagemap.h>
45 #include <asm/semaphore.h>
46 #include <asm/processor.h>
47 #include <linux/mm.h>
48 #include <linux/device.h>
49
50 #if defined (__i386__)
51         #include <asm/cpufeature.h>
52 #endif
53
54 #include "ov511.h"
55
56 /*
57  * Version Information
58  */
59 #define DRIVER_VERSION "v1.64 for Linux 2.5"
60 #define EMAIL "mark@alpha.dyndns.org"
61 #define DRIVER_AUTHOR "Mark McClelland <mark@alpha.dyndns.org> & Bret Wallach \
62         & Orion Sky Lawlor <olawlor@acm.org> & Kevin Moore & Charl P. Botha \
63         <cpbotha@ieee.org> & Claudio Matsuoka <claudio@conectiva.com>"
64 #define DRIVER_DESC "ov511 USB Camera Driver"
65
66 #define OV511_I2C_RETRIES 3
67 #define ENABLE_Y_QUANTABLE 1
68 #define ENABLE_UV_QUANTABLE 1
69
70 #define OV511_MAX_UNIT_VIDEO 16
71
72 /* Pixel count * bytes per YUV420 pixel (1.5) */
73 #define MAX_FRAME_SIZE(w, h) ((w) * (h) * 3 / 2)
74
75 #define MAX_DATA_SIZE(w, h) (MAX_FRAME_SIZE(w, h) + sizeof(struct timeval))
76
77 /* Max size * bytes per YUV420 pixel (1.5) + one extra isoc frame for safety */
78 #define MAX_RAW_DATA_SIZE(w, h) ((w) * (h) * 3 / 2 + 1024)
79
80 #define FATAL_ERROR(rc) ((rc) < 0 && (rc) != -EPERM)
81
82 /**********************************************************************
83  * Module Parameters
84  * (See ov511.txt for detailed descriptions of these)
85  **********************************************************************/
86
87 /* These variables (and all static globals) default to zero */
88 static int autobright           = 1;
89 static int autogain             = 1;
90 static int autoexp              = 1;
91 static int debug;
92 static int snapshot;
93 static int cams                 = 1;
94 static int compress;
95 static int testpat;
96 static int dumppix;
97 static int led                  = 1;
98 static int dump_bridge;
99 static int dump_sensor;
100 static int printph;
101 static int phy                  = 0x1f;
102 static int phuv                 = 0x05;
103 static int pvy                  = 0x06;
104 static int pvuv                 = 0x06;
105 static int qhy                  = 0x14;
106 static int qhuv                 = 0x03;
107 static int qvy                  = 0x04;
108 static int qvuv                 = 0x04;
109 static int lightfreq;
110 static int bandingfilter;
111 static int clockdiv             = -1;
112 static int packetsize           = -1;
113 static int framedrop            = -1;
114 static int fastset;
115 static int force_palette;
116 static int backlight;
117 static int unit_video[OV511_MAX_UNIT_VIDEO];
118 static int remove_zeros;
119 static int mirror;
120 static int ov518_color;
121
122 module_param(autobright, int, 0);
123 MODULE_PARM_DESC(autobright, "Sensor automatically changes brightness");
124 module_param(autogain, int, 0);
125 MODULE_PARM_DESC(autogain, "Sensor automatically changes gain");
126 module_param(autoexp, int, 0);
127 MODULE_PARM_DESC(autoexp, "Sensor automatically changes exposure");
128 module_param(debug, int, 0);
129 MODULE_PARM_DESC(debug,
130   "Debug level: 0=none, 1=inits, 2=warning, 3=config, 4=functions, 5=max");
131 module_param(snapshot, int, 0);
132 MODULE_PARM_DESC(snapshot, "Enable snapshot mode");
133 module_param(cams, int, 0);
134 MODULE_PARM_DESC(cams, "Number of simultaneous cameras");
135 module_param(compress, int, 0);
136 MODULE_PARM_DESC(compress, "Turn on compression");
137 module_param(testpat, int, 0);
138 MODULE_PARM_DESC(testpat,
139   "Replace image with vertical bar testpattern (only partially working)");
140 module_param(dumppix, int, 0);
141 MODULE_PARM_DESC(dumppix, "Dump raw pixel data");
142 module_param(led, int, 0);
143 MODULE_PARM_DESC(led,
144   "LED policy (OV511+ or later). 0=off, 1=on (default), 2=auto (on when open)");
145 module_param(dump_bridge, int, 0);
146 MODULE_PARM_DESC(dump_bridge, "Dump the bridge registers");
147 module_param(dump_sensor, int, 0);
148 MODULE_PARM_DESC(dump_sensor, "Dump the sensor registers");
149 module_param(printph, int, 0);
150 MODULE_PARM_DESC(printph, "Print frame start/end headers");
151 module_param(phy, int, 0);
152 MODULE_PARM_DESC(phy, "Prediction range (horiz. Y)");
153 module_param(phuv, int, 0);
154 MODULE_PARM_DESC(phuv, "Prediction range (horiz. UV)");
155 module_param(pvy, int, 0);
156 MODULE_PARM_DESC(pvy, "Prediction range (vert. Y)");
157 module_param(pvuv, int, 0);
158 MODULE_PARM_DESC(pvuv, "Prediction range (vert. UV)");
159 module_param(qhy, int, 0);
160 MODULE_PARM_DESC(qhy, "Quantization threshold (horiz. Y)");
161 module_param(qhuv, int, 0);
162 MODULE_PARM_DESC(qhuv, "Quantization threshold (horiz. UV)");
163 module_param(qvy, int, 0);
164 MODULE_PARM_DESC(qvy, "Quantization threshold (vert. Y)");
165 module_param(qvuv, int, 0);
166 MODULE_PARM_DESC(qvuv, "Quantization threshold (vert. UV)");
167 module_param(lightfreq, int, 0);
168 MODULE_PARM_DESC(lightfreq,
169   "Light frequency. Set to 50 or 60 Hz, or zero for default settings");
170 module_param(bandingfilter, int, 0);
171 MODULE_PARM_DESC(bandingfilter,
172   "Enable banding filter (to reduce effects of fluorescent lighting)");
173 module_param(clockdiv, int, 0);
174 MODULE_PARM_DESC(clockdiv, "Force pixel clock divisor to a specific value");
175 module_param(packetsize, int, 0);
176 MODULE_PARM_DESC(packetsize, "Force a specific isoc packet size");
177 module_param(framedrop, int, 0);
178 MODULE_PARM_DESC(framedrop, "Force a specific frame drop register setting");
179 module_param(fastset, int, 0);
180 MODULE_PARM_DESC(fastset, "Allows picture settings to take effect immediately");
181 module_param(force_palette, int, 0);
182 MODULE_PARM_DESC(force_palette, "Force the palette to a specific value");
183 module_param(backlight, int, 0);
184 MODULE_PARM_DESC(backlight, "For objects that are lit from behind");
185 static int num_uv;
186 module_param_array(unit_video, int, &num_uv, 0);
187 MODULE_PARM_DESC(unit_video,
188   "Force use of specific minor number(s). 0 is not allowed.");
189 module_param(remove_zeros, int, 0);
190 MODULE_PARM_DESC(remove_zeros,
191   "Remove zero-padding from uncompressed incoming data");
192 module_param(mirror, int, 0);
193 MODULE_PARM_DESC(mirror, "Reverse image horizontally");
194 module_param(ov518_color, int, 0);
195 MODULE_PARM_DESC(ov518_color, "Enable OV518 color (experimental)");
196
197 MODULE_AUTHOR(DRIVER_AUTHOR);
198 MODULE_DESCRIPTION(DRIVER_DESC);
199 MODULE_LICENSE("GPL");
200
201 /**********************************************************************
202  * Miscellaneous Globals
203  **********************************************************************/
204
205 static struct usb_driver ov511_driver;
206
207 /* Number of times to retry a failed I2C transaction. Increase this if you
208  * are getting "Failed to read sensor ID..." */
209 static const int i2c_detect_tries = 5;
210
211 static struct usb_device_id device_table [] = {
212         { USB_DEVICE(VEND_OMNIVISION, PROD_OV511) },
213         { USB_DEVICE(VEND_OMNIVISION, PROD_OV511PLUS) },
214         { USB_DEVICE(VEND_OMNIVISION, PROD_OV518) },
215         { USB_DEVICE(VEND_OMNIVISION, PROD_OV518PLUS) },
216         { USB_DEVICE(VEND_MATTEL, PROD_ME2CAM) },
217         { }  /* Terminating entry */
218 };
219
220 MODULE_DEVICE_TABLE (usb, device_table);
221
222 static unsigned char yQuanTable511[] = OV511_YQUANTABLE;
223 static unsigned char uvQuanTable511[] = OV511_UVQUANTABLE;
224 static unsigned char yQuanTable518[] = OV518_YQUANTABLE;
225 static unsigned char uvQuanTable518[] = OV518_UVQUANTABLE;
226
227 /**********************************************************************
228  * Symbolic Names
229  **********************************************************************/
230
231 /* Known OV511-based cameras */
232 static struct symbolic_list camlist[] = {
233         {   0, "Generic Camera (no ID)" },
234         {   1, "Mustek WCam 3X" },
235         {   3, "D-Link DSB-C300" },
236         {   4, "Generic OV511/OV7610" },
237         {   5, "Puretek PT-6007" },
238         {   6, "Lifeview USB Life TV (NTSC)" },
239         {  21, "Creative Labs WebCam 3" },
240         {  22, "Lifeview USB Life TV (PAL D/K+B/G)" },
241         {  36, "Koala-Cam" },
242         {  38, "Lifeview USB Life TV (PAL)" },
243         {  41, "Samsung Anycam MPC-M10" },
244         {  43, "Mtekvision Zeca MV402" },
245         {  46, "Suma eON" },
246         {  70, "Lifeview USB Life TV (PAL/SECAM)" },
247         { 100, "Lifeview RoboCam" },
248         { 102, "AverMedia InterCam Elite" },
249         { 112, "MediaForte MV300" },    /* or OV7110 evaluation kit */
250         { 134, "Ezonics EZCam II" },
251         { 192, "Webeye 2000B" },
252         { 253, "Alpha Vision Tech. AlphaCam SE" },
253         {  -1, NULL }
254 };
255
256 /* Video4Linux1 Palettes */
257 static struct symbolic_list v4l1_plist[] = {
258         { VIDEO_PALETTE_GREY,   "GREY" },
259         { VIDEO_PALETTE_HI240,  "HI240" },
260         { VIDEO_PALETTE_RGB565, "RGB565" },
261         { VIDEO_PALETTE_RGB24,  "RGB24" },
262         { VIDEO_PALETTE_RGB32,  "RGB32" },
263         { VIDEO_PALETTE_RGB555, "RGB555" },
264         { VIDEO_PALETTE_YUV422, "YUV422" },
265         { VIDEO_PALETTE_YUYV,   "YUYV" },
266         { VIDEO_PALETTE_UYVY,   "UYVY" },
267         { VIDEO_PALETTE_YUV420, "YUV420" },
268         { VIDEO_PALETTE_YUV411, "YUV411" },
269         { VIDEO_PALETTE_RAW,    "RAW" },
270         { VIDEO_PALETTE_YUV422P,"YUV422P" },
271         { VIDEO_PALETTE_YUV411P,"YUV411P" },
272         { VIDEO_PALETTE_YUV420P,"YUV420P" },
273         { VIDEO_PALETTE_YUV410P,"YUV410P" },
274         { -1, NULL }
275 };
276
277 static struct symbolic_list brglist[] = {
278         { BRG_OV511,            "OV511" },
279         { BRG_OV511PLUS,        "OV511+" },
280         { BRG_OV518,            "OV518" },
281         { BRG_OV518PLUS,        "OV518+" },
282         { -1, NULL }
283 };
284
285 static struct symbolic_list senlist[] = {
286         { SEN_OV76BE,   "OV76BE" },
287         { SEN_OV7610,   "OV7610" },
288         { SEN_OV7620,   "OV7620" },
289         { SEN_OV7620AE, "OV7620AE" },
290         { SEN_OV6620,   "OV6620" },
291         { SEN_OV6630,   "OV6630" },
292         { SEN_OV6630AE, "OV6630AE" },
293         { SEN_OV6630AF, "OV6630AF" },
294         { SEN_OV8600,   "OV8600" },
295         { SEN_KS0127,   "KS0127" },
296         { SEN_KS0127B,  "KS0127B" },
297         { SEN_SAA7111A, "SAA7111A" },
298         { -1, NULL }
299 };
300
301 /* URB error codes: */
302 static struct symbolic_list urb_errlist[] = {
303         { -ENOSR,       "Buffer error (overrun)" },
304         { -EPIPE,       "Stalled (device not responding)" },
305         { -EOVERFLOW,   "Babble (bad cable?)" },
306         { -EPROTO,      "Bit-stuff error (bad cable?)" },
307         { -EILSEQ,      "CRC/Timeout" },
308         { -ETIMEDOUT,   "NAK (device does not respond)" },
309         { -1, NULL }
310 };
311
312 /**********************************************************************
313  * Memory management
314  **********************************************************************/
315 static void *
316 rvmalloc(unsigned long size)
317 {
318         void *mem;
319         unsigned long adr;
320
321         size = PAGE_ALIGN(size);
322         mem = vmalloc_32(size);
323         if (!mem)
324                 return NULL;
325
326         memset(mem, 0, size); /* Clear the ram out, no junk to the user */
327         adr = (unsigned long) mem;
328         while (size > 0) {
329                 SetPageReserved(vmalloc_to_page((void *)adr));
330                 adr += PAGE_SIZE;
331                 size -= PAGE_SIZE;
332         }
333
334         return mem;
335 }
336
337 static void
338 rvfree(void *mem, unsigned long size)
339 {
340         unsigned long adr;
341
342         if (!mem)
343                 return;
344
345         adr = (unsigned long) mem;
346         while ((long) size > 0) {
347                 ClearPageReserved(vmalloc_to_page((void *)adr));
348                 adr += PAGE_SIZE;
349                 size -= PAGE_SIZE;
350         }
351         vfree(mem);
352 }
353
354 /**********************************************************************
355  *
356  * Register I/O
357  *
358  **********************************************************************/
359
360 /* Write an OV51x register */
361 static int
362 reg_w(struct usb_ov511 *ov, unsigned char reg, unsigned char value)
363 {
364         int rc;
365
366         PDEBUG(5, "0x%02X:0x%02X", reg, value);
367
368         mutex_lock(&ov->cbuf_lock);
369         ov->cbuf[0] = value;
370         rc = usb_control_msg(ov->dev,
371                              usb_sndctrlpipe(ov->dev, 0),
372                              (ov->bclass == BCL_OV518)?1:2 /* REG_IO */,
373                              USB_TYPE_VENDOR | USB_RECIP_DEVICE,
374                              0, (__u16)reg, &ov->cbuf[0], 1, 1000);
375         mutex_unlock(&ov->cbuf_lock);
376
377         if (rc < 0)
378                 err("reg write: error %d: %s", rc, symbolic(urb_errlist, rc));
379
380         return rc;
381 }
382
383 /* Read from an OV51x register */
384 /* returns: negative is error, pos or zero is data */
385 static int
386 reg_r(struct usb_ov511 *ov, unsigned char reg)
387 {
388         int rc;
389
390         mutex_lock(&ov->cbuf_lock);
391         rc = usb_control_msg(ov->dev,
392                              usb_rcvctrlpipe(ov->dev, 0),
393                              (ov->bclass == BCL_OV518)?1:3 /* REG_IO */,
394                              USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
395                              0, (__u16)reg, &ov->cbuf[0], 1, 1000);
396
397         if (rc < 0) {
398                 err("reg read: error %d: %s", rc, symbolic(urb_errlist, rc));
399         } else {
400                 rc = ov->cbuf[0];
401                 PDEBUG(5, "0x%02X:0x%02X", reg, ov->cbuf[0]);
402         }
403
404         mutex_unlock(&ov->cbuf_lock);
405
406         return rc;
407 }
408
409 /*
410  * Writes bits at positions specified by mask to an OV51x reg. Bits that are in
411  * the same position as 1's in "mask" are cleared and set to "value". Bits
412  * that are in the same position as 0's in "mask" are preserved, regardless
413  * of their respective state in "value".
414  */
415 static int
416 reg_w_mask(struct usb_ov511 *ov,
417            unsigned char reg,
418            unsigned char value,
419            unsigned char mask)
420 {
421         int ret;
422         unsigned char oldval, newval;
423
424         ret = reg_r(ov, reg);
425         if (ret < 0)
426                 return ret;
427
428         oldval = (unsigned char) ret;
429         oldval &= (~mask);              /* Clear the masked bits */
430         value &= mask;                  /* Enforce mask on value */
431         newval = oldval | value;        /* Set the desired bits */
432
433         return (reg_w(ov, reg, newval));
434 }
435
436 /* 
437  * Writes multiple (n) byte value to a single register. Only valid with certain
438  * registers (0x30 and 0xc4 - 0xce).
439  */
440 static int
441 ov518_reg_w32(struct usb_ov511 *ov, unsigned char reg, u32 val, int n)
442 {
443         int rc;
444
445         PDEBUG(5, "0x%02X:%7d, n=%d", reg, val, n);
446
447         mutex_lock(&ov->cbuf_lock);
448
449         *((__le32 *)ov->cbuf) = __cpu_to_le32(val);
450
451         rc = usb_control_msg(ov->dev,
452                              usb_sndctrlpipe(ov->dev, 0),
453                              1 /* REG_IO */,
454                              USB_TYPE_VENDOR | USB_RECIP_DEVICE,
455                              0, (__u16)reg, ov->cbuf, n, 1000);
456         mutex_unlock(&ov->cbuf_lock);
457
458         if (rc < 0)
459                 err("reg write multiple: error %d: %s", rc,
460                     symbolic(urb_errlist, rc));
461
462         return rc;
463 }
464
465 static int
466 ov511_upload_quan_tables(struct usb_ov511 *ov)
467 {
468         unsigned char *pYTable = yQuanTable511;
469         unsigned char *pUVTable = uvQuanTable511;
470         unsigned char val0, val1;
471         int i, rc, reg = R511_COMP_LUT_BEGIN;
472
473         PDEBUG(4, "Uploading quantization tables");
474
475         for (i = 0; i < OV511_QUANTABLESIZE / 2; i++) {
476                 if (ENABLE_Y_QUANTABLE) {
477                         val0 = *pYTable++;
478                         val1 = *pYTable++;
479                         val0 &= 0x0f;
480                         val1 &= 0x0f;
481                         val0 |= val1 << 4;
482                         rc = reg_w(ov, reg, val0);
483                         if (rc < 0)
484                                 return rc;
485                 }
486
487                 if (ENABLE_UV_QUANTABLE) {
488                         val0 = *pUVTable++;
489                         val1 = *pUVTable++;
490                         val0 &= 0x0f;
491                         val1 &= 0x0f;
492                         val0 |= val1 << 4;
493                         rc = reg_w(ov, reg + OV511_QUANTABLESIZE/2, val0);
494                         if (rc < 0)
495                                 return rc;
496                 }
497
498                 reg++;
499         }
500
501         return 0;
502 }
503
504 /* OV518 quantization tables are 8x4 (instead of 8x8) */
505 static int
506 ov518_upload_quan_tables(struct usb_ov511 *ov)
507 {
508         unsigned char *pYTable = yQuanTable518;
509         unsigned char *pUVTable = uvQuanTable518;
510         unsigned char val0, val1;
511         int i, rc, reg = R511_COMP_LUT_BEGIN;
512
513         PDEBUG(4, "Uploading quantization tables");
514
515         for (i = 0; i < OV518_QUANTABLESIZE / 2; i++) {
516                 if (ENABLE_Y_QUANTABLE) {
517                         val0 = *pYTable++;
518                         val1 = *pYTable++;
519                         val0 &= 0x0f;
520                         val1 &= 0x0f;
521                         val0 |= val1 << 4;
522                         rc = reg_w(ov, reg, val0);
523                         if (rc < 0)
524                                 return rc;
525                 }
526
527                 if (ENABLE_UV_QUANTABLE) {
528                         val0 = *pUVTable++;
529                         val1 = *pUVTable++;
530                         val0 &= 0x0f;
531                         val1 &= 0x0f;
532                         val0 |= val1 << 4;
533                         rc = reg_w(ov, reg + OV518_QUANTABLESIZE/2, val0);
534                         if (rc < 0)
535                                 return rc;
536                 }
537
538                 reg++;
539         }
540
541         return 0;
542 }
543
544 static int
545 ov51x_reset(struct usb_ov511 *ov, unsigned char reset_type)
546 {
547         int rc;
548
549         /* Setting bit 0 not allowed on 518/518Plus */
550         if (ov->bclass == BCL_OV518)
551                 reset_type &= 0xfe;
552
553         PDEBUG(4, "Reset: type=0x%02X", reset_type);
554
555         rc = reg_w(ov, R51x_SYS_RESET, reset_type);
556         rc = reg_w(ov, R51x_SYS_RESET, 0);
557
558         if (rc < 0)
559                 err("reset: command failed");
560
561         return rc;
562 }
563
564 /**********************************************************************
565  *
566  * Low-level I2C I/O functions
567  *
568  **********************************************************************/
569
570 /* NOTE: Do not call this function directly!
571  * The OV518 I2C I/O procedure is different, hence, this function.
572  * This is normally only called from i2c_w(). Note that this function
573  * always succeeds regardless of whether the sensor is present and working.
574  */
575 static int
576 ov518_i2c_write_internal(struct usb_ov511 *ov,
577                          unsigned char reg,
578                          unsigned char value)
579 {
580         int rc;
581
582         PDEBUG(5, "0x%02X:0x%02X", reg, value);
583
584         /* Select camera register */
585         rc = reg_w(ov, R51x_I2C_SADDR_3, reg);
586         if (rc < 0)
587                 return rc;
588
589         /* Write "value" to I2C data port of OV511 */
590         rc = reg_w(ov, R51x_I2C_DATA, value);
591         if (rc < 0)
592                 return rc;
593
594         /* Initiate 3-byte write cycle */
595         rc = reg_w(ov, R518_I2C_CTL, 0x01);
596         if (rc < 0)
597                 return rc;
598
599         return 0;
600 }
601
602 /* NOTE: Do not call this function directly! */
603 static int
604 ov511_i2c_write_internal(struct usb_ov511 *ov,
605                          unsigned char reg,
606                          unsigned char value)
607 {
608         int rc, retries;
609
610         PDEBUG(5, "0x%02X:0x%02X", reg, value);
611
612         /* Three byte write cycle */
613         for (retries = OV511_I2C_RETRIES; ; ) {
614                 /* Select camera register */
615                 rc = reg_w(ov, R51x_I2C_SADDR_3, reg);
616                 if (rc < 0)
617                         break;
618
619                 /* Write "value" to I2C data port of OV511 */
620                 rc = reg_w(ov, R51x_I2C_DATA, value);
621                 if (rc < 0)
622                         break;
623
624                 /* Initiate 3-byte write cycle */
625                 rc = reg_w(ov, R511_I2C_CTL, 0x01);
626                 if (rc < 0)
627                         break;
628
629                 /* Retry until idle */
630                 do
631                         rc = reg_r(ov, R511_I2C_CTL);
632                 while (rc > 0 && ((rc&1) == 0)); 
633                 if (rc < 0)
634                         break;
635
636                 /* Ack? */
637                 if ((rc&2) == 0) {
638                         rc = 0;
639                         break;
640                 }
641 #if 0
642                 /* I2C abort */
643                 reg_w(ov, R511_I2C_CTL, 0x10);
644 #endif
645                 if (--retries < 0) {
646                         err("i2c write retries exhausted");
647                         rc = -1;
648                         break;
649                 }
650         }
651
652         return rc;
653 }
654
655 /* NOTE: Do not call this function directly!
656  * The OV518 I2C I/O procedure is different, hence, this function.
657  * This is normally only called from i2c_r(). Note that this function
658  * always succeeds regardless of whether the sensor is present and working.
659  */
660 static int
661 ov518_i2c_read_internal(struct usb_ov511 *ov, unsigned char reg)
662 {
663         int rc, value;
664
665         /* Select camera register */
666         rc = reg_w(ov, R51x_I2C_SADDR_2, reg);
667         if (rc < 0)
668                 return rc;
669
670         /* Initiate 2-byte write cycle */
671         rc = reg_w(ov, R518_I2C_CTL, 0x03);
672         if (rc < 0)
673                 return rc;
674
675         /* Initiate 2-byte read cycle */
676         rc = reg_w(ov, R518_I2C_CTL, 0x05);
677         if (rc < 0)
678                 return rc;
679
680         value = reg_r(ov, R51x_I2C_DATA);
681
682         PDEBUG(5, "0x%02X:0x%02X", reg, value);
683
684         return value;
685 }
686
687 /* NOTE: Do not call this function directly!
688  * returns: negative is error, pos or zero is data */
689 static int
690 ov511_i2c_read_internal(struct usb_ov511 *ov, unsigned char reg)
691 {
692         int rc, value, retries;
693
694         /* Two byte write cycle */
695         for (retries = OV511_I2C_RETRIES; ; ) {
696                 /* Select camera register */
697                 rc = reg_w(ov, R51x_I2C_SADDR_2, reg);
698                 if (rc < 0)
699                         return rc;
700
701                 /* Initiate 2-byte write cycle */
702                 rc = reg_w(ov, R511_I2C_CTL, 0x03);
703                 if (rc < 0)
704                         return rc;
705
706                 /* Retry until idle */
707                 do
708                          rc = reg_r(ov, R511_I2C_CTL);
709                 while (rc > 0 && ((rc&1) == 0));
710                 if (rc < 0)
711                         return rc;
712
713                 if ((rc&2) == 0) /* Ack? */
714                         break;
715
716                 /* I2C abort */
717                 reg_w(ov, R511_I2C_CTL, 0x10);
718
719                 if (--retries < 0) {
720                         err("i2c write retries exhausted");
721                         return -1;
722                 }
723         }
724
725         /* Two byte read cycle */
726         for (retries = OV511_I2C_RETRIES; ; ) {
727                 /* Initiate 2-byte read cycle */
728                 rc = reg_w(ov, R511_I2C_CTL, 0x05);
729                 if (rc < 0)
730                         return rc;
731
732                 /* Retry until idle */
733                 do
734                         rc = reg_r(ov, R511_I2C_CTL);
735                 while (rc > 0 && ((rc&1) == 0));
736                 if (rc < 0)
737                         return rc;
738
739                 if ((rc&2) == 0) /* Ack? */
740                         break;
741
742                 /* I2C abort */
743                 rc = reg_w(ov, R511_I2C_CTL, 0x10);
744                 if (rc < 0)
745                         return rc;
746
747                 if (--retries < 0) {
748                         err("i2c read retries exhausted");
749                         return -1;
750                 }
751         }
752
753         value = reg_r(ov, R51x_I2C_DATA);
754
755         PDEBUG(5, "0x%02X:0x%02X", reg, value);
756
757         /* This is needed to make i2c_w() work */
758         rc = reg_w(ov, R511_I2C_CTL, 0x05);
759         if (rc < 0)
760                 return rc;
761
762         return value;
763 }
764
765 /* returns: negative is error, pos or zero is data */
766 static int
767 i2c_r(struct usb_ov511 *ov, unsigned char reg)
768 {
769         int rc;
770
771         mutex_lock(&ov->i2c_lock);
772
773         if (ov->bclass == BCL_OV518)
774                 rc = ov518_i2c_read_internal(ov, reg);
775         else
776                 rc = ov511_i2c_read_internal(ov, reg);
777
778         mutex_unlock(&ov->i2c_lock);
779
780         return rc;
781 }
782
783 static int
784 i2c_w(struct usb_ov511 *ov, unsigned char reg, unsigned char value)
785 {
786         int rc;
787
788         mutex_lock(&ov->i2c_lock);
789
790         if (ov->bclass == BCL_OV518)
791                 rc = ov518_i2c_write_internal(ov, reg, value);
792         else
793                 rc = ov511_i2c_write_internal(ov, reg, value);
794
795         mutex_unlock(&ov->i2c_lock);
796
797         return rc;
798 }
799
800 /* Do not call this function directly! */
801 static int
802 ov51x_i2c_write_mask_internal(struct usb_ov511 *ov,
803                               unsigned char reg,
804                               unsigned char value,
805                               unsigned char mask)
806 {
807         int rc;
808         unsigned char oldval, newval;
809
810         if (mask == 0xff) {
811                 newval = value;
812         } else {
813                 if (ov->bclass == BCL_OV518)
814                         rc = ov518_i2c_read_internal(ov, reg);
815                 else
816                         rc = ov511_i2c_read_internal(ov, reg);
817                 if (rc < 0)
818                         return rc;
819
820                 oldval = (unsigned char) rc;
821                 oldval &= (~mask);              /* Clear the masked bits */
822                 value &= mask;                  /* Enforce mask on value */
823                 newval = oldval | value;        /* Set the desired bits */
824         }
825
826         if (ov->bclass == BCL_OV518)
827                 return (ov518_i2c_write_internal(ov, reg, newval));
828         else
829                 return (ov511_i2c_write_internal(ov, reg, newval));
830 }
831
832 /* Writes bits at positions specified by mask to an I2C reg. Bits that are in
833  * the same position as 1's in "mask" are cleared and set to "value". Bits
834  * that are in the same position as 0's in "mask" are preserved, regardless
835  * of their respective state in "value".
836  */
837 static int
838 i2c_w_mask(struct usb_ov511 *ov,
839            unsigned char reg,
840            unsigned char value,
841            unsigned char mask)
842 {
843         int rc;
844
845         mutex_lock(&ov->i2c_lock);
846         rc = ov51x_i2c_write_mask_internal(ov, reg, value, mask);
847         mutex_unlock(&ov->i2c_lock);
848
849         return rc;
850 }
851
852 /* Set the read and write slave IDs. The "slave" argument is the write slave,
853  * and the read slave will be set to (slave + 1). ov->i2c_lock should be held
854  * when calling this. This should not be called from outside the i2c I/O
855  * functions.
856  */
857 static int
858 i2c_set_slave_internal(struct usb_ov511 *ov, unsigned char slave)
859 {
860         int rc;
861
862         rc = reg_w(ov, R51x_I2C_W_SID, slave);
863         if (rc < 0)
864                 return rc;
865
866         rc = reg_w(ov, R51x_I2C_R_SID, slave + 1);
867         if (rc < 0)
868                 return rc;
869
870         return 0;
871 }
872
873 /* Write to a specific I2C slave ID and register, using the specified mask */
874 static int
875 i2c_w_slave(struct usb_ov511 *ov,
876             unsigned char slave,
877             unsigned char reg,
878             unsigned char value,
879             unsigned char mask)
880 {
881         int rc = 0;
882
883         mutex_lock(&ov->i2c_lock);
884
885         /* Set new slave IDs */
886         rc = i2c_set_slave_internal(ov, slave);
887         if (rc < 0)
888                 goto out;
889
890         rc = ov51x_i2c_write_mask_internal(ov, reg, value, mask);
891
892 out:
893         /* Restore primary IDs */
894         if (i2c_set_slave_internal(ov, ov->primary_i2c_slave) < 0)
895                 err("Couldn't restore primary I2C slave");
896
897         mutex_unlock(&ov->i2c_lock);
898         return rc;
899 }
900
901 /* Read from a specific I2C slave ID and register */
902 static int
903 i2c_r_slave(struct usb_ov511 *ov,
904             unsigned char slave,
905             unsigned char reg)
906 {
907         int rc;
908
909         mutex_lock(&ov->i2c_lock);
910
911         /* Set new slave IDs */
912         rc = i2c_set_slave_internal(ov, slave);
913         if (rc < 0)
914                 goto out;
915
916         if (ov->bclass == BCL_OV518)
917                 rc = ov518_i2c_read_internal(ov, reg);
918         else
919                 rc = ov511_i2c_read_internal(ov, reg);
920
921 out:
922         /* Restore primary IDs */
923         if (i2c_set_slave_internal(ov, ov->primary_i2c_slave) < 0)
924                 err("Couldn't restore primary I2C slave");
925
926         mutex_unlock(&ov->i2c_lock);
927         return rc;
928 }
929
930 /* Sets I2C read and write slave IDs. Returns <0 for error */
931 static int
932 ov51x_set_slave_ids(struct usb_ov511 *ov, unsigned char sid)
933 {
934         int rc;
935
936         mutex_lock(&ov->i2c_lock);
937
938         rc = i2c_set_slave_internal(ov, sid);
939         if (rc < 0)
940                 goto out;
941
942         // FIXME: Is this actually necessary?
943         rc = ov51x_reset(ov, OV511_RESET_NOREGS);
944 out:
945         mutex_unlock(&ov->i2c_lock);
946         return rc;
947 }
948
949 static int
950 write_regvals(struct usb_ov511 *ov, struct ov511_regvals * pRegvals)
951 {
952         int rc;
953
954         while (pRegvals->bus != OV511_DONE_BUS) {
955                 if (pRegvals->bus == OV511_REG_BUS) {
956                         if ((rc = reg_w(ov, pRegvals->reg, pRegvals->val)) < 0)
957                                 return rc;
958                 } else if (pRegvals->bus == OV511_I2C_BUS) {
959                         if ((rc = i2c_w(ov, pRegvals->reg, pRegvals->val)) < 0)
960                                 return rc;
961                 } else {
962                         err("Bad regval array");
963                         return -1;
964                 }
965                 pRegvals++;
966         }
967         return 0;
968 }
969
970 #ifdef OV511_DEBUG
971 static void
972 dump_i2c_range(struct usb_ov511 *ov, int reg1, int regn)
973 {
974         int i, rc;
975
976         for (i = reg1; i <= regn; i++) {
977                 rc = i2c_r(ov, i);
978                 info("Sensor[0x%02X] = 0x%02X", i, rc);
979         }
980 }
981
982 static void
983 dump_i2c_regs(struct usb_ov511 *ov)
984 {
985         info("I2C REGS");
986         dump_i2c_range(ov, 0x00, 0x7C);
987 }
988
989 static void
990 dump_reg_range(struct usb_ov511 *ov, int reg1, int regn)
991 {
992         int i, rc;
993
994         for (i = reg1; i <= regn; i++) {
995                 rc = reg_r(ov, i);
996                 info("OV511[0x%02X] = 0x%02X", i, rc);
997         }
998 }
999
1000 static void
1001 ov511_dump_regs(struct usb_ov511 *ov)
1002 {
1003         info("CAMERA INTERFACE REGS");
1004         dump_reg_range(ov, 0x10, 0x1f);
1005         info("DRAM INTERFACE REGS");
1006         dump_reg_range(ov, 0x20, 0x23);
1007         info("ISO FIFO REGS");
1008         dump_reg_range(ov, 0x30, 0x31);
1009         info("PIO REGS");
1010         dump_reg_range(ov, 0x38, 0x39);
1011         dump_reg_range(ov, 0x3e, 0x3e);
1012         info("I2C REGS");
1013         dump_reg_range(ov, 0x40, 0x49);
1014         info("SYSTEM CONTROL REGS");
1015         dump_reg_range(ov, 0x50, 0x55);
1016         dump_reg_range(ov, 0x5e, 0x5f);
1017         info("OmniCE REGS");
1018         dump_reg_range(ov, 0x70, 0x79);
1019         /* NOTE: Quantization tables are not readable. You will get the value
1020          * in reg. 0x79 for every table register */
1021         dump_reg_range(ov, 0x80, 0x9f);
1022         dump_reg_range(ov, 0xa0, 0xbf);
1023
1024 }
1025
1026 static void
1027 ov518_dump_regs(struct usb_ov511 *ov)
1028 {
1029         info("VIDEO MODE REGS");
1030         dump_reg_range(ov, 0x20, 0x2f);
1031         info("DATA PUMP AND SNAPSHOT REGS");
1032         dump_reg_range(ov, 0x30, 0x3f);
1033         info("I2C REGS");
1034         dump_reg_range(ov, 0x40, 0x4f);
1035         info("SYSTEM CONTROL AND VENDOR REGS");
1036         dump_reg_range(ov, 0x50, 0x5f);
1037         info("60 - 6F");
1038         dump_reg_range(ov, 0x60, 0x6f);
1039         info("70 - 7F");
1040         dump_reg_range(ov, 0x70, 0x7f);
1041         info("Y QUANTIZATION TABLE");
1042         dump_reg_range(ov, 0x80, 0x8f);
1043         info("UV QUANTIZATION TABLE");
1044         dump_reg_range(ov, 0x90, 0x9f);
1045         info("A0 - BF");
1046         dump_reg_range(ov, 0xa0, 0xbf);
1047         info("CBR");
1048         dump_reg_range(ov, 0xc0, 0xcf);
1049 }
1050 #endif
1051
1052 /*****************************************************************************/
1053
1054 /* Temporarily stops OV511 from functioning. Must do this before changing
1055  * registers while the camera is streaming */
1056 static inline int
1057 ov51x_stop(struct usb_ov511 *ov)
1058 {
1059         PDEBUG(4, "stopping");
1060         ov->stopped = 1;
1061         if (ov->bclass == BCL_OV518)
1062                 return (reg_w_mask(ov, R51x_SYS_RESET, 0x3a, 0x3a));
1063         else
1064                 return (reg_w(ov, R51x_SYS_RESET, 0x3d));
1065 }
1066
1067 /* Restarts OV511 after ov511_stop() is called. Has no effect if it is not
1068  * actually stopped (for performance). */
1069 static inline int
1070 ov51x_restart(struct usb_ov511 *ov)
1071 {
1072         if (ov->stopped) {
1073                 PDEBUG(4, "restarting");
1074                 ov->stopped = 0;
1075
1076                 /* Reinitialize the stream */
1077                 if (ov->bclass == BCL_OV518)
1078                         reg_w(ov, 0x2f, 0x80);
1079
1080                 return (reg_w(ov, R51x_SYS_RESET, 0x00));
1081         }
1082
1083         return 0;
1084 }
1085
1086 /* Sleeps until no frames are active. Returns !0 if got signal */
1087 static int
1088 ov51x_wait_frames_inactive(struct usb_ov511 *ov)
1089 {
1090         return wait_event_interruptible(ov->wq, ov->curframe < 0);
1091 }
1092
1093 /* Resets the hardware snapshot button */
1094 static void
1095 ov51x_clear_snapshot(struct usb_ov511 *ov)
1096 {
1097         if (ov->bclass == BCL_OV511) {
1098                 reg_w(ov, R51x_SYS_SNAP, 0x00);
1099                 reg_w(ov, R51x_SYS_SNAP, 0x02);
1100                 reg_w(ov, R51x_SYS_SNAP, 0x00);
1101         } else if (ov->bclass == BCL_OV518) {
1102                 warn("snapshot reset not supported yet on OV518(+)");
1103         } else {
1104                 err("clear snap: invalid bridge type");
1105         }
1106 }
1107
1108 #if 0
1109 /* Checks the status of the snapshot button. Returns 1 if it was pressed since
1110  * it was last cleared, and zero in all other cases (including errors) */
1111 static int
1112 ov51x_check_snapshot(struct usb_ov511 *ov)
1113 {
1114         int ret, status = 0;
1115
1116         if (ov->bclass == BCL_OV511) {
1117                 ret = reg_r(ov, R51x_SYS_SNAP);
1118                 if (ret < 0) {
1119                         err("Error checking snspshot status (%d)", ret);
1120                 } else if (ret & 0x08) {
1121                         status = 1;
1122                 }
1123         } else if (ov->bclass == BCL_OV518) {
1124                 warn("snapshot check not supported yet on OV518(+)");
1125         } else {
1126                 err("check snap: invalid bridge type");
1127         }
1128
1129         return status;
1130 }
1131 #endif
1132
1133 /* This does an initial reset of an OmniVision sensor and ensures that I2C
1134  * is synchronized. Returns <0 for failure.
1135  */
1136 static int
1137 init_ov_sensor(struct usb_ov511 *ov)
1138 {
1139         int i, success;
1140
1141         /* Reset the sensor */
1142         if (i2c_w(ov, 0x12, 0x80) < 0)
1143                 return -EIO;
1144
1145         /* Wait for it to initialize */
1146         msleep(150);
1147
1148         for (i = 0, success = 0; i < i2c_detect_tries && !success; i++) {
1149                 if ((i2c_r(ov, OV7610_REG_ID_HIGH) == 0x7F) &&
1150                     (i2c_r(ov, OV7610_REG_ID_LOW) == 0xA2)) {
1151                         success = 1;
1152                         continue;
1153                 }
1154
1155                 /* Reset the sensor */
1156                 if (i2c_w(ov, 0x12, 0x80) < 0)
1157                         return -EIO;
1158                 /* Wait for it to initialize */
1159                 msleep(150);
1160                 /* Dummy read to sync I2C */
1161                 if (i2c_r(ov, 0x00) < 0)
1162                         return -EIO;
1163         }
1164
1165         if (!success)
1166                 return -EIO;
1167
1168         PDEBUG(1, "I2C synced in %d attempt(s)", i);
1169
1170         return 0;
1171 }
1172
1173 static int
1174 ov511_set_packet_size(struct usb_ov511 *ov, int size)
1175 {
1176         int alt, mult;
1177
1178         if (ov51x_stop(ov) < 0)
1179                 return -EIO;
1180
1181         mult = size >> 5;
1182
1183         if (ov->bridge == BRG_OV511) {
1184                 if (size == 0)
1185                         alt = OV511_ALT_SIZE_0;
1186                 else if (size == 257)
1187                         alt = OV511_ALT_SIZE_257;
1188                 else if (size == 513)
1189                         alt = OV511_ALT_SIZE_513;
1190                 else if (size == 769)
1191                         alt = OV511_ALT_SIZE_769;
1192                 else if (size == 993)
1193                         alt = OV511_ALT_SIZE_993;
1194                 else {
1195                         err("Set packet size: invalid size (%d)", size);
1196                         return -EINVAL;
1197                 }
1198         } else if (ov->bridge == BRG_OV511PLUS) {
1199                 if (size == 0)
1200                         alt = OV511PLUS_ALT_SIZE_0;
1201                 else if (size == 33)
1202                         alt = OV511PLUS_ALT_SIZE_33;
1203                 else if (size == 129)
1204                         alt = OV511PLUS_ALT_SIZE_129;
1205                 else if (size == 257)
1206                         alt = OV511PLUS_ALT_SIZE_257;
1207                 else if (size == 385)
1208                         alt = OV511PLUS_ALT_SIZE_385;
1209                 else if (size == 513)
1210                         alt = OV511PLUS_ALT_SIZE_513;
1211                 else if (size == 769)
1212                         alt = OV511PLUS_ALT_SIZE_769;
1213                 else if (size == 961)
1214                         alt = OV511PLUS_ALT_SIZE_961;
1215                 else {
1216                         err("Set packet size: invalid size (%d)", size);
1217                         return -EINVAL;
1218                 }
1219         } else {
1220                 err("Set packet size: Invalid bridge type");
1221                 return -EINVAL;
1222         }
1223
1224         PDEBUG(3, "%d, mult=%d, alt=%d", size, mult, alt);
1225
1226         if (reg_w(ov, R51x_FIFO_PSIZE, mult) < 0)
1227                 return -EIO;
1228
1229         if (usb_set_interface(ov->dev, ov->iface, alt) < 0) {
1230                 err("Set packet size: set interface error");
1231                 return -EBUSY;
1232         }
1233
1234         if (ov51x_reset(ov, OV511_RESET_NOREGS) < 0)
1235                 return -EIO;
1236
1237         ov->packet_size = size;
1238
1239         if (ov51x_restart(ov) < 0)
1240                 return -EIO;
1241
1242         return 0;
1243 }
1244
1245 /* Note: Unlike the OV511/OV511+, the size argument does NOT include the
1246  * optional packet number byte. The actual size *is* stored in ov->packet_size,
1247  * though. */
1248 static int
1249 ov518_set_packet_size(struct usb_ov511 *ov, int size)
1250 {
1251         int alt;
1252
1253         if (ov51x_stop(ov) < 0)
1254                 return -EIO;
1255
1256         if (ov->bclass == BCL_OV518) {
1257                 if (size == 0)
1258                         alt = OV518_ALT_SIZE_0;
1259                 else if (size == 128)
1260                         alt = OV518_ALT_SIZE_128;
1261                 else if (size == 256)
1262                         alt = OV518_ALT_SIZE_256;
1263                 else if (size == 384)
1264                         alt = OV518_ALT_SIZE_384;
1265                 else if (size == 512)
1266                         alt = OV518_ALT_SIZE_512;
1267                 else if (size == 640)
1268                         alt = OV518_ALT_SIZE_640;
1269                 else if (size == 768)
1270                         alt = OV518_ALT_SIZE_768;
1271                 else if (size == 896)
1272                         alt = OV518_ALT_SIZE_896;
1273                 else {
1274                         err("Set packet size: invalid size (%d)", size);
1275                         return -EINVAL;
1276                 }
1277         } else {
1278                 err("Set packet size: Invalid bridge type");
1279                 return -EINVAL;
1280         }
1281
1282         PDEBUG(3, "%d, alt=%d", size, alt);
1283
1284         ov->packet_size = size;
1285         if (size > 0) {
1286                 /* Program ISO FIFO size reg (packet number isn't included) */
1287                 ov518_reg_w32(ov, 0x30, size, 2);
1288
1289                 if (ov->packet_numbering)
1290                         ++ov->packet_size;
1291         }
1292
1293         if (usb_set_interface(ov->dev, ov->iface, alt) < 0) {
1294                 err("Set packet size: set interface error");
1295                 return -EBUSY;
1296         }
1297
1298         /* Initialize the stream */
1299         if (reg_w(ov, 0x2f, 0x80) < 0)
1300                 return -EIO;
1301
1302         if (ov51x_restart(ov) < 0)
1303                 return -EIO;
1304
1305         if (ov51x_reset(ov, OV511_RESET_NOREGS) < 0)
1306                 return -EIO;
1307
1308         return 0;
1309 }
1310
1311 /* Upload compression params and quantization tables. Returns 0 for success. */
1312 static int
1313 ov511_init_compression(struct usb_ov511 *ov)
1314 {
1315         int rc = 0;
1316
1317         if (!ov->compress_inited) {
1318                 reg_w(ov, 0x70, phy);
1319                 reg_w(ov, 0x71, phuv);
1320                 reg_w(ov, 0x72, pvy);
1321                 reg_w(ov, 0x73, pvuv);
1322                 reg_w(ov, 0x74, qhy);
1323                 reg_w(ov, 0x75, qhuv);
1324                 reg_w(ov, 0x76, qvy);
1325                 reg_w(ov, 0x77, qvuv);
1326
1327                 if (ov511_upload_quan_tables(ov) < 0) {
1328                         err("Error uploading quantization tables");
1329                         rc = -EIO;
1330                         goto out;
1331                 }
1332         }
1333
1334         ov->compress_inited = 1;
1335 out:
1336         return rc;
1337 }
1338
1339 /* Upload compression params and quantization tables. Returns 0 for success. */
1340 static int
1341 ov518_init_compression(struct usb_ov511 *ov)
1342 {
1343         int rc = 0;
1344
1345         if (!ov->compress_inited) {
1346                 if (ov518_upload_quan_tables(ov) < 0) {
1347                         err("Error uploading quantization tables");
1348                         rc = -EIO;
1349                         goto out;
1350                 }
1351         }
1352
1353         ov->compress_inited = 1;
1354 out:
1355         return rc;
1356 }
1357
1358 /* -------------------------------------------------------------------------- */
1359
1360 /* Sets sensor's contrast setting to "val" */
1361 static int
1362 sensor_set_contrast(struct usb_ov511 *ov, unsigned short val)
1363 {
1364         int rc;
1365
1366         PDEBUG(3, "%d", val);
1367
1368         if (ov->stop_during_set)
1369                 if (ov51x_stop(ov) < 0)
1370                         return -EIO;
1371
1372         switch (ov->sensor) {
1373         case SEN_OV7610:
1374         case SEN_OV6620:
1375         {
1376                 rc = i2c_w(ov, OV7610_REG_CNT, val >> 8);
1377                 if (rc < 0)
1378                         goto out;
1379                 break;
1380         }
1381         case SEN_OV6630:
1382         {
1383                 rc = i2c_w_mask(ov, OV7610_REG_CNT, val >> 12, 0x0f);
1384                 if (rc < 0)
1385                         goto out;
1386                 break;
1387         }
1388         case SEN_OV7620:
1389         {
1390                 unsigned char ctab[] = {
1391                         0x01, 0x05, 0x09, 0x11, 0x15, 0x35, 0x37, 0x57,
1392                         0x5b, 0xa5, 0xa7, 0xc7, 0xc9, 0xcf, 0xef, 0xff
1393                 };
1394
1395                 /* Use Y gamma control instead. Bit 0 enables it. */
1396                 rc = i2c_w(ov, 0x64, ctab[val>>12]);
1397                 if (rc < 0)
1398                         goto out;
1399                 break;
1400         }
1401         case SEN_SAA7111A:
1402         {
1403                 rc = i2c_w(ov, 0x0b, val >> 9);
1404                 if (rc < 0)
1405                         goto out;
1406                 break;
1407         }
1408         default:
1409         {
1410                 PDEBUG(3, "Unsupported with this sensor");
1411                 rc = -EPERM;
1412                 goto out;
1413         }
1414         }
1415
1416         rc = 0;         /* Success */
1417         ov->contrast = val;
1418 out:
1419         if (ov51x_restart(ov) < 0)
1420                 return -EIO;
1421
1422         return rc;
1423 }
1424
1425 /* Gets sensor's contrast setting */
1426 static int
1427 sensor_get_contrast(struct usb_ov511 *ov, unsigned short *val)
1428 {
1429         int rc;
1430
1431         switch (ov->sensor) {
1432         case SEN_OV7610:
1433         case SEN_OV6620:
1434                 rc = i2c_r(ov, OV7610_REG_CNT);
1435                 if (rc < 0)
1436                         return rc;
1437                 else
1438                         *val = rc << 8;
1439                 break;
1440         case SEN_OV6630:
1441                 rc = i2c_r(ov, OV7610_REG_CNT);
1442                 if (rc < 0)
1443                         return rc;
1444                 else
1445                         *val = rc << 12;
1446                 break;
1447         case SEN_OV7620:
1448                 /* Use Y gamma reg instead. Bit 0 is the enable bit. */
1449                 rc = i2c_r(ov, 0x64);
1450                 if (rc < 0)
1451                         return rc;
1452                 else
1453                         *val = (rc & 0xfe) << 8;
1454                 break;
1455         case SEN_SAA7111A:
1456                 *val = ov->contrast;
1457                 break;
1458         default:
1459                 PDEBUG(3, "Unsupported with this sensor");
1460                 return -EPERM;
1461         }
1462
1463         PDEBUG(3, "%d", *val);
1464         ov->contrast = *val;
1465
1466         return 0;
1467 }
1468
1469 /* -------------------------------------------------------------------------- */
1470
1471 /* Sets sensor's brightness setting to "val" */
1472 static int
1473 sensor_set_brightness(struct usb_ov511 *ov, unsigned short val)
1474 {
1475         int rc;
1476
1477         PDEBUG(4, "%d", val);
1478
1479         if (ov->stop_during_set)
1480                 if (ov51x_stop(ov) < 0)
1481                         return -EIO;
1482
1483         switch (ov->sensor) {
1484         case SEN_OV7610:
1485         case SEN_OV76BE:
1486         case SEN_OV6620:
1487         case SEN_OV6630:
1488                 rc = i2c_w(ov, OV7610_REG_BRT, val >> 8);
1489                 if (rc < 0)
1490                         goto out;
1491                 break;
1492         case SEN_OV7620:
1493                 /* 7620 doesn't like manual changes when in auto mode */
1494                 if (!ov->auto_brt) {
1495                         rc = i2c_w(ov, OV7610_REG_BRT, val >> 8);
1496                         if (rc < 0)
1497                                 goto out;
1498                 }
1499                 break;
1500         case SEN_SAA7111A:
1501                 rc = i2c_w(ov, 0x0a, val >> 8);
1502                 if (rc < 0)
1503                         goto out;
1504                 break;
1505         default:
1506                 PDEBUG(3, "Unsupported with this sensor");
1507                 rc = -EPERM;
1508                 goto out;
1509         }
1510
1511         rc = 0;         /* Success */
1512         ov->brightness = val;
1513 out:
1514         if (ov51x_restart(ov) < 0)
1515                 return -EIO;
1516
1517         return rc;
1518 }
1519
1520 /* Gets sensor's brightness setting */
1521 static int
1522 sensor_get_brightness(struct usb_ov511 *ov, unsigned short *val)
1523 {
1524         int rc;
1525
1526         switch (ov->sensor) {
1527         case SEN_OV7610:
1528         case SEN_OV76BE:
1529         case SEN_OV7620:
1530         case SEN_OV6620:
1531         case SEN_OV6630:
1532                 rc = i2c_r(ov, OV7610_REG_BRT);
1533                 if (rc < 0)
1534                         return rc;
1535                 else
1536                         *val = rc << 8;
1537                 break;
1538         case SEN_SAA7111A:
1539                 *val = ov->brightness;
1540                 break;
1541         default:
1542                 PDEBUG(3, "Unsupported with this sensor");
1543                 return -EPERM;
1544         }
1545
1546         PDEBUG(3, "%d", *val);
1547         ov->brightness = *val;
1548
1549         return 0;
1550 }
1551
1552 /* -------------------------------------------------------------------------- */
1553
1554 /* Sets sensor's saturation (color intensity) setting to "val" */
1555 static int
1556 sensor_set_saturation(struct usb_ov511 *ov, unsigned short val)
1557 {
1558         int rc;
1559
1560         PDEBUG(3, "%d", val);
1561
1562         if (ov->stop_during_set)
1563                 if (ov51x_stop(ov) < 0)
1564                         return -EIO;
1565
1566         switch (ov->sensor) {
1567         case SEN_OV7610:
1568         case SEN_OV76BE:
1569         case SEN_OV6620:
1570         case SEN_OV6630:
1571                 rc = i2c_w(ov, OV7610_REG_SAT, val >> 8);
1572                 if (rc < 0)
1573                         goto out;
1574                 break;
1575         case SEN_OV7620:
1576 //              /* Use UV gamma control instead. Bits 0 & 7 are reserved. */
1577 //              rc = ov_i2c_write(ov->dev, 0x62, (val >> 9) & 0x7e);
1578 //              if (rc < 0)
1579 //                      goto out;
1580                 rc = i2c_w(ov, OV7610_REG_SAT, val >> 8);
1581                 if (rc < 0)
1582                         goto out;
1583                 break;
1584         case SEN_SAA7111A:
1585                 rc = i2c_w(ov, 0x0c, val >> 9);
1586                 if (rc < 0)
1587                         goto out;
1588                 break;
1589         default:
1590                 PDEBUG(3, "Unsupported with this sensor");
1591                 rc = -EPERM;
1592                 goto out;
1593         }
1594
1595         rc = 0;         /* Success */
1596         ov->colour = val;
1597 out:
1598         if (ov51x_restart(ov) < 0)
1599                 return -EIO;
1600
1601         return rc;
1602 }
1603
1604 /* Gets sensor's saturation (color intensity) setting */
1605 static int
1606 sensor_get_saturation(struct usb_ov511 *ov, unsigned short *val)
1607 {
1608         int rc;
1609
1610         switch (ov->sensor) {
1611         case SEN_OV7610:
1612         case SEN_OV76BE:
1613         case SEN_OV6620:
1614         case SEN_OV6630:
1615                 rc = i2c_r(ov, OV7610_REG_SAT);
1616                 if (rc < 0)
1617                         return rc;
1618                 else
1619                         *val = rc << 8;
1620                 break;
1621         case SEN_OV7620:
1622 //              /* Use UV gamma reg instead. Bits 0 & 7 are reserved. */
1623 //              rc = i2c_r(ov, 0x62);
1624 //              if (rc < 0)
1625 //                      return rc;
1626 //              else
1627 //                      *val = (rc & 0x7e) << 9;
1628                 rc = i2c_r(ov, OV7610_REG_SAT);
1629                 if (rc < 0)
1630                         return rc;
1631                 else
1632                         *val = rc << 8;
1633                 break;
1634         case SEN_SAA7111A:
1635                 *val = ov->colour;
1636                 break;
1637         default:
1638                 PDEBUG(3, "Unsupported with this sensor");
1639                 return -EPERM;
1640         }
1641
1642         PDEBUG(3, "%d", *val);
1643         ov->colour = *val;
1644
1645         return 0;
1646 }
1647
1648 /* -------------------------------------------------------------------------- */
1649
1650 /* Sets sensor's hue (red/blue balance) setting to "val" */
1651 static int
1652 sensor_set_hue(struct usb_ov511 *ov, unsigned short val)
1653 {
1654         int rc;
1655
1656         PDEBUG(3, "%d", val);
1657
1658         if (ov->stop_during_set)
1659                 if (ov51x_stop(ov) < 0)
1660                         return -EIO;
1661
1662         switch (ov->sensor) {
1663         case SEN_OV7610:
1664         case SEN_OV6620:
1665         case SEN_OV6630:
1666                 rc = i2c_w(ov, OV7610_REG_RED, 0xFF - (val >> 8));
1667                 if (rc < 0)
1668                         goto out;
1669
1670                 rc = i2c_w(ov, OV7610_REG_BLUE, val >> 8);
1671                 if (rc < 0)
1672                         goto out;
1673                 break;
1674         case SEN_OV7620:
1675 // Hue control is causing problems. I will enable it once it's fixed.
1676 #if 0
1677                 rc = i2c_w(ov, 0x7a, (unsigned char)(val >> 8) + 0xb);
1678                 if (rc < 0)
1679                         goto out;
1680
1681                 rc = i2c_w(ov, 0x79, (unsigned char)(val >> 8) + 0xb);
1682                 if (rc < 0)
1683                         goto out;
1684 #endif
1685                 break;
1686         case SEN_SAA7111A:
1687                 rc = i2c_w(ov, 0x0d, (val + 32768) >> 8);
1688                 if (rc < 0)
1689                         goto out;
1690                 break;
1691         default:
1692                 PDEBUG(3, "Unsupported with this sensor");
1693                 rc = -EPERM;
1694                 goto out;
1695         }
1696
1697         rc = 0;         /* Success */
1698         ov->hue = val;
1699 out:
1700         if (ov51x_restart(ov) < 0)
1701                 return -EIO;
1702
1703         return rc;
1704 }
1705
1706 /* Gets sensor's hue (red/blue balance) setting */
1707 static int
1708 sensor_get_hue(struct usb_ov511 *ov, unsigned short *val)
1709 {
1710         int rc;
1711
1712         switch (ov->sensor) {
1713         case SEN_OV7610:
1714         case SEN_OV6620:
1715         case SEN_OV6630:
1716                 rc = i2c_r(ov, OV7610_REG_BLUE);
1717                 if (rc < 0)
1718                         return rc;
1719                 else
1720                         *val = rc << 8;
1721                 break;
1722         case SEN_OV7620:
1723                 rc = i2c_r(ov, 0x7a);
1724                 if (rc < 0)
1725                         return rc;
1726                 else
1727                         *val = rc << 8;
1728                 break;
1729         case SEN_SAA7111A:
1730                 *val = ov->hue;
1731                 break;
1732         default:
1733                 PDEBUG(3, "Unsupported with this sensor");
1734                 return -EPERM;
1735         }
1736
1737         PDEBUG(3, "%d", *val);
1738         ov->hue = *val;
1739
1740         return 0;
1741 }
1742
1743 /* -------------------------------------------------------------------------- */
1744
1745 static int
1746 sensor_set_picture(struct usb_ov511 *ov, struct video_picture *p)
1747 {
1748         int rc;
1749
1750         PDEBUG(4, "sensor_set_picture");
1751
1752         ov->whiteness = p->whiteness;
1753
1754         /* Don't return error if a setting is unsupported, or rest of settings
1755          * will not be performed */
1756
1757         rc = sensor_set_contrast(ov, p->contrast);
1758         if (FATAL_ERROR(rc))
1759                 return rc;
1760
1761         rc = sensor_set_brightness(ov, p->brightness);
1762         if (FATAL_ERROR(rc))
1763                 return rc;
1764
1765         rc = sensor_set_saturation(ov, p->colour);
1766         if (FATAL_ERROR(rc))
1767                 return rc;
1768
1769         rc = sensor_set_hue(ov, p->hue);
1770         if (FATAL_ERROR(rc))
1771                 return rc;
1772
1773         return 0;
1774 }
1775
1776 static int
1777 sensor_get_picture(struct usb_ov511 *ov, struct video_picture *p)
1778 {
1779         int rc;
1780
1781         PDEBUG(4, "sensor_get_picture");
1782
1783         /* Don't return error if a setting is unsupported, or rest of settings
1784          * will not be performed */
1785
1786         rc = sensor_get_contrast(ov, &(p->contrast));
1787         if (FATAL_ERROR(rc))
1788                 return rc;
1789
1790         rc = sensor_get_brightness(ov, &(p->brightness));
1791         if (FATAL_ERROR(rc))
1792                 return rc;
1793
1794         rc = sensor_get_saturation(ov, &(p->colour));
1795         if (FATAL_ERROR(rc))
1796                 return rc;
1797
1798         rc = sensor_get_hue(ov, &(p->hue));
1799         if (FATAL_ERROR(rc))
1800                 return rc;
1801
1802         p->whiteness = 105 << 8;
1803
1804         return 0;
1805 }
1806
1807 #if 0
1808 // FIXME: Exposure range is only 0x00-0x7f in interlace mode
1809 /* Sets current exposure for sensor. This only has an effect if auto-exposure
1810  * is off */
1811 static inline int
1812 sensor_set_exposure(struct usb_ov511 *ov, unsigned char val)
1813 {
1814         int rc;
1815
1816         PDEBUG(3, "%d", val);
1817
1818         if (ov->stop_during_set)
1819                 if (ov51x_stop(ov) < 0)
1820                         return -EIO;
1821
1822         switch (ov->sensor) {
1823         case SEN_OV6620:
1824         case SEN_OV6630:
1825         case SEN_OV7610:
1826         case SEN_OV7620:
1827         case SEN_OV76BE:
1828         case SEN_OV8600:
1829                 rc = i2c_w(ov, 0x10, val);
1830                 if (rc < 0)
1831                         goto out;
1832
1833                 break;
1834         case SEN_KS0127:
1835         case SEN_KS0127B:
1836         case SEN_SAA7111A:
1837                 PDEBUG(3, "Unsupported with this sensor");
1838                 return -EPERM;
1839         default:
1840                 err("Sensor not supported for set_exposure");
1841                 return -EINVAL;
1842         }
1843
1844         rc = 0;         /* Success */
1845         ov->exposure = val;
1846 out:
1847         if (ov51x_restart(ov) < 0)
1848                 return -EIO;
1849
1850         return rc;
1851 }
1852 #endif
1853
1854 /* Gets current exposure level from sensor, regardless of whether it is under
1855  * manual control. */
1856 static int
1857 sensor_get_exposure(struct usb_ov511 *ov, unsigned char *val)
1858 {
1859         int rc;
1860
1861         switch (ov->sensor) {
1862         case SEN_OV7610:
1863         case SEN_OV6620:
1864         case SEN_OV6630:
1865         case SEN_OV7620:
1866         case SEN_OV76BE:
1867         case SEN_OV8600:
1868                 rc = i2c_r(ov, 0x10);
1869                 if (rc < 0)
1870                         return rc;
1871                 else
1872                         *val = rc;
1873                 break;
1874         case SEN_KS0127:
1875         case SEN_KS0127B:
1876         case SEN_SAA7111A:
1877                 val = NULL;
1878                 PDEBUG(3, "Unsupported with this sensor");
1879                 return -EPERM;
1880         default:
1881                 err("Sensor not supported for get_exposure");
1882                 return -EINVAL;
1883         }
1884
1885         PDEBUG(3, "%d", *val);
1886         ov->exposure = *val;
1887
1888         return 0;
1889 }
1890
1891 /* Turns on or off the LED. Only has an effect with OV511+/OV518(+) */
1892 static void
1893 ov51x_led_control(struct usb_ov511 *ov, int enable)
1894 {
1895         PDEBUG(4, " (%s)", enable ? "turn on" : "turn off");
1896
1897         if (ov->bridge == BRG_OV511PLUS)
1898                 reg_w(ov, R511_SYS_LED_CTL, enable ? 1 : 0);
1899         else if (ov->bclass == BCL_OV518)
1900                 reg_w_mask(ov, R518_GPIO_OUT, enable ? 0x02 : 0x00, 0x02);
1901
1902         return;
1903 }
1904
1905 /* Matches the sensor's internal frame rate to the lighting frequency.
1906  * Valid frequencies are:
1907  *      50 - 50Hz, for European and Asian lighting
1908  *      60 - 60Hz, for American lighting
1909  *
1910  * Tested with: OV7610, OV7620, OV76BE, OV6620
1911  * Unsupported: KS0127, KS0127B, SAA7111A
1912  * Returns: 0 for success
1913  */
1914 static int
1915 sensor_set_light_freq(struct usb_ov511 *ov, int freq)
1916 {
1917         int sixty;
1918
1919         PDEBUG(4, "%d Hz", freq);
1920
1921         if (freq == 60)
1922                 sixty = 1;
1923         else if (freq == 50)
1924                 sixty = 0;
1925         else {
1926                 err("Invalid light freq (%d Hz)", freq);
1927                 return -EINVAL;
1928         }
1929
1930         switch (ov->sensor) {
1931         case SEN_OV7610:
1932                 i2c_w_mask(ov, 0x2a, sixty?0x00:0x80, 0x80);
1933                 i2c_w(ov, 0x2b, sixty?0x00:0xac);
1934                 i2c_w_mask(ov, 0x13, 0x10, 0x10);
1935                 i2c_w_mask(ov, 0x13, 0x00, 0x10);
1936                 break;
1937         case SEN_OV7620:
1938         case SEN_OV76BE:
1939         case SEN_OV8600:
1940                 i2c_w_mask(ov, 0x2a, sixty?0x00:0x80, 0x80);
1941                 i2c_w(ov, 0x2b, sixty?0x00:0xac);
1942                 i2c_w_mask(ov, 0x76, 0x01, 0x01);
1943                 break;
1944         case SEN_OV6620:
1945         case SEN_OV6630:
1946                 i2c_w(ov, 0x2b, sixty?0xa8:0x28);
1947                 i2c_w(ov, 0x2a, sixty?0x84:0xa4);
1948                 break;
1949         case SEN_KS0127:
1950         case SEN_KS0127B:
1951         case SEN_SAA7111A:
1952                 PDEBUG(5, "Unsupported with this sensor");
1953                 return -EPERM;
1954         default:
1955                 err("Sensor not supported for set_light_freq");
1956                 return -EINVAL;
1957         }
1958
1959         ov->lightfreq = freq;
1960
1961         return 0;
1962 }
1963
1964 /* If enable is true, turn on the sensor's banding filter, otherwise turn it
1965  * off. This filter tries to reduce the pattern of horizontal light/dark bands
1966  * caused by some (usually fluorescent) lighting. The light frequency must be
1967  * set either before or after enabling it with ov51x_set_light_freq().
1968  *
1969  * Tested with: OV7610, OV7620, OV76BE, OV6620.
1970  * Unsupported: KS0127, KS0127B, SAA7111A
1971  * Returns: 0 for success
1972  */
1973 static int
1974 sensor_set_banding_filter(struct usb_ov511 *ov, int enable)
1975 {
1976         int rc;
1977
1978         PDEBUG(4, " (%s)", enable ? "turn on" : "turn off");
1979
1980         if (ov->sensor == SEN_KS0127 || ov->sensor == SEN_KS0127B
1981                 || ov->sensor == SEN_SAA7111A) {
1982                 PDEBUG(5, "Unsupported with this sensor");
1983                 return -EPERM;
1984         }
1985
1986         rc = i2c_w_mask(ov, 0x2d, enable?0x04:0x00, 0x04);
1987         if (rc < 0)
1988                 return rc;
1989
1990         ov->bandfilt = enable;
1991
1992         return 0;
1993 }
1994
1995 /* If enable is true, turn on the sensor's auto brightness control, otherwise
1996  * turn it off.
1997  *
1998  * Unsupported: KS0127, KS0127B, SAA7111A
1999  * Returns: 0 for success
2000  */
2001 static int
2002 sensor_set_auto_brightness(struct usb_ov511 *ov, int enable)
2003 {
2004         int rc;
2005
2006         PDEBUG(4, " (%s)", enable ? "turn on" : "turn off");
2007
2008         if (ov->sensor == SEN_KS0127 || ov->sensor == SEN_KS0127B
2009                 || ov->sensor == SEN_SAA7111A) {
2010                 PDEBUG(5, "Unsupported with this sensor");
2011                 return -EPERM;
2012         }
2013
2014         rc = i2c_w_mask(ov, 0x2d, enable?0x10:0x00, 0x10);
2015         if (rc < 0)
2016                 return rc;
2017
2018         ov->auto_brt = enable;
2019
2020         return 0;
2021 }
2022
2023 /* If enable is true, turn on the sensor's auto exposure control, otherwise
2024  * turn it off.
2025  *
2026  * Unsupported: KS0127, KS0127B, SAA7111A
2027  * Returns: 0 for success
2028  */
2029 static int
2030 sensor_set_auto_exposure(struct usb_ov511 *ov, int enable)
2031 {
2032         PDEBUG(4, " (%s)", enable ? "turn on" : "turn off");
2033
2034         switch (ov->sensor) {
2035         case SEN_OV7610:
2036                 i2c_w_mask(ov, 0x29, enable?0x00:0x80, 0x80);
2037                 break;
2038         case SEN_OV6620:
2039         case SEN_OV7620:
2040         case SEN_OV76BE:
2041         case SEN_OV8600:
2042                 i2c_w_mask(ov, 0x13, enable?0x01:0x00, 0x01);
2043                 break;
2044         case SEN_OV6630:
2045                 i2c_w_mask(ov, 0x28, enable?0x00:0x10, 0x10);
2046                 break;
2047         case SEN_KS0127:
2048         case SEN_KS0127B:
2049         case SEN_SAA7111A:
2050                 PDEBUG(5, "Unsupported with this sensor");
2051                 return -EPERM;
2052         default:
2053                 err("Sensor not supported for set_auto_exposure");
2054                 return -EINVAL;
2055         }
2056
2057         ov->auto_exp = enable;
2058
2059         return 0;
2060 }
2061
2062 /* Modifies the sensor's exposure algorithm to allow proper exposure of objects
2063  * that are illuminated from behind.
2064  *
2065  * Tested with: OV6620, OV7620
2066  * Unsupported: OV7610, OV76BE, KS0127, KS0127B, SAA7111A
2067  * Returns: 0 for success
2068  */
2069 static int
2070 sensor_set_backlight(struct usb_ov511 *ov, int enable)
2071 {
2072         PDEBUG(4, " (%s)", enable ? "turn on" : "turn off");
2073
2074         switch (ov->sensor) {
2075         case SEN_OV7620:
2076         case SEN_OV8600:
2077                 i2c_w_mask(ov, 0x68, enable?0xe0:0xc0, 0xe0);
2078                 i2c_w_mask(ov, 0x29, enable?0x08:0x00, 0x08);
2079                 i2c_w_mask(ov, 0x28, enable?0x02:0x00, 0x02);
2080                 break;
2081         case SEN_OV6620:
2082                 i2c_w_mask(ov, 0x4e, enable?0xe0:0xc0, 0xe0);
2083                 i2c_w_mask(ov, 0x29, enable?0x08:0x00, 0x08);
2084                 i2c_w_mask(ov, 0x0e, enable?0x80:0x00, 0x80);
2085                 break;
2086         case SEN_OV6630:
2087                 i2c_w_mask(ov, 0x4e, enable?0x80:0x60, 0xe0);
2088                 i2c_w_mask(ov, 0x29, enable?0x08:0x00, 0x08);
2089                 i2c_w_mask(ov, 0x28, enable?0x02:0x00, 0x02);
2090                 break;
2091         case SEN_OV7610:
2092         case SEN_OV76BE:
2093         case SEN_KS0127:
2094         case SEN_KS0127B:
2095         case SEN_SAA7111A:
2096                 PDEBUG(5, "Unsupported with this sensor");
2097                 return -EPERM;
2098         default:
2099                 err("Sensor not supported for set_backlight");
2100                 return -EINVAL;
2101         }
2102
2103         ov->backlight = enable;
2104
2105         return 0;
2106 }
2107
2108 static int
2109 sensor_set_mirror(struct usb_ov511 *ov, int enable)
2110 {
2111         PDEBUG(4, " (%s)", enable ? "turn on" : "turn off");
2112
2113         switch (ov->sensor) {
2114         case SEN_OV6620:
2115         case SEN_OV6630:
2116         case SEN_OV7610:
2117         case SEN_OV7620:
2118         case SEN_OV76BE:
2119         case SEN_OV8600:
2120                 i2c_w_mask(ov, 0x12, enable?0x40:0x00, 0x40);
2121                 break;
2122         case SEN_KS0127:
2123         case SEN_KS0127B:
2124         case SEN_SAA7111A:
2125                 PDEBUG(5, "Unsupported with this sensor");
2126                 return -EPERM;
2127         default:
2128                 err("Sensor not supported for set_mirror");
2129                 return -EINVAL;
2130         }
2131
2132         ov->mirror = enable;
2133
2134         return 0;
2135 }
2136
2137 /* Returns number of bits per pixel (regardless of where they are located;
2138  * planar or not), or zero for unsupported format.
2139  */
2140 static inline int
2141 get_depth(int palette)
2142 {
2143         switch (palette) {
2144         case VIDEO_PALETTE_GREY:    return 8;
2145         case VIDEO_PALETTE_YUV420:  return 12;
2146         case VIDEO_PALETTE_YUV420P: return 12; /* Planar */
2147         default:                    return 0;  /* Invalid format */
2148         }
2149 }
2150
2151 /* Bytes per frame. Used by read(). Return of 0 indicates error */
2152 static inline long int
2153 get_frame_length(struct ov511_frame *frame)
2154 {
2155         if (!frame)
2156                 return 0;
2157         else
2158                 return ((frame->width * frame->height
2159                          * get_depth(frame->format)) >> 3);
2160 }
2161
2162 static int
2163 mode_init_ov_sensor_regs(struct usb_ov511 *ov, int width, int height,
2164                          int mode, int sub_flag, int qvga)
2165 {
2166         int clock;
2167
2168         /******** Mode (VGA/QVGA) and sensor specific regs ********/
2169
2170         switch (ov->sensor) {
2171         case SEN_OV7610:
2172                 i2c_w(ov, 0x14, qvga?0x24:0x04);
2173 // FIXME: Does this improve the image quality or frame rate?
2174 #if 0
2175                 i2c_w_mask(ov, 0x28, qvga?0x00:0x20, 0x20);
2176                 i2c_w(ov, 0x24, 0x10);
2177                 i2c_w(ov, 0x25, qvga?0x40:0x8a);
2178                 i2c_w(ov, 0x2f, qvga?0x30:0xb0);
2179                 i2c_w(ov, 0x35, qvga?0x1c:0x9c);
2180 #endif
2181                 break;
2182         case SEN_OV7620:
2183 //              i2c_w(ov, 0x2b, 0x00);
2184                 i2c_w(ov, 0x14, qvga?0xa4:0x84);
2185                 i2c_w_mask(ov, 0x28, qvga?0x00:0x20, 0x20);
2186                 i2c_w(ov, 0x24, qvga?0x20:0x3a);
2187                 i2c_w(ov, 0x25, qvga?0x30:0x60);
2188                 i2c_w_mask(ov, 0x2d, qvga?0x40:0x00, 0x40);
2189                 i2c_w_mask(ov, 0x67, qvga?0xf0:0x90, 0xf0);
2190                 i2c_w_mask(ov, 0x74, qvga?0x20:0x00, 0x20);
2191                 break;
2192         case SEN_OV76BE:
2193 //              i2c_w(ov, 0x2b, 0x00);
2194                 i2c_w(ov, 0x14, qvga?0xa4:0x84);
2195 // FIXME: Enable this once 7620AE uses 7620 initial settings
2196 #if 0
2197                 i2c_w_mask(ov, 0x28, qvga?0x00:0x20, 0x20);
2198                 i2c_w(ov, 0x24, qvga?0x20:0x3a);
2199                 i2c_w(ov, 0x25, qvga?0x30:0x60);
2200                 i2c_w_mask(ov, 0x2d, qvga?0x40:0x00, 0x40);
2201                 i2c_w_mask(ov, 0x67, qvga?0xb0:0x90, 0xf0);
2202                 i2c_w_mask(ov, 0x74, qvga?0x20:0x00, 0x20);
2203 #endif
2204                 break;
2205         case SEN_OV6620:
2206                 i2c_w(ov, 0x14, qvga?0x24:0x04);
2207                 break;
2208         case SEN_OV6630:
2209                 i2c_w(ov, 0x14, qvga?0xa0:0x80);
2210                 break;
2211         default:
2212                 err("Invalid sensor");
2213                 return -EINVAL;
2214         }
2215
2216         /******** Palette-specific regs ********/
2217
2218         if (mode == VIDEO_PALETTE_GREY) {
2219                 if (ov->sensor == SEN_OV7610 || ov->sensor == SEN_OV76BE) {
2220                         /* these aren't valid on the OV6620/OV7620/6630? */
2221                         i2c_w_mask(ov, 0x0e, 0x40, 0x40);
2222                 }
2223
2224                 if (ov->sensor == SEN_OV6630 && ov->bridge == BRG_OV518
2225                     && ov518_color) {
2226                         i2c_w_mask(ov, 0x12, 0x00, 0x10);
2227                         i2c_w_mask(ov, 0x13, 0x00, 0x20);
2228                 } else {
2229                         i2c_w_mask(ov, 0x13, 0x20, 0x20);
2230                 }
2231         } else {
2232                 if (ov->sensor == SEN_OV7610 || ov->sensor == SEN_OV76BE) {
2233                         /* not valid on the OV6620/OV7620/6630? */
2234                         i2c_w_mask(ov, 0x0e, 0x00, 0x40);
2235                 }
2236
2237                 /* The OV518 needs special treatment. Although both the OV518
2238                  * and the OV6630 support a 16-bit video bus, only the 8 bit Y
2239                  * bus is actually used. The UV bus is tied to ground.
2240                  * Therefore, the OV6630 needs to be in 8-bit multiplexed
2241                  * output mode */
2242
2243                 if (ov->sensor == SEN_OV6630 && ov->bridge == BRG_OV518
2244                     && ov518_color) {
2245                         i2c_w_mask(ov, 0x12, 0x10, 0x10);
2246                         i2c_w_mask(ov, 0x13, 0x20, 0x20);
2247                 } else {
2248                         i2c_w_mask(ov, 0x13, 0x00, 0x20);
2249                 }
2250         }
2251
2252         /******** Clock programming ********/
2253
2254         /* The OV6620 needs special handling. This prevents the 
2255          * severe banding that normally occurs */
2256         if (ov->sensor == SEN_OV6620 || ov->sensor == SEN_OV6630)
2257         {
2258                 /* Clock down */
2259
2260                 i2c_w(ov, 0x2a, 0x04);
2261
2262                 if (ov->compress) {
2263 //                      clock = 0;    /* This ensures the highest frame rate */
2264                         clock = 3;
2265                 } else if (clockdiv == -1) {   /* If user didn't override it */
2266                         clock = 3;    /* Gives better exposure time */
2267                 } else {
2268                         clock = clockdiv;
2269                 }
2270
2271                 PDEBUG(4, "Setting clock divisor to %d", clock);
2272
2273                 i2c_w(ov, 0x11, clock);
2274
2275                 i2c_w(ov, 0x2a, 0x84);
2276                 /* This next setting is critical. It seems to improve
2277                  * the gain or the contrast. The "reserved" bits seem
2278                  * to have some effect in this case. */
2279                 i2c_w(ov, 0x2d, 0x85);
2280         }
2281         else
2282         {
2283                 if (ov->compress) {
2284                         clock = 1;    /* This ensures the highest frame rate */
2285                 } else if (clockdiv == -1) {   /* If user didn't override it */
2286                         /* Calculate and set the clock divisor */
2287                         clock = ((sub_flag ? ov->subw * ov->subh
2288                                   : width * height)
2289                                  * (mode == VIDEO_PALETTE_GREY ? 2 : 3) / 2)
2290                                  / 66000;
2291                 } else {
2292                         clock = clockdiv;
2293                 }
2294
2295                 PDEBUG(4, "Setting clock divisor to %d", clock);
2296
2297                 i2c_w(ov, 0x11, clock);
2298         }
2299
2300         /******** Special Features ********/
2301
2302         if (framedrop >= 0)
2303                 i2c_w(ov, 0x16, framedrop);
2304
2305         /* Test Pattern */
2306         i2c_w_mask(ov, 0x12, (testpat?0x02:0x00), 0x02);
2307
2308         /* Enable auto white balance */
2309         i2c_w_mask(ov, 0x12, 0x04, 0x04);
2310
2311         // This will go away as soon as ov51x_mode_init_sensor_regs()
2312         // is fully tested.
2313         /* 7620/6620/6630? don't have register 0x35, so play it safe */
2314         if (ov->sensor == SEN_OV7610 || ov->sensor == SEN_OV76BE) {
2315                 if (width == 640 && height == 480)
2316                         i2c_w(ov, 0x35, 0x9e);
2317                 else
2318                         i2c_w(ov, 0x35, 0x1e);
2319         }
2320
2321         return 0;
2322 }
2323
2324 static int
2325 set_ov_sensor_window(struct usb_ov511 *ov, int width, int height, int mode,
2326                      int sub_flag)
2327 {
2328         int ret;
2329         int hwsbase, hwebase, vwsbase, vwebase, hwsize, vwsize; 
2330         int hoffset, voffset, hwscale = 0, vwscale = 0;
2331
2332         /* The different sensor ICs handle setting up of window differently.
2333          * IF YOU SET IT WRONG, YOU WILL GET ALL ZERO ISOC DATA FROM OV51x!!! */
2334         switch (ov->sensor) {
2335         case SEN_OV7610:
2336         case SEN_OV76BE:
2337                 hwsbase = 0x38;
2338                 hwebase = 0x3a;
2339                 vwsbase = vwebase = 0x05;
2340                 break;
2341         case SEN_OV6620:
2342         case SEN_OV6630:
2343                 hwsbase = 0x38;
2344                 hwebase = 0x3a;
2345                 vwsbase = 0x05;
2346                 vwebase = 0x06;
2347                 break;
2348         case SEN_OV7620:
2349                 hwsbase = 0x2f;         /* From 7620.SET (spec is wrong) */
2350                 hwebase = 0x2f;
2351                 vwsbase = vwebase = 0x05;
2352                 break;
2353         default:
2354                 err("Invalid sensor");
2355                 return -EINVAL;
2356         }
2357
2358         if (ov->sensor == SEN_OV6620 || ov->sensor == SEN_OV6630) {
2359                 /* Note: OV518(+) does downsample on its own) */
2360                 if ((width > 176 && height > 144)
2361                     || ov->bclass == BCL_OV518) {  /* CIF */
2362                         ret = mode_init_ov_sensor_regs(ov, width, height,
2363                                 mode, sub_flag, 0);
2364                         if (ret < 0)
2365                                 return ret;
2366                         hwscale = 1;
2367                         vwscale = 1;  /* The datasheet says 0; it's wrong */
2368                         hwsize = 352;
2369                         vwsize = 288;
2370                 } else if (width > 176 || height > 144) {
2371                         err("Illegal dimensions");
2372                         return -EINVAL;
2373                 } else {                            /* QCIF */
2374                         ret = mode_init_ov_sensor_regs(ov, width, height,
2375                                 mode, sub_flag, 1);
2376                         if (ret < 0)
2377                                 return ret;
2378                         hwsize = 176;
2379                         vwsize = 144;
2380                 }
2381         } else {
2382                 if (width > 320 && height > 240) {  /* VGA */
2383                         ret = mode_init_ov_sensor_regs(ov, width, height,
2384                                 mode, sub_flag, 0);
2385                         if (ret < 0)
2386                                 return ret;
2387                         hwscale = 2;
2388                         vwscale = 1;
2389                         hwsize = 640;
2390                         vwsize = 480;
2391                 } else if (width > 320 || height > 240) {
2392                         err("Illegal dimensions");
2393                         return -EINVAL;
2394                 } else {                            /* QVGA */
2395                         ret = mode_init_ov_sensor_regs(ov, width, height,
2396                                 mode, sub_flag, 1);
2397                         if (ret < 0)
2398                                 return ret;
2399                         hwscale = 1;
2400                         hwsize = 320;
2401                         vwsize = 240;
2402                 }
2403         }
2404
2405         /* Center the window */
2406         hoffset = ((hwsize - width) / 2) >> hwscale;
2407         voffset = ((vwsize - height) / 2) >> vwscale;
2408
2409         /* FIXME! - This needs to be changed to support 160x120 and 6620!!! */
2410         if (sub_flag) {
2411                 i2c_w(ov, 0x17, hwsbase+(ov->subx>>hwscale));
2412                 i2c_w(ov, 0x18, hwebase+((ov->subx+ov->subw)>>hwscale));
2413                 i2c_w(ov, 0x19, vwsbase+(ov->suby>>vwscale));
2414                 i2c_w(ov, 0x1a, vwebase+((ov->suby+ov->subh)>>vwscale));
2415         } else {
2416                 i2c_w(ov, 0x17, hwsbase + hoffset);
2417                 i2c_w(ov, 0x18, hwebase + hoffset + (hwsize>>hwscale));
2418                 i2c_w(ov, 0x19, vwsbase + voffset);
2419                 i2c_w(ov, 0x1a, vwebase + voffset + (vwsize>>vwscale));
2420         }
2421
2422 #ifdef OV511_DEBUG
2423         if (dump_sensor)
2424                 dump_i2c_regs(ov);
2425 #endif
2426
2427         return 0;
2428 }
2429
2430 /* Set up the OV511/OV511+ with the given image parameters.
2431  *
2432  * Do not put any sensor-specific code in here (including I2C I/O functions)
2433  */
2434 static int
2435 ov511_mode_init_regs(struct usb_ov511 *ov,
2436                      int width, int height, int mode, int sub_flag)
2437 {
2438         int hsegs, vsegs;
2439
2440         if (sub_flag) {
2441                 width = ov->subw;
2442                 height = ov->subh;
2443         }
2444
2445         PDEBUG(3, "width:%d, height:%d, mode:%d, sub:%d",
2446                width, height, mode, sub_flag);
2447
2448         // FIXME: This should be moved to a 7111a-specific function once
2449         // subcapture is dealt with properly
2450         if (ov->sensor == SEN_SAA7111A) {
2451                 if (width == 320 && height == 240) {
2452                         /* No need to do anything special */
2453                 } else if (width == 640 && height == 480) {
2454                         /* Set the OV511 up as 320x480, but keep the
2455                          * V4L resolution as 640x480 */
2456                         width = 320;
2457                 } else {
2458                         err("SAA7111A only allows 320x240 or 640x480");
2459                         return -EINVAL;
2460                 }
2461         }
2462
2463         /* Make sure width and height are a multiple of 8 */
2464         if (width % 8 || height % 8) {
2465                 err("Invalid size (%d, %d) (mode = %d)", width, height, mode);
2466                 return -EINVAL;
2467         }
2468
2469         if (width < ov->minwidth || height < ov->minheight) {
2470                 err("Requested dimensions are too small");
2471                 return -EINVAL;
2472         }
2473
2474         if (ov51x_stop(ov) < 0)
2475                 return -EIO;
2476
2477         if (mode == VIDEO_PALETTE_GREY) {
2478                 reg_w(ov, R511_CAM_UV_EN, 0x00);
2479                 reg_w(ov, R511_SNAP_UV_EN, 0x00);
2480                 reg_w(ov, R511_SNAP_OPTS, 0x01);
2481         } else {
2482                 reg_w(ov, R511_CAM_UV_EN, 0x01);
2483                 reg_w(ov, R511_SNAP_UV_EN, 0x01);
2484                 reg_w(ov, R511_SNAP_OPTS, 0x03);
2485         }
2486
2487         /* Here I'm assuming that snapshot size == image size.
2488          * I hope that's always true. --claudio
2489          */
2490         hsegs = (width >> 3) - 1;
2491         vsegs = (height >> 3) - 1;
2492
2493         reg_w(ov, R511_CAM_PXCNT, hsegs);
2494         reg_w(ov, R511_CAM_LNCNT, vsegs);
2495         reg_w(ov, R511_CAM_PXDIV, 0x00);
2496         reg_w(ov, R511_CAM_LNDIV, 0x00);
2497
2498         /* YUV420, low pass filter on */
2499         reg_w(ov, R511_CAM_OPTS, 0x03);
2500
2501         /* Snapshot additions */
2502         reg_w(ov, R511_SNAP_PXCNT, hsegs);
2503         reg_w(ov, R511_SNAP_LNCNT, vsegs);
2504         reg_w(ov, R511_SNAP_PXDIV, 0x00);
2505         reg_w(ov, R511_SNAP_LNDIV, 0x00);
2506
2507         if (ov->compress) {
2508                 /* Enable Y and UV quantization and compression */
2509                 reg_w(ov, R511_COMP_EN, 0x07);
2510                 reg_w(ov, R511_COMP_LUT_EN, 0x03);
2511                 ov51x_reset(ov, OV511_RESET_OMNICE);
2512         }
2513
2514         if (ov51x_restart(ov) < 0)
2515                 return -EIO;
2516
2517         return 0;
2518 }
2519
2520 /* Sets up the OV518/OV518+ with the given image parameters
2521  *
2522  * OV518 needs a completely different approach, until we can figure out what
2523  * the individual registers do. Also, only 15 FPS is supported now.
2524  *
2525  * Do not put any sensor-specific code in here (including I2C I/O functions)
2526  */
2527 static int
2528 ov518_mode_init_regs(struct usb_ov511 *ov,
2529                      int width, int height, int mode, int sub_flag)
2530 {
2531         int hsegs, vsegs, hi_res;
2532
2533         if (sub_flag) {
2534                 width = ov->subw;
2535                 height = ov->subh;
2536         }
2537
2538         PDEBUG(3, "width:%d, height:%d, mode:%d, sub:%d",
2539                width, height, mode, sub_flag);
2540
2541         if (width % 16 || height % 8) {
2542                 err("Invalid size (%d, %d)", width, height);
2543                 return -EINVAL;
2544         }
2545
2546         if (width < ov->minwidth || height < ov->minheight) {
2547                 err("Requested dimensions are too small");
2548                 return -EINVAL;
2549         }
2550
2551         if (width >= 320 && height >= 240) {
2552                 hi_res = 1;
2553         } else if (width >= 320 || height >= 240) {
2554                 err("Invalid width/height combination (%d, %d)", width, height);
2555                 return -EINVAL;
2556         } else {
2557                 hi_res = 0;
2558         }
2559
2560         if (ov51x_stop(ov) < 0)
2561                 return -EIO;
2562
2563         /******** Set the mode ********/
2564
2565         reg_w(ov, 0x2b, 0);
2566         reg_w(ov, 0x2c, 0);
2567         reg_w(ov, 0x2d, 0);
2568         reg_w(ov, 0x2e, 0);
2569         reg_w(ov, 0x3b, 0);
2570         reg_w(ov, 0x3c, 0);
2571         reg_w(ov, 0x3d, 0);
2572         reg_w(ov, 0x3e, 0);
2573
2574         if (ov->bridge == BRG_OV518 && ov518_color) {
2575                 /* OV518 needs U and V swapped */
2576                 i2c_w_mask(ov, 0x15, 0x00, 0x01);
2577
2578                 if (mode == VIDEO_PALETTE_GREY) {
2579                         /* Set 16-bit input format (UV data are ignored) */
2580                         reg_w_mask(ov, 0x20, 0x00, 0x08);
2581
2582                         /* Set 8-bit (4:0:0) output format */
2583                         reg_w_mask(ov, 0x28, 0x00, 0xf0);
2584                         reg_w_mask(ov, 0x38, 0x00, 0xf0);
2585                 } else {
2586                         /* Set 8-bit (YVYU) input format */
2587                         reg_w_mask(ov, 0x20, 0x08, 0x08);
2588
2589                         /* Set 12-bit (4:2:0) output format */
2590                         reg_w_mask(ov, 0x28, 0x80, 0xf0);
2591                         reg_w_mask(ov, 0x38, 0x80, 0xf0);
2592                 }
2593         } else {
2594                 reg_w(ov, 0x28, (mode == VIDEO_PALETTE_GREY) ? 0x00:0x80);
2595                 reg_w(ov, 0x38, (mode == VIDEO_PALETTE_GREY) ? 0x00:0x80);
2596         }
2597
2598         hsegs = width / 16;
2599         vsegs = height / 4;
2600
2601         reg_w(ov, 0x29, hsegs);
2602         reg_w(ov, 0x2a, vsegs);
2603
2604         reg_w(ov, 0x39, hsegs);
2605         reg_w(ov, 0x3a, vsegs);
2606
2607         /* Windows driver does this here; who knows why */
2608         reg_w(ov, 0x2f, 0x80);
2609
2610         /******** Set the framerate (to 15 FPS) ********/
2611
2612         /* Mode independent, but framerate dependent, regs */
2613         reg_w(ov, 0x51, 0x02);  /* Clock divider; lower==faster */
2614         reg_w(ov, 0x22, 0x18);
2615         reg_w(ov, 0x23, 0xff);
2616
2617         if (ov->bridge == BRG_OV518PLUS)
2618                 reg_w(ov, 0x21, 0x19);
2619         else
2620                 reg_w(ov, 0x71, 0x19);  /* Compression-related? */
2621
2622         // FIXME: Sensor-specific
2623         /* Bit 5 is what matters here. Of course, it is "reserved" */
2624         i2c_w(ov, 0x54, 0x23);
2625
2626         reg_w(ov, 0x2f, 0x80);
2627
2628         if (ov->bridge == BRG_OV518PLUS) {
2629                 reg_w(ov, 0x24, 0x94);
2630                 reg_w(ov, 0x25, 0x90);
2631                 ov518_reg_w32(ov, 0xc4,    400, 2);     /* 190h   */
2632                 ov518_reg_w32(ov, 0xc6,    540, 2);     /* 21ch   */
2633                 ov518_reg_w32(ov, 0xc7,    540, 2);     /* 21ch   */
2634                 ov518_reg_w32(ov, 0xc8,    108, 2);     /* 6ch    */
2635                 ov518_reg_w32(ov, 0xca, 131098, 3);     /* 2001ah */
2636                 ov518_reg_w32(ov, 0xcb,    532, 2);     /* 214h   */
2637                 ov518_reg_w32(ov, 0xcc,   2400, 2);     /* 960h   */
2638                 ov518_reg_w32(ov, 0xcd,     32, 2);     /* 20h    */
2639                 ov518_reg_w32(ov, 0xce,    608, 2);     /* 260h   */
2640         } else {
2641                 reg_w(ov, 0x24, 0x9f);
2642                 reg_w(ov, 0x25, 0x90);
2643                 ov518_reg_w32(ov, 0xc4,    400, 2);     /* 190h   */
2644                 ov518_reg_w32(ov, 0xc6,    500, 2);     /* 1f4h   */
2645                 ov518_reg_w32(ov, 0xc7,    500, 2);     /* 1f4h   */
2646                 ov518_reg_w32(ov, 0xc8,    142, 2);     /* 8eh    */
2647                 ov518_reg_w32(ov, 0xca, 131098, 3);     /* 2001ah */
2648                 ov518_reg_w32(ov, 0xcb,    532, 2);     /* 214h   */
2649                 ov518_reg_w32(ov, 0xcc,   2000, 2);     /* 7d0h   */
2650                 ov518_reg_w32(ov, 0xcd,     32, 2);     /* 20h    */
2651                 ov518_reg_w32(ov, 0xce,    608, 2);     /* 260h   */
2652         }
2653
2654         reg_w(ov, 0x2f, 0x80);
2655
2656         if (ov51x_restart(ov) < 0)
2657                 return -EIO;
2658
2659         /* Reset it just for good measure */
2660         if (ov51x_reset(ov, OV511_RESET_NOREGS) < 0)
2661                 return -EIO;
2662
2663         return 0;
2664 }
2665
2666 /* This is a wrapper around the OV511, OV518, and sensor specific functions */
2667 static int
2668 mode_init_regs(struct usb_ov511 *ov,
2669                int width, int height, int mode, int sub_flag)
2670 {
2671         int rc = 0;
2672
2673         if (!ov || !ov->dev)
2674                 return -EFAULT;
2675
2676         if (ov->bclass == BCL_OV518) {
2677                 rc = ov518_mode_init_regs(ov, width, height, mode, sub_flag);
2678         } else {
2679                 rc = ov511_mode_init_regs(ov, width, height, mode, sub_flag);
2680         }
2681
2682         if (FATAL_ERROR(rc))
2683                 return rc;
2684
2685         switch (ov->sensor) {
2686         case SEN_OV7610:
2687         case SEN_OV7620:
2688         case SEN_OV76BE:
2689         case SEN_OV8600:
2690         case SEN_OV6620:
2691         case SEN_OV6630:
2692                 rc = set_ov_sensor_window(ov, width, height, mode, sub_flag);
2693                 break;
2694         case SEN_KS0127:
2695         case SEN_KS0127B:
2696                 err("KS0127-series decoders not supported yet");
2697                 rc = -EINVAL;
2698                 break;
2699         case SEN_SAA7111A:
2700 //              rc = mode_init_saa_sensor_regs(ov, width, height, mode,
2701 //                                             sub_flag);
2702
2703                 PDEBUG(1, "SAA status = 0x%02X", i2c_r(ov, 0x1f));
2704                 break;
2705         default:
2706                 err("Unknown sensor");
2707                 rc = -EINVAL;
2708         }
2709
2710         if (FATAL_ERROR(rc))
2711                 return rc;
2712
2713         /* Sensor-independent settings */
2714         rc = sensor_set_auto_brightness(ov, ov->auto_brt);
2715         if (FATAL_ERROR(rc))
2716                 return rc;
2717
2718         rc = sensor_set_auto_exposure(ov, ov->auto_exp);
2719         if (FATAL_ERROR(rc))
2720                 return rc;
2721
2722         rc = sensor_set_banding_filter(ov, bandingfilter);
2723         if (FATAL_ERROR(rc))
2724                 return rc;
2725
2726         if (ov->lightfreq) {
2727                 rc = sensor_set_light_freq(ov, lightfreq);
2728                 if (FATAL_ERROR(rc))
2729                         return rc;
2730         }
2731
2732         rc = sensor_set_backlight(ov, ov->backlight);
2733         if (FATAL_ERROR(rc))
2734                 return rc;
2735
2736         rc = sensor_set_mirror(ov, ov->mirror);
2737         if (FATAL_ERROR(rc))
2738                 return rc;
2739
2740         return 0;
2741 }
2742
2743 /* This sets the default image parameters. This is useful for apps that use
2744  * read() and do not set these.
2745  */
2746 static int
2747 ov51x_set_default_params(struct usb_ov511 *ov)
2748 {
2749         int i;
2750
2751         /* Set default sizes in case IOCTL (VIDIOCMCAPTURE) is not used
2752          * (using read() instead). */
2753         for (i = 0; i < OV511_NUMFRAMES; i++) {
2754                 ov->frame[i].width = ov->maxwidth;
2755                 ov->frame[i].height = ov->maxheight;
2756                 ov->frame[i].bytes_read = 0;
2757                 if (force_palette)
2758                         ov->frame[i].format = force_palette;
2759                 else
2760                         ov->frame[i].format = VIDEO_PALETTE_YUV420;
2761
2762                 ov->frame[i].depth = get_depth(ov->frame[i].format);
2763         }
2764
2765         PDEBUG(3, "%dx%d, %s", ov->maxwidth, ov->maxheight,
2766                symbolic(v4l1_plist, ov->frame[0].format));
2767
2768         /* Initialize to max width/height, YUV420 or RGB24 (if supported) */
2769         if (mode_init_regs(ov, ov->maxwidth, ov->maxheight,
2770                            ov->frame[0].format, 0) < 0)
2771                 return -EINVAL;
2772
2773         return 0;
2774 }
2775
2776 /**********************************************************************
2777  *
2778  * Video decoder stuff
2779  *
2780  **********************************************************************/
2781
2782 /* Set analog input port of decoder */
2783 static int
2784 decoder_set_input(struct usb_ov511 *ov, int input)
2785 {
2786         PDEBUG(4, "port %d", input);
2787
2788         switch (ov->sensor) {
2789         case SEN_SAA7111A:
2790         {
2791                 /* Select mode */
2792                 i2c_w_mask(ov, 0x02, input, 0x07);
2793                 /* Bypass chrominance trap for modes 4..7 */
2794                 i2c_w_mask(ov, 0x09, (input > 3) ? 0x80:0x00, 0x80);
2795                 break;
2796         }
2797         default:
2798                 return -EINVAL;
2799         }
2800
2801         return 0;
2802 }
2803
2804 /* Get ASCII name of video input */
2805 static int
2806 decoder_get_input_name(struct usb_ov511 *ov, int input, char *name)
2807 {
2808         switch (ov->sensor) {
2809         case SEN_SAA7111A:
2810         {
2811                 if (input < 0 || input > 7)
2812                         return -EINVAL;
2813                 else if (input < 4)
2814                         sprintf(name, "CVBS-%d", input);
2815                 else // if (input < 8)
2816                         sprintf(name, "S-Video-%d", input - 4);
2817                 break;
2818         }
2819         default:
2820                 sprintf(name, "%s", "Camera");
2821         }
2822
2823         return 0;
2824 }
2825
2826 /* Set norm (NTSC, PAL, SECAM, AUTO) */
2827 static int
2828 decoder_set_norm(struct usb_ov511 *ov, int norm)
2829 {
2830         PDEBUG(4, "%d", norm);
2831
2832         switch (ov->sensor) {
2833         case SEN_SAA7111A:
2834         {
2835                 int reg_8, reg_e;
2836
2837                 if (norm == VIDEO_MODE_NTSC) {
2838                         reg_8 = 0x40;   /* 60 Hz */
2839                         reg_e = 0x00;   /* NTSC M / PAL BGHI */
2840                 } else if (norm == VIDEO_MODE_PAL) {
2841                         reg_8 = 0x00;   /* 50 Hz */
2842                         reg_e = 0x00;   /* NTSC M / PAL BGHI */
2843                 } else if (norm == VIDEO_MODE_AUTO) {
2844                         reg_8 = 0x80;   /* Auto field detect */
2845                         reg_e = 0x00;   /* NTSC M / PAL BGHI */
2846                 } else if (norm == VIDEO_MODE_SECAM) {
2847                         reg_8 = 0x00;   /* 50 Hz */
2848                         reg_e = 0x50;   /* SECAM / PAL 4.43 */
2849                 } else {
2850                         return -EINVAL;
2851                 }
2852
2853                 i2c_w_mask(ov, 0x08, reg_8, 0xc0);
2854                 i2c_w_mask(ov, 0x0e, reg_e, 0x70);
2855                 break;
2856         }
2857         default:
2858                 return -EINVAL;
2859         }
2860
2861         return 0;
2862 }
2863
2864 /**********************************************************************
2865  *
2866  * Raw data parsing
2867  *
2868  **********************************************************************/
2869
2870 /* Copies a 64-byte segment at pIn to an 8x8 block at pOut. The width of the
2871  * image at pOut is specified by w.
2872  */
2873 static inline void
2874 make_8x8(unsigned char *pIn, unsigned char *pOut, int w)
2875 {
2876         unsigned char *pOut1 = pOut;
2877         int x, y;
2878
2879         for (y = 0; y < 8; y++) {
2880                 pOut1 = pOut;
2881                 for (x = 0; x < 8; x++) {
2882                         *pOut1++ = *pIn++;
2883                 }
2884                 pOut += w;
2885         }
2886 }
2887
2888 /*
2889  * For RAW BW (YUV 4:0:0) images, data show up in 256 byte segments.
2890  * The segments represent 4 squares of 8x8 pixels as follows:
2891  *
2892  *      0  1 ...  7    64  65 ...  71   ...  192 193 ... 199
2893  *      8  9 ... 15    72  73 ...  79        200 201 ... 207
2894  *           ...              ...                    ...
2895  *     56 57 ... 63   120 121 ... 127        248 249 ... 255
2896  *
2897  */ 
2898 static void
2899 yuv400raw_to_yuv400p(struct ov511_frame *frame,
2900                      unsigned char *pIn0, unsigned char *pOut0)
2901 {
2902         int x, y;
2903         unsigned char *pIn, *pOut, *pOutLine;
2904
2905         /* Copy Y */
2906         pIn = pIn0;
2907         pOutLine = pOut0;
2908         for (y = 0; y < frame->rawheight - 1; y += 8) {
2909                 pOut = pOutLine;
2910                 for (x = 0; x < frame->rawwidth - 1; x += 8) {
2911                         make_8x8(pIn, pOut, frame->rawwidth);
2912                         pIn += 64;
2913                         pOut += 8;
2914                 }
2915                 pOutLine += 8 * frame->rawwidth;
2916         }
2917 }
2918
2919 /*
2920  * For YUV 4:2:0 images, the data show up in 384 byte segments.
2921  * The first 64 bytes of each segment are U, the next 64 are V.  The U and
2922  * V are arranged as follows:
2923  *
2924  *      0  1 ...  7
2925  *      8  9 ... 15
2926  *           ...   
2927  *     56 57 ... 63
2928  *
2929  * U and V are shipped at half resolution (1 U,V sample -> one 2x2 block).
2930  *
2931  * The next 256 bytes are full resolution Y data and represent 4 squares
2932  * of 8x8 pixels as follows:
2933  *
2934  *      0  1 ...  7    64  65 ...  71   ...  192 193 ... 199
2935  *      8  9 ... 15    72  73 ...  79        200 201 ... 207
2936  *           ...              ...                    ...
2937  *     56 57 ... 63   120 121 ... 127   ...  248 249 ... 255
2938  *
2939  * Note that the U and V data in one segment represent a 16 x 16 pixel
2940  * area, but the Y data represent a 32 x 8 pixel area. If the width is not an
2941  * even multiple of 32, the extra 8x8 blocks within a 32x8 block belong to the
2942  * next horizontal stripe.
2943  *
2944  * If dumppix module param is set, _parse_data just dumps the incoming segments,
2945  * verbatim, in order, into the frame. When used with vidcat -f ppm -s 640x480
2946  * this puts the data on the standard output and can be analyzed with the
2947  * parseppm.c utility I wrote.  That's a much faster way for figuring out how
2948  * these data are scrambled.
2949  */
2950
2951 /* Converts from raw, uncompressed segments at pIn0 to a YUV420P frame at pOut0.
2952  *
2953  * FIXME: Currently only handles width and height that are multiples of 16
2954  */
2955 static void
2956 yuv420raw_to_yuv420p(struct ov511_frame *frame,
2957                      unsigned char *pIn0, unsigned char *pOut0)
2958 {
2959         int k, x, y;
2960         unsigned char *pIn, *pOut, *pOutLine;
2961         const unsigned int a = frame->rawwidth * frame->rawheight;
2962         const unsigned int w = frame->rawwidth / 2;
2963
2964         /* Copy U and V */
2965         pIn = pIn0;
2966         pOutLine = pOut0 + a;
2967         for (y = 0; y < frame->rawheight - 1; y += 16) {
2968                 pOut = pOutLine;
2969                 for (x = 0; x < frame->rawwidth - 1; x += 16) {
2970                         make_8x8(pIn, pOut, w);
2971                         make_8x8(pIn + 64, pOut + a/4, w);
2972                         pIn += 384;
2973                         pOut += 8;
2974                 }
2975                 pOutLine += 8 * w;
2976         }
2977
2978         /* Copy Y */
2979         pIn = pIn0 + 128;
2980         pOutLine = pOut0;
2981         k = 0;
2982         for (y = 0; y < frame->rawheight - 1; y += 8) {
2983                 pOut = pOutLine;
2984                 for (x = 0; x < frame->rawwidth - 1; x += 8) {
2985                         make_8x8(pIn, pOut, frame->rawwidth);
2986                         pIn += 64;
2987                         pOut += 8;
2988                         if ((++k) > 3) {
2989                                 k = 0;
2990                                 pIn += 128;
2991                         }
2992                 }
2993                 pOutLine += 8 * frame->rawwidth;
2994         }
2995 }
2996
2997 /**********************************************************************
2998  *
2999  * Decompression
3000  *
3001  **********************************************************************/
3002
3003 static int
3004 request_decompressor(struct usb_ov511 *ov)
3005 {
3006         if (ov->bclass == BCL_OV511 || ov->bclass == BCL_OV518) {
3007                 err("No decompressor available");
3008         } else {
3009                 err("Unknown bridge");
3010         }
3011
3012         return -ENOSYS;
3013 }
3014
3015 static void
3016 decompress(struct usb_ov511 *ov, struct ov511_frame *frame,
3017            unsigned char *pIn0, unsigned char *pOut0)
3018 {
3019         if (!ov->decomp_ops)
3020                 if (request_decompressor(ov))
3021                         return;
3022
3023 }
3024
3025 /**********************************************************************
3026  *
3027  * Format conversion
3028  *
3029  **********************************************************************/
3030
3031 /* Fuses even and odd fields together, and doubles width.
3032  * INPUT: an odd field followed by an even field at pIn0, in YUV planar format
3033  * OUTPUT: a normal YUV planar image, with correct aspect ratio
3034  */
3035 static void
3036 deinterlace(struct ov511_frame *frame, int rawformat,
3037             unsigned char *pIn0, unsigned char *pOut0)
3038 {
3039         const int fieldheight = frame->rawheight / 2;
3040         const int fieldpix = fieldheight * frame->rawwidth;
3041         const int w = frame->width;
3042         int x, y;
3043         unsigned char *pInEven, *pInOdd, *pOut;
3044
3045         PDEBUG(5, "fieldheight=%d", fieldheight);
3046
3047         if (frame->rawheight != frame->height) {
3048                 err("invalid height");
3049                 return;
3050         }
3051
3052         if ((frame->rawwidth * 2) != frame->width) {
3053                 err("invalid width");
3054                 return;
3055         }
3056
3057         /* Y */
3058         pInOdd = pIn0;
3059         pInEven = pInOdd + fieldpix;
3060         pOut = pOut0;
3061         for (y = 0; y < fieldheight; y++) {
3062                 for (x = 0; x < frame->rawwidth; x++) {
3063                         *pOut = *pInEven;
3064                         *(pOut+1) = *pInEven++;
3065                         *(pOut+w) = *pInOdd;
3066                         *(pOut+w+1) = *pInOdd++;
3067                         pOut += 2;
3068                 }
3069                 pOut += w;
3070         }
3071
3072         if (rawformat == RAWFMT_YUV420) {
3073         /* U */
3074                 pInOdd = pIn0 + fieldpix * 2;
3075                 pInEven = pInOdd + fieldpix / 4;
3076                 for (y = 0; y < fieldheight / 2; y++) {
3077                         for (x = 0; x < frame->rawwidth / 2; x++) {
3078                                 *pOut = *pInEven;
3079                                 *(pOut+1) = *pInEven++;
3080                                 *(pOut+w/2) = *pInOdd;
3081                                 *(pOut+w/2+1) = *pInOdd++;
3082                                 pOut += 2;
3083                         }
3084                         pOut += w/2;
3085                 }
3086         /* V */
3087                 pInOdd = pIn0 + fieldpix * 2 + fieldpix / 2;
3088                 pInEven = pInOdd + fieldpix / 4;
3089                 for (y = 0; y < fieldheight / 2; y++) {
3090                         for (x = 0; x < frame->rawwidth / 2; x++) {
3091                                 *pOut = *pInEven;
3092                                 *(pOut+1) = *pInEven++;
3093                                 *(pOut+w/2) = *pInOdd;
3094                                 *(pOut+w/2+1) = *pInOdd++;
3095                                 pOut += 2;
3096                         }
3097                         pOut += w/2;
3098                 }
3099         }
3100 }
3101
3102 static void
3103 ov51x_postprocess_grey(struct usb_ov511 *ov, struct ov511_frame *frame)
3104 {
3105                 /* Deinterlace frame, if necessary */
3106                 if (ov->sensor == SEN_SAA7111A && frame->rawheight >= 480) {
3107                         if (frame->compressed)
3108                                 decompress(ov, frame, frame->rawdata,
3109                                                  frame->tempdata);
3110                         else
3111                                 yuv400raw_to_yuv400p(frame, frame->rawdata,
3112                                                      frame->tempdata);
3113
3114                         deinterlace(frame, RAWFMT_YUV400, frame->tempdata,
3115                                     frame->data);
3116                 } else {
3117                         if (frame->compressed)
3118                                 decompress(ov, frame, frame->rawdata,
3119                                                  frame->data);
3120                         else
3121                                 yuv400raw_to_yuv400p(frame, frame->rawdata,
3122                                                      frame->data);
3123                 }
3124 }
3125
3126 /* Process raw YUV420 data into standard YUV420P */
3127 static void
3128 ov51x_postprocess_yuv420(struct usb_ov511 *ov, struct ov511_frame *frame)
3129 {
3130         /* Deinterlace frame, if necessary */
3131         if (ov->sensor == SEN_SAA7111A && frame->rawheight >= 480) {
3132                 if (frame->compressed)
3133                         decompress(ov, frame, frame->rawdata, frame->tempdata);
3134                 else
3135                         yuv420raw_to_yuv420p(frame, frame->rawdata,
3136                                              frame->tempdata);
3137
3138                 deinterlace(frame, RAWFMT_YUV420, frame->tempdata,
3139                             frame->data);
3140         } else {
3141                 if (frame->compressed)
3142                         decompress(ov, frame, frame->rawdata, frame->data);
3143                 else
3144                         yuv420raw_to_yuv420p(frame, frame->rawdata,
3145                                              frame->data);
3146         }
3147 }
3148
3149 /* Post-processes the specified frame. This consists of:
3150  *      1. Decompress frame, if necessary
3151  *      2. Deinterlace frame and scale to proper size, if necessary
3152  *      3. Convert from YUV planar to destination format, if necessary
3153  *      4. Fix the RGB offset, if necessary
3154  */
3155 static void
3156 ov51x_postprocess(struct usb_ov511 *ov, struct ov511_frame *frame)
3157 {
3158         if (dumppix) {
3159                 memset(frame->data, 0,
3160                         MAX_DATA_SIZE(ov->maxwidth, ov->maxheight));
3161                 PDEBUG(4, "Dumping %d bytes", frame->bytes_recvd);
3162                 memcpy(frame->data, frame->rawdata, frame->bytes_recvd);
3163         } else {
3164                 switch (frame->format) {
3165                 case VIDEO_PALETTE_GREY:
3166                         ov51x_postprocess_grey(ov, frame);
3167                         break;
3168                 case VIDEO_PALETTE_YUV420:
3169                 case VIDEO_PALETTE_YUV420P:
3170                         ov51x_postprocess_yuv420(ov, frame);
3171                         break;
3172                 default:
3173                         err("Cannot convert data to %s",
3174                             symbolic(v4l1_plist, frame->format));
3175                 }
3176         }
3177 }
3178
3179 /**********************************************************************
3180  *
3181  * OV51x data transfer, IRQ handler
3182  *
3183  **********************************************************************/
3184
3185 static inline void
3186 ov511_move_data(struct usb_ov511 *ov, unsigned char *in, int n)
3187 {
3188         int num, offset;
3189         int pnum = in[ov->packet_size - 1];             /* Get packet number */
3190         int max_raw = MAX_RAW_DATA_SIZE(ov->maxwidth, ov->maxheight);
3191         struct ov511_frame *frame = &ov->frame[ov->curframe];
3192         struct timeval *ts;
3193
3194         /* SOF/EOF packets have 1st to 8th bytes zeroed and the 9th
3195          * byte non-zero. The EOF packet has image width/height in the
3196          * 10th and 11th bytes. The 9th byte is given as follows:
3197          *
3198          * bit 7: EOF
3199          *     6: compression enabled
3200          *     5: 422/420/400 modes
3201          *     4: 422/420/400 modes
3202          *     3: 1
3203          *     2: snapshot button on
3204          *     1: snapshot frame
3205          *     0: even/odd field
3206          */
3207
3208         if (printph) {
3209                 info("ph(%3d): %2x %2x %2x %2x %2x %2x %2x %2x %2x %2x %2x %2x",
3210                      pnum, in[0], in[1], in[2], in[3], in[4], in[5], in[6],
3211                      in[7], in[8], in[9], in[10], in[11]);
3212         }
3213
3214         /* Check for SOF/EOF packet */
3215         if ((in[0] | in[1] | in[2] | in[3] | in[4] | in[5] | in[6] | in[7]) ||
3216             (~in[8] & 0x08))
3217                 goto check_middle;
3218
3219         /* Frame end */
3220         if (in[8] & 0x80) {
3221                 ts = (struct timeval *)(frame->data
3222                       + MAX_FRAME_SIZE(ov->maxwidth, ov->maxheight));
3223                 do_gettimeofday(ts);
3224
3225                 /* Get the actual frame size from the EOF header */
3226                 frame->rawwidth = ((int)(in[9]) + 1) * 8;
3227                 frame->rawheight = ((int)(in[10]) + 1) * 8;
3228
3229                 PDEBUG(4, "Frame end, frame=%d, pnum=%d, w=%d, h=%d, recvd=%d",
3230                         ov->curframe, pnum, frame->rawwidth, frame->rawheight,
3231                         frame->bytes_recvd);
3232
3233                 /* Validate the header data */
3234                 RESTRICT_TO_RANGE(frame->rawwidth, ov->minwidth, ov->maxwidth);
3235                 RESTRICT_TO_RANGE(frame->rawheight, ov->minheight,
3236                                   ov->maxheight);
3237
3238                 /* Don't allow byte count to exceed buffer size */
3239                 RESTRICT_TO_RANGE(frame->bytes_recvd, 8, max_raw);
3240
3241                 if (frame->scanstate == STATE_LINES) {
3242                         int nextf;
3243
3244                         frame->grabstate = FRAME_DONE;
3245                         wake_up_interruptible(&frame->wq);
3246
3247                         /* If next frame is ready or grabbing,
3248                          * point to it */
3249                         nextf = (ov->curframe + 1) % OV511_NUMFRAMES;
3250                         if (ov->frame[nextf].grabstate == FRAME_READY
3251                             || ov->frame[nextf].grabstate == FRAME_GRABBING) {
3252                                 ov->curframe = nextf;
3253                                 ov->frame[nextf].scanstate = STATE_SCANNING;
3254                         } else {
3255                                 if (frame->grabstate == FRAME_DONE) {
3256                                         PDEBUG(4, "** Frame done **");
3257                                 } else {
3258                                         PDEBUG(4, "Frame not ready? state = %d",
3259                                                 ov->frame[nextf].grabstate);
3260                                 }
3261
3262                                 ov->curframe = -1;
3263                         }
3264                 } else {
3265                         PDEBUG(5, "Frame done, but not scanning");
3266                 }
3267                 /* Image corruption caused by misplaced frame->segment = 0
3268                  * fixed by carlosf@conectiva.com.br
3269                  */
3270         } else {
3271                 /* Frame start */
3272                 PDEBUG(4, "Frame start, framenum = %d", ov->curframe);
3273
3274                 /* Check to see if it's a snapshot frame */
3275                 /* FIXME?? Should the snapshot reset go here? Performance? */
3276                 if (in[8] & 0x02) {
3277                         frame->snapshot = 1;
3278                         PDEBUG(3, "snapshot detected");
3279                 }
3280
3281                 frame->scanstate = STATE_LINES;
3282                 frame->bytes_recvd = 0;
3283                 frame->compressed = in[8] & 0x40;
3284         }
3285
3286 check_middle:
3287         /* Are we in a frame? */
3288         if (frame->scanstate != STATE_LINES) {
3289                 PDEBUG(5, "Not in a frame; packet skipped");
3290                 return;
3291         }
3292
3293         /* If frame start, skip header */
3294         if (frame->bytes_recvd == 0)
3295                 offset = 9;
3296         else
3297                 offset = 0;
3298
3299         num = n - offset - 1;
3300
3301         /* Dump all data exactly as received */
3302         if (dumppix == 2) {
3303                 frame->bytes_recvd += n - 1;
3304                 if (frame->bytes_recvd <= max_raw)
3305                         memcpy(frame->rawdata + frame->bytes_recvd - (n - 1),
3306                                 in, n - 1);
3307                 else
3308                         PDEBUG(3, "Raw data buffer overrun!! (%d)",
3309                                 frame->bytes_recvd - max_raw);
3310         } else if (!frame->compressed && !remove_zeros) {
3311                 frame->bytes_recvd += num;
3312                 if (frame->bytes_recvd <= max_raw)
3313                         memcpy(frame->rawdata + frame->bytes_recvd - num,
3314                                 in + offset, num);
3315                 else
3316                         PDEBUG(3, "Raw data buffer overrun!! (%d)",
3317                                 frame->bytes_recvd - max_raw);
3318         } else { /* Remove all-zero FIFO lines (aligned 32-byte blocks) */
3319                 int b, read = 0, allzero, copied = 0;
3320                 if (offset) {
3321                         frame->bytes_recvd += 32 - offset;      // Bytes out
3322                         memcpy(frame->rawdata,  in + offset, 32 - offset);
3323                         read += 32;
3324                 }
3325
3326                 while (read < n - 1) {
3327                         allzero = 1;
3328                         for (b = 0; b < 32; b++) {
3329                                 if (in[read + b]) {
3330                                         allzero = 0;
3331                                         break;
3332                                 }
3333                         }
3334
3335                         if (allzero) {
3336                                 /* Don't copy it */
3337                         } else {
3338                                 if (frame->bytes_recvd + copied + 32 <= max_raw)
3339                                 {
3340                                         memcpy(frame->rawdata
3341                                                 + frame->bytes_recvd + copied,
3342                                                 in + read, 32);
3343                                         copied += 32;
3344                                 } else {
3345                                         PDEBUG(3, "Raw data buffer overrun!!");
3346                                 }
3347                         }
3348                         read += 32;
3349                 }
3350
3351                 frame->bytes_recvd += copied;
3352         }
3353 }
3354
3355 static inline void
3356 ov518_move_data(struct usb_ov511 *ov, unsigned char *in, int n)
3357 {
3358         int max_raw = MAX_RAW_DATA_SIZE(ov->maxwidth, ov->maxheight);
3359         struct ov511_frame *frame = &ov->frame[ov->curframe];
3360         struct timeval *ts;
3361
3362         /* Don't copy the packet number byte */
3363         if (ov->packet_numbering)
3364                 --n;
3365
3366         /* A false positive here is likely, until OVT gives me
3367          * the definitive SOF/EOF format */
3368         if ((!(in[0] | in[1] | in[2] | in[3] | in[5])) && in[6]) {
3369                 if (printph) {
3370                         info("ph: %2x %2x %2x %2x %2x %2x %2x %2x", in[0],
3371                              in[1], in[2], in[3], in[4], in[5], in[6], in[7]);
3372                 }
3373
3374                 if (frame->scanstate == STATE_LINES) {
3375                         PDEBUG(4, "Detected frame end/start");
3376                         goto eof;
3377                 } else { //scanstate == STATE_SCANNING
3378                         /* Frame start */
3379                         PDEBUG(4, "Frame start, framenum = %d", ov->curframe);
3380                         goto sof;
3381                 }
3382         } else {
3383                 goto check_middle;
3384         }
3385
3386 eof:
3387         ts = (struct timeval *)(frame->data
3388               + MAX_FRAME_SIZE(ov->maxwidth, ov->maxheight));
3389         do_gettimeofday(ts);
3390
3391         PDEBUG(4, "Frame end, curframe = %d, hw=%d, vw=%d, recvd=%d",
3392                 ov->curframe,
3393                 (int)(in[9]), (int)(in[10]), frame->bytes_recvd);
3394
3395         // FIXME: Since we don't know the header formats yet,
3396         // there is no way to know what the actual image size is
3397         frame->rawwidth = frame->width;
3398         frame->rawheight = frame->height;
3399
3400         /* Validate the header data */
3401         RESTRICT_TO_RANGE(frame->rawwidth, ov->minwidth, ov->maxwidth);
3402         RESTRICT_TO_RANGE(frame->rawheight, ov->minheight, ov->maxheight);
3403
3404         /* Don't allow byte count to exceed buffer size */
3405         RESTRICT_TO_RANGE(frame->bytes_recvd, 8, max_raw);
3406
3407         if (frame->scanstate == STATE_LINES) {
3408                 int nextf;
3409
3410                 frame->grabstate = FRAME_DONE;
3411                 wake_up_interruptible(&frame->wq);
3412
3413                 /* If next frame is ready or grabbing,
3414                  * point to it */
3415                 nextf = (ov->curframe + 1) % OV511_NUMFRAMES;
3416                 if (ov->frame[nextf].grabstate == FRAME_READY
3417                     || ov->frame[nextf].grabstate == FRAME_GRABBING) {
3418                         ov->curframe = nextf;
3419                         ov->frame[nextf].scanstate = STATE_SCANNING;
3420                         frame = &ov->frame[nextf];
3421                 } else {
3422                         if (frame->grabstate == FRAME_DONE) {
3423                                 PDEBUG(4, "** Frame done **");
3424                         } else {
3425                                 PDEBUG(4, "Frame not ready? state = %d",
3426                                        ov->frame[nextf].grabstate);
3427                         }
3428
3429                         ov->curframe = -1;
3430                         PDEBUG(4, "SOF dropped (no active frame)");
3431                         return;  /* Nowhere to store this frame */
3432                 }
3433         }
3434 sof:
3435         PDEBUG(4, "Starting capture on frame %d", frame->framenum);
3436
3437 // Snapshot not reverse-engineered yet.
3438 #if 0
3439         /* Check to see if it's a snapshot frame */
3440         /* FIXME?? Should the snapshot reset go here? Performance? */
3441         if (in[8] & 0x02) {
3442                 frame->snapshot = 1;
3443                 PDEBUG(3, "snapshot detected");
3444         }
3445 #endif
3446         frame->scanstate = STATE_LINES;
3447         frame->bytes_recvd = 0;
3448         frame->compressed = 1;
3449
3450 check_middle:
3451         /* Are we in a frame? */
3452         if (frame->scanstate != STATE_LINES) {
3453                 PDEBUG(4, "scanstate: no SOF yet");
3454                 return;
3455         }
3456
3457         /* Dump all data exactly as received */
3458         if (dumppix == 2) {
3459                 frame->bytes_recvd += n;
3460                 if (frame->bytes_recvd <= max_raw)
3461                         memcpy(frame->rawdata + frame->bytes_recvd - n, in, n);
3462                 else
3463                         PDEBUG(3, "Raw data buffer overrun!! (%d)",
3464                                 frame->bytes_recvd - max_raw);
3465         } else {
3466                 /* All incoming data are divided into 8-byte segments. If the
3467                  * segment contains all zero bytes, it must be skipped. These
3468                  * zero-segments allow the OV518 to mainain a constant data rate
3469                  * regardless of the effectiveness of the compression. Segments
3470                  * are aligned relative to the beginning of each isochronous
3471                  * packet. The first segment in each image is a header (the
3472                  * decompressor skips it later).
3473                  */
3474
3475                 int b, read = 0, allzero, copied = 0;
3476
3477                 while (read < n) {
3478                         allzero = 1;
3479                         for (b = 0; b < 8; b++) {
3480                                 if (in[read + b]) {
3481                                         allzero = 0;
3482                                         break;
3483                                 }
3484                         }
3485
3486                         if (allzero) {
3487                         /* Don't copy it */
3488                         } else {
3489                                 if (frame->bytes_recvd + copied + 8 <= max_raw)
3490                                 {
3491                                         memcpy(frame->rawdata
3492                                                 + frame->bytes_recvd + copied,
3493                                                 in + read, 8);
3494                                         copied += 8;
3495                                 } else {
3496                                         PDEBUG(3, "Raw data buffer overrun!!");
3497                                 }
3498                         }
3499                         read += 8;
3500                 }
3501                 frame->bytes_recvd += copied;
3502         }
3503 }
3504
3505 static void
3506 ov51x_isoc_irq(struct urb *urb, struct pt_regs *regs)
3507 {
3508         int i;
3509         struct usb_ov511 *ov;
3510         struct ov511_sbuf *sbuf;
3511
3512         if (!urb->context) {
3513                 PDEBUG(4, "no context");
3514                 return;
3515         }
3516
3517         sbuf = urb->context;
3518         ov = sbuf->ov;
3519
3520         if (!ov || !ov->dev || !ov->user) {
3521                 PDEBUG(4, "no device, or not open");
3522                 return;
3523         }
3524
3525         if (!ov->streaming) {
3526                 PDEBUG(4, "hmmm... not streaming, but got interrupt");
3527                 return;
3528         }
3529
3530         if (urb->status == -ENOENT || urb->status == -ECONNRESET) {
3531                 PDEBUG(4, "URB unlinked");
3532                 return;
3533         }
3534
3535         if (urb->status != -EINPROGRESS && urb->status != 0) {
3536                 err("ERROR: urb->status=%d: %s", urb->status,
3537                     symbolic(urb_errlist, urb->status));
3538         }
3539
3540         /* Copy the data received into our frame buffer */
3541         PDEBUG(5, "sbuf[%d]: Moving %d packets", sbuf->n,
3542                urb->number_of_packets);
3543         for (i = 0; i < urb->number_of_packets; i++) {
3544                 /* Warning: Don't call *_move_data() if no frame active! */
3545                 if (ov->curframe >= 0) {
3546                         int n = urb->iso_frame_desc[i].actual_length;
3547                         int st = urb->iso_frame_desc[i].status;
3548                         unsigned char *cdata;
3549
3550                         urb->iso_frame_desc[i].actual_length = 0;
3551                         urb->iso_frame_desc[i].status = 0;
3552
3553                         cdata = urb->transfer_buffer
3554                                 + urb->iso_frame_desc[i].offset;
3555
3556                         if (!n) {
3557                                 PDEBUG(4, "Zero-length packet");
3558                                 continue;
3559                         }
3560
3561                         if (st)
3562                                 PDEBUG(2, "data error: [%d] len=%d, status=%d",
3563                                        i, n, st);
3564
3565                         if (ov->bclass == BCL_OV511)
3566                                 ov511_move_data(ov, cdata, n);
3567                         else if (ov->bclass == BCL_OV518)
3568                                 ov518_move_data(ov, cdata, n);
3569                         else
3570                                 err("Unknown bridge device (%d)", ov->bridge);
3571
3572                 } else if (waitqueue_active(&ov->wq)) {
3573                         wake_up_interruptible(&ov->wq);
3574                 }
3575         }
3576
3577         /* Resubmit this URB */
3578         urb->dev = ov->dev;
3579         if ((i = usb_submit_urb(urb, GFP_ATOMIC)) != 0)
3580                 err("usb_submit_urb() ret %d", i);
3581
3582         return;
3583 }
3584
3585 /****************************************************************************
3586  *
3587  * Stream initialization and termination
3588  *
3589  ***************************************************************************/
3590
3591 static int
3592 ov51x_init_isoc(struct usb_ov511 *ov)
3593 {
3594         struct urb *urb;
3595         int fx, err, n, size;
3596
3597         PDEBUG(3, "*** Initializing capture ***");
3598
3599         ov->curframe = -1;
3600
3601         if (ov->bridge == BRG_OV511) {
3602                 if (cams == 1)
3603                         size = 993;
3604                 else if (cams == 2)
3605                         size = 513;
3606                 else if (cams == 3 || cams == 4)
3607                         size = 257;
3608                 else {
3609                         err("\"cams\" parameter too high!");
3610                         return -1;
3611                 }
3612         } else if (ov->bridge == BRG_OV511PLUS) {
3613                 if (cams == 1)
3614                         size = 961;
3615                 else if (cams == 2)
3616                         size = 513;
3617                 else if (cams == 3 || cams == 4)
3618                         size = 257;
3619                 else if (cams >= 5 && cams <= 8)
3620                         size = 129;
3621                 else if (cams >= 9 && cams <= 31)
3622                         size = 33;
3623                 else {
3624                         err("\"cams\" parameter too high!");
3625                         return -1;
3626                 }
3627         } else if (ov->bclass == BCL_OV518) {
3628                 if (cams == 1)
3629                         size = 896;
3630                 else if (cams == 2)
3631                         size = 512;
3632                 else if (cams == 3 || cams == 4)
3633                         size = 256;
3634                 else if (cams >= 5 && cams <= 8)
3635                         size = 128;
3636                 else {
3637                         err("\"cams\" parameter too high!");
3638                         return -1;
3639                 }
3640         } else {
3641                 err("invalid bridge type");
3642                 return -1;
3643         }
3644
3645         // FIXME: OV518 is hardcoded to 15 FPS (alternate 5) for now
3646         if (ov->bclass == BCL_OV518) {
3647                 if (packetsize == -1) {
3648                         ov518_set_packet_size(ov, 640);
3649                 } else {
3650                         info("Forcing packet size to %d", packetsize);
3651                         ov518_set_packet_size(ov, packetsize);
3652                 }
3653         } else {
3654                 if (packetsize == -1) {
3655                         ov511_set_packet_size(ov, size);
3656                 } else {
3657                         info("Forcing packet size to %d", packetsize);
3658                         ov511_set_packet_size(ov, packetsize);
3659                 }
3660         }
3661
3662         for (n = 0; n < OV511_NUMSBUF; n++) {
3663                 urb = usb_alloc_urb(FRAMES_PER_DESC, GFP_KERNEL);
3664                 if (!urb) {
3665                         err("init isoc: usb_alloc_urb ret. NULL");
3666                         return -ENOMEM;
3667                 }
3668                 ov->sbuf[n].urb = urb;
3669                 urb->dev = ov->dev;
3670                 urb->context = &ov->sbuf[n];
3671                 urb->pipe = usb_rcvisocpipe(ov->dev, OV511_ENDPOINT_ADDRESS);
3672                 urb->transfer_flags = URB_ISO_ASAP;
3673                 urb->transfer_buffer = ov->sbuf[n].data;
3674                 urb->complete = ov51x_isoc_irq;
3675                 urb->number_of_packets = FRAMES_PER_DESC;
3676                 urb->transfer_buffer_length = ov->packet_size * FRAMES_PER_DESC;
3677                 urb->interval = 1;
3678                 for (fx = 0; fx < FRAMES_PER_DESC; fx++) {
3679                         urb->iso_frame_desc[fx].offset = ov->packet_size * fx;
3680                         urb->iso_frame_desc[fx].length = ov->packet_size;
3681                 }
3682         }
3683
3684         ov->streaming = 1;
3685
3686         for (n = 0; n < OV511_NUMSBUF; n++) {
3687                 ov->sbuf[n].urb->dev = ov->dev;
3688                 err = usb_submit_urb(ov->sbuf[n].urb, GFP_KERNEL);
3689                 if (err) {
3690                         err("init isoc: usb_submit_urb(%d) ret %d", n, err);
3691                         return err;
3692                 }
3693         }
3694
3695         return 0;
3696 }
3697
3698 static void
3699 ov51x_unlink_isoc(struct usb_ov511 *ov)
3700 {
3701         int n;
3702
3703         /* Unschedule all of the iso td's */
3704         for (n = OV511_NUMSBUF - 1; n >= 0; n--) {
3705                 if (ov->sbuf[n].urb) {
3706                         usb_kill_urb(ov->sbuf[n].urb);
3707                         usb_free_urb(ov->sbuf[n].urb);
3708                         ov->sbuf[n].urb = NULL;
3709                 }
3710         }
3711 }
3712
3713 static void
3714 ov51x_stop_isoc(struct usb_ov511 *ov)
3715 {
3716         if (!ov->streaming || !ov->dev)
3717                 return;
3718
3719         PDEBUG(3, "*** Stopping capture ***");
3720
3721         if (ov->bclass == BCL_OV518)
3722                 ov518_set_packet_size(ov, 0);
3723         else
3724                 ov511_set_packet_size(ov, 0);
3725
3726         ov->streaming = 0;
3727
3728         ov51x_unlink_isoc(ov);
3729 }
3730
3731 static int
3732 ov51x_new_frame(struct usb_ov511 *ov, int framenum)
3733 {
3734         struct ov511_frame *frame;
3735         int newnum;
3736
3737         PDEBUG(4, "ov->curframe = %d, framenum = %d", ov->curframe, framenum);
3738
3739         if (!ov->dev)
3740                 return -1;
3741
3742         /* If we're not grabbing a frame right now and the other frame is */
3743         /* ready to be grabbed into, then use it instead */
3744         if (ov->curframe == -1) {
3745                 newnum = (framenum - 1 + OV511_NUMFRAMES) % OV511_NUMFRAMES;
3746                 if (ov->frame[newnum].grabstate == FRAME_READY)
3747                         framenum = newnum;
3748         } else
3749                 return 0;
3750
3751         frame = &ov->frame[framenum];
3752
3753         PDEBUG(4, "framenum = %d, width = %d, height = %d", framenum,
3754                frame->width, frame->height);
3755
3756         frame->grabstate = FRAME_GRABBING;
3757         frame->scanstate = STATE_SCANNING;
3758         frame->snapshot = 0;
3759
3760         ov->curframe = framenum;
3761
3762         /* Make sure it's not too big */
3763         if (frame->width > ov->maxwidth)
3764                 frame->width = ov->maxwidth;
3765
3766         frame->width &= ~7L;            /* Multiple of 8 */
3767
3768         if (frame->height > ov->maxheight)
3769                 frame->height = ov->maxheight;
3770
3771         frame->height &= ~3L;           /* Multiple of 4 */
3772
3773         return 0;
3774 }
3775
3776 /****************************************************************************
3777  *
3778  * Buffer management
3779  *
3780  ***************************************************************************/
3781
3782 /*
3783  * - You must acquire buf_lock before entering this function.
3784  * - Because this code will free any non-null pointer, you must be sure to null
3785  *   them if you explicitly free them somewhere else!
3786  */
3787 static void
3788 ov51x_do_dealloc(struct usb_ov511 *ov)
3789 {
3790         int i;
3791         PDEBUG(4, "entered");
3792
3793         if (ov->fbuf) {
3794                 rvfree(ov->fbuf, OV511_NUMFRAMES
3795                        * MAX_DATA_SIZE(ov->maxwidth, ov->maxheight));
3796                 ov->fbuf = NULL;
3797         }
3798
3799         vfree(ov->rawfbuf);
3800         ov->rawfbuf = NULL;
3801
3802         vfree(ov->tempfbuf);
3803         ov->tempfbuf = NULL;
3804
3805         for (i = 0; i < OV511_NUMSBUF; i++) {
3806                 kfree(ov->sbuf[i].data);
3807                 ov->sbuf[i].data = NULL;
3808         }
3809
3810         for (i = 0; i < OV511_NUMFRAMES; i++) {
3811                 ov->frame[i].data = NULL;
3812                 ov->frame[i].rawdata = NULL;
3813                 ov->frame[i].tempdata = NULL;
3814                 if (ov->frame[i].compbuf) {
3815                         free_page((unsigned long) ov->frame[i].compbuf);
3816                         ov->frame[i].compbuf = NULL;
3817                 }
3818         }
3819
3820         PDEBUG(4, "buffer memory deallocated");
3821         ov->buf_state = BUF_NOT_ALLOCATED;
3822         PDEBUG(4, "leaving");
3823 }
3824
3825 static int
3826 ov51x_alloc(struct usb_ov511 *ov)
3827 {
3828         int i;
3829         const int w = ov->maxwidth;
3830         const int h = ov->maxheight;
3831         const int data_bufsize = OV511_NUMFRAMES * MAX_DATA_SIZE(w, h);
3832         const int raw_bufsize = OV511_NUMFRAMES * MAX_RAW_DATA_SIZE(w, h);
3833
3834         PDEBUG(4, "entered");
3835         mutex_lock(&ov->buf_lock);
3836
3837         if (ov->buf_state == BUF_ALLOCATED)
3838                 goto out;
3839
3840         ov->fbuf = rvmalloc(data_bufsize);
3841         if (!ov->fbuf)
3842                 goto error;
3843
3844         ov->rawfbuf = vmalloc(raw_bufsize);
3845         if (!ov->rawfbuf)
3846                 goto error;
3847
3848         memset(ov->rawfbuf, 0, raw_bufsize);
3849
3850         ov->tempfbuf = vmalloc(raw_bufsize);
3851         if (!ov->tempfbuf)
3852                 goto error;
3853
3854         memset(ov->tempfbuf, 0, raw_bufsize);
3855
3856         for (i = 0; i < OV511_NUMSBUF; i++) {
3857                 ov->sbuf[i].data = kmalloc(FRAMES_PER_DESC *
3858                         MAX_FRAME_SIZE_PER_DESC, GFP_KERNEL);
3859                 if (!ov->sbuf[i].data)
3860                         goto error;
3861
3862                 PDEBUG(4, "sbuf[%d] @ %p", i, ov->sbuf[i].data);
3863         }
3864
3865         for (i = 0; i < OV511_NUMFRAMES; i++) {
3866                 ov->frame[i].data = ov->fbuf + i * MAX_DATA_SIZE(w, h);
3867                 ov->frame[i].rawdata = ov->rawfbuf
3868                  + i * MAX_RAW_DATA_SIZE(w, h);
3869                 ov->frame[i].tempdata = ov->tempfbuf
3870                  + i * MAX_RAW_DATA_SIZE(w, h);
3871
3872                 ov->frame[i].compbuf =
3873                  (unsigned char *) __get_free_page(GFP_KERNEL);
3874                 if (!ov->frame[i].compbuf)
3875                         goto error;
3876
3877                 PDEBUG(4, "frame[%d] @ %p", i, ov->frame[i].data);
3878         }
3879
3880         ov->buf_state = BUF_ALLOCATED;
3881 out:
3882         mutex_unlock(&ov->buf_lock);
3883         PDEBUG(4, "leaving");
3884         return 0;
3885 error:
3886         ov51x_do_dealloc(ov);
3887         mutex_unlock(&ov->buf_lock);
3888         PDEBUG(4, "errored");
3889         return -ENOMEM;
3890 }
3891
3892 static void
3893 ov51x_dealloc(struct usb_ov511 *ov)
3894 {
3895         PDEBUG(4, "entered");
3896         mutex_lock(&ov->buf_lock);
3897         ov51x_do_dealloc(ov);
3898         mutex_unlock(&ov->buf_lock);
3899         PDEBUG(4, "leaving");
3900 }
3901
3902 /****************************************************************************
3903  *
3904  * V4L 1 API
3905  *
3906  ***************************************************************************/
3907
3908 static int
3909 ov51x_v4l1_open(struct inode *inode, struct file *file)
3910 {
3911         struct video_device *vdev = video_devdata(file);
3912         struct usb_ov511 *ov = video_get_drvdata(vdev);
3913         int err, i;
3914
3915         PDEBUG(4, "opening");
3916
3917         mutex_lock(&ov->lock);
3918
3919         err = -EBUSY;
3920         if (ov->user)
3921                 goto out;
3922
3923         ov->sub_flag = 0;
3924
3925         /* In case app doesn't set them... */
3926         err = ov51x_set_default_params(ov);
3927         if (err < 0)
3928                 goto out;
3929
3930         /* Make sure frames are reset */
3931         for (i = 0; i < OV511_NUMFRAMES; i++) {
3932                 ov->frame[i].grabstate = FRAME_UNUSED;
3933                 ov->frame[i].bytes_read = 0;
3934         }
3935
3936         /* If compression is on, make sure now that a
3937          * decompressor can be loaded */
3938         if (ov->compress && !ov->decomp_ops) {
3939                 err = request_decompressor(ov);
3940                 if (err && !dumppix)
3941                         goto out;
3942         }
3943
3944         err = ov51x_alloc(ov);
3945         if (err < 0)
3946                 goto out;
3947
3948         err = ov51x_init_isoc(ov);
3949         if (err) {
3950                 ov51x_dealloc(ov);
3951                 goto out;
3952         }
3953
3954         ov->user++;
3955         file->private_data = vdev;
3956
3957         if (ov->led_policy == LED_AUTO)
3958                 ov51x_led_control(ov, 1);
3959
3960 out:
3961         mutex_unlock(&ov->lock);
3962         return err;
3963 }
3964
3965 static int
3966 ov51x_v4l1_close(struct inode *inode, struct file *file)
3967 {
3968         struct video_device *vdev = file->private_data;
3969         struct usb_ov511 *ov = video_get_drvdata(vdev);
3970
3971         PDEBUG(4, "ov511_close");
3972
3973         mutex_lock(&ov->lock);
3974
3975         ov->user--;
3976         ov51x_stop_isoc(ov);
3977
3978         if (ov->led_policy == LED_AUTO)
3979                 ov51x_led_control(ov, 0);
3980
3981         if (ov->dev)
3982                 ov51x_dealloc(ov);
3983
3984         mutex_unlock(&ov->lock);
3985
3986         /* Device unplugged while open. Only a minimum of unregistration is done
3987          * here; the disconnect callback already did the rest. */
3988         if (!ov->dev) {
3989                 mutex_lock(&ov->cbuf_lock);
3990                 kfree(ov->cbuf);
3991                 ov->cbuf = NULL;
3992                 mutex_unlock(&ov->cbuf_lock);
3993
3994                 ov51x_dealloc(ov);
3995                 kfree(ov);
3996                 ov = NULL;
3997         }
3998
3999         file->private_data = NULL;
4000         return 0;
4001 }
4002
4003 /* Do not call this function directly! */
4004 static int
4005 ov51x_v4l1_ioctl_internal(struct inode *inode, struct file *file,
4006                           unsigned int cmd, void *arg)
4007 {
4008         struct video_device *vdev = file->private_data;
4009         struct usb_ov511 *ov = video_get_drvdata(vdev);
4010         PDEBUG(5, "IOCtl: 0x%X", cmd);
4011
4012         if (!ov->dev)
4013                 return -EIO;
4014
4015         switch (cmd) {
4016         case VIDIOCGCAP:
4017         {
4018                 struct video_capability *b = arg;
4019
4020                 PDEBUG(4, "VIDIOCGCAP");
4021
4022                 memset(b, 0, sizeof(struct video_capability));
4023                 sprintf(b->name, "%s USB Camera",
4024                         symbolic(brglist, ov->bridge));
4025                 b->type = VID_TYPE_CAPTURE | VID_TYPE_SUBCAPTURE;
4026                 b->channels = ov->num_inputs;
4027                 b->audios = 0;
4028                 b->maxwidth = ov->maxwidth;
4029                 b->maxheight = ov->maxheight;
4030                 b->minwidth = ov->minwidth;
4031                 b->minheight = ov->minheight;
4032
4033                 return 0;
4034         }
4035         case VIDIOCGCHAN:
4036         {
4037                 struct video_channel *v = arg;
4038
4039                 PDEBUG(4, "VIDIOCGCHAN");
4040
4041                 if ((unsigned)(v->channel) >= ov->num_inputs) {
4042                         err("Invalid channel (%d)", v->channel);
4043                         return -EINVAL;
4044                 }
4045
4046                 v->norm = ov->norm;
4047                 v->type = VIDEO_TYPE_CAMERA;
4048                 v->flags = 0;
4049 //              v->flags |= (ov->has_decoder) ? VIDEO_VC_NORM : 0;
4050                 v->tuners = 0;
4051                 decoder_get_input_name(ov, v->channel, v->name);
4052
4053                 return 0;
4054         }
4055         case VIDIOCSCHAN:
4056         {
4057                 struct video_channel *v = arg;
4058                 int err;
4059
4060                 PDEBUG(4, "VIDIOCSCHAN");
4061
4062                 /* Make sure it's not a camera */
4063                 if (!ov->has_decoder) {
4064                         if (v->channel == 0)
4065                                 return 0;
4066                         else
4067                                 return -EINVAL;
4068                 }
4069
4070                 if (v->norm != VIDEO_MODE_PAL &&
4071                     v->norm != VIDEO_MODE_NTSC &&
4072                     v->norm != VIDEO_MODE_SECAM &&
4073                     v->norm != VIDEO_MODE_AUTO) {
4074                         err("Invalid norm (%d)", v->norm);
4075                         return -EINVAL;
4076                 }
4077
4078                 if ((unsigned)(v->channel) >= ov->num_inputs) {
4079                         err("Invalid channel (%d)", v->channel);
4080                         return -EINVAL;
4081                 }
4082
4083                 err = decoder_set_input(ov, v->channel);
4084                 if (err)
4085                         return err;
4086
4087                 err = decoder_set_norm(ov, v->norm);
4088                 if (err)
4089                         return err;
4090
4091                 return 0;
4092         }
4093         case VIDIOCGPICT:
4094         {
4095                 struct video_picture *p = arg;
4096
4097                 PDEBUG(4, "VIDIOCGPICT");
4098
4099                 memset(p, 0, sizeof(struct video_picture));
4100                 if (sensor_get_picture(ov, p))
4101                         return -EIO;
4102
4103                 /* Can we get these from frame[0]? -claudio? */
4104                 p->depth = ov->frame[0].depth;
4105                 p->palette = ov->frame[0].format;
4106
4107                 return 0;
4108         }
4109         case VIDIOCSPICT:
4110         {
4111                 struct video_picture *p = arg;
4112                 int i, rc;
4113
4114                 PDEBUG(4, "VIDIOCSPICT");
4115
4116                 if (!get_depth(p->palette))
4117                         return -EINVAL;
4118
4119                 if (sensor_set_picture(ov, p))
4120                         return -EIO;
4121
4122                 if (force_palette && p->palette != force_palette) {
4123                         info("Palette rejected (%s)",
4124                              symbolic(v4l1_plist, p->palette));
4125                         return -EINVAL;
4126                 }
4127
4128                 // FIXME: Format should be independent of frames
4129                 if (p->palette != ov->frame[0].format) {
4130                         PDEBUG(4, "Detected format change");
4131
4132                         rc = ov51x_wait_frames_inactive(ov);
4133                         if (rc)
4134                                 return rc;
4135
4136                         mode_init_regs(ov, ov->frame[0].width,
4137                                 ov->frame[0].height, p->palette, ov->sub_flag);
4138                 }
4139
4140                 PDEBUG(4, "Setting depth=%d, palette=%s",
4141                        p->depth, symbolic(v4l1_plist, p->palette));
4142
4143                 for (i = 0; i < OV511_NUMFRAMES; i++) {
4144                         ov->frame[i].depth = p->depth;
4145                         ov->frame[i].format = p->palette;
4146                 }
4147
4148                 return 0;
4149         }
4150         case VIDIOCGCAPTURE:
4151         {
4152                 int *vf = arg;
4153
4154                 PDEBUG(4, "VIDIOCGCAPTURE");
4155
4156                 ov->sub_flag = *vf;
4157                 return 0;
4158         }
4159         case VIDIOCSCAPTURE:
4160         {
4161                 struct video_capture *vc = arg;
4162
4163                 PDEBUG(4, "VIDIOCSCAPTURE");
4164
4165                 if (vc->flags)
4166                         return -EINVAL;
4167                 if (vc->decimation)
4168                         return -EINVAL;
4169
4170                 vc->x &= ~3L;
4171                 vc->y &= ~1L;
4172                 vc->y &= ~31L;
4173
4174                 if (vc->width == 0)
4175                         vc->width = 32;
4176
4177                 vc->height /= 16;
4178                 vc->height *= 16;
4179                 if (vc->height == 0)
4180                         vc->height = 16;
4181
4182                 ov->subx = vc->x;
4183                 ov->suby = vc->y;
4184                 ov->subw = vc->width;
4185                 ov->subh = vc->height;
4186
4187                 return 0;
4188         }
4189         case VIDIOCSWIN:
4190         {
4191                 struct video_window *vw = arg;
4192                 int i, rc;
4193
4194                 PDEBUG(4, "VIDIOCSWIN: %dx%d", vw->width, vw->height);
4195
4196 #if 0
4197                 if (vw->flags)
4198                         return -EINVAL;
4199                 if (vw->clipcount)
4200                         return -EINVAL;
4201                 if (vw->height != ov->maxheight)
4202                         return -EINVAL;
4203                 if (vw->width != ov->maxwidth)
4204                         return -EINVAL;
4205 #endif
4206
4207                 rc = ov51x_wait_frames_inactive(ov);
4208                 if (rc)
4209                         return rc;
4210
4211                 rc = mode_init_regs(ov, vw->width, vw->height,
4212                         ov->frame[0].format, ov->sub_flag);
4213                 if (rc < 0)
4214                         return rc;
4215
4216                 for (i = 0; i < OV511_NUMFRAMES; i++) {
4217                         ov->frame[i].width = vw->width;
4218                         ov->frame[i].height = vw->height;
4219                 }
4220
4221                 return 0;
4222         }
4223         case VIDIOCGWIN:
4224         {
4225                 struct video_window *vw = arg;
4226
4227                 memset(vw, 0, sizeof(struct video_window));
4228                 vw->x = 0;              /* FIXME */
4229                 vw->y = 0;
4230                 vw->width = ov->frame[0].width;
4231                 vw->height = ov->frame[0].height;
4232                 vw->flags = 30;
4233
4234                 PDEBUG(4, "VIDIOCGWIN: %dx%d", vw->width, vw->height);
4235
4236                 return 0;
4237         }
4238         case VIDIOCGMBUF:
4239         {
4240                 struct video_mbuf *vm = arg;
4241                 int i;
4242
4243                 PDEBUG(4, "VIDIOCGMBUF");
4244
4245                 memset(vm, 0, sizeof(struct video_mbuf));
4246                 vm->size = OV511_NUMFRAMES
4247                            * MAX_DATA_SIZE(ov->maxwidth, ov->maxheight);
4248                 vm->frames = OV511_NUMFRAMES;
4249
4250                 vm->offsets[0] = 0;
4251                 for (i = 1; i < OV511_NUMFRAMES; i++) {
4252                         vm->offsets[i] = vm->offsets[i-1]
4253                            + MAX_DATA_SIZE(ov->maxwidth, ov->maxheight);
4254                 }
4255
4256                 return 0;
4257         }
4258         case VIDIOCMCAPTURE:
4259         {
4260                 struct video_mmap *vm = arg;
4261                 int rc, depth;
4262                 unsigned int f = vm->frame;
4263
4264                 PDEBUG(4, "VIDIOCMCAPTURE: frame: %d, %dx%d, %s", f, vm->width,
4265                         vm->height, symbolic(v4l1_plist, vm->format));
4266
4267                 depth = get_depth(vm->format);
4268                 if (!depth) {
4269                         PDEBUG(2, "VIDIOCMCAPTURE: invalid format (%s)",
4270                                symbolic(v4l1_plist, vm->format));
4271                         return -EINVAL;
4272                 }
4273
4274                 if (f >= OV511_NUMFRAMES) {
4275                         err("VIDIOCMCAPTURE: invalid frame (%d)", f);
4276                         return -EINVAL;
4277                 }
4278
4279                 if (vm->width > ov->maxwidth
4280                     || vm->height > ov->maxheight) {
4281                         err("VIDIOCMCAPTURE: requested dimensions too big");
4282                         return -EINVAL;
4283                 }
4284
4285                 if (ov->frame[f].grabstate == FRAME_GRABBING) {
4286                         PDEBUG(4, "VIDIOCMCAPTURE: already grabbing");
4287                         return -EBUSY;
4288                 }
4289
4290                 if (force_palette && (vm->format != force_palette)) {
4291                         PDEBUG(2, "palette rejected (%s)",
4292                                symbolic(v4l1_plist, vm->format));
4293                         return -EINVAL;
4294                 }
4295
4296                 if ((ov->frame[f].width != vm->width) ||
4297                     (ov->frame[f].height != vm->height) ||
4298                     (ov->frame[f].format != vm->format) ||
4299                     (ov->frame[f].sub_flag != ov->sub_flag) ||
4300                     (ov->frame[f].depth != depth)) {
4301                         PDEBUG(4, "VIDIOCMCAPTURE: change in image parameters");
4302
4303                         rc = ov51x_wait_frames_inactive(ov);
4304                         if (rc)
4305                                 return rc;
4306
4307                         rc = mode_init_regs(ov, vm->width, vm->height,
4308                                 vm->format, ov->sub_flag);
4309 #if 0
4310                         if (rc < 0) {
4311                                 PDEBUG(1, "Got error while initializing regs ");
4312                                 return ret;
4313                         }
4314 #endif
4315                         ov->frame[f].width = vm->width;
4316                         ov->frame[f].height = vm->height;
4317                         ov->frame[f].format = vm->format;
4318                         ov->frame[f].sub_flag = ov->sub_flag;
4319                         ov->frame[f].depth = depth;
4320                 }
4321
4322                 /* Mark it as ready */
4323                 ov->frame[f].grabstate = FRAME_READY;
4324
4325                 PDEBUG(4, "VIDIOCMCAPTURE: renewing frame %d", f);
4326
4327                 return ov51x_new_frame(ov, f);
4328         }
4329         case VIDIOCSYNC:
4330         {
4331                 unsigned int fnum = *((unsigned int *) arg);
4332                 struct ov511_frame *frame;
4333                 int rc;
4334
4335                 if (fnum >= OV511_NUMFRAMES) {
4336                         err("VIDIOCSYNC: invalid frame (%d)", fnum);
4337                         return -EINVAL;
4338                 }
4339
4340                 frame = &ov->frame[fnum];
4341
4342                 PDEBUG(4, "syncing to frame %d, grabstate = %d", fnum,
4343                        frame->grabstate);
4344
4345                 switch (frame->grabstate) {
4346                 case FRAME_UNUSED:
4347                         return -EINVAL;
4348                 case FRAME_READY:
4349                 case FRAME_GRABBING:
4350                 case FRAME_ERROR:
4351 redo:
4352                         if (!ov->dev)
4353                                 return -EIO;
4354
4355                         rc = wait_event_interruptible(frame->wq,
4356                             (frame->grabstate == FRAME_DONE)
4357                             || (frame->grabstate == FRAME_ERROR));
4358
4359                         if (rc)
4360                                 return rc;
4361
4362                         if (frame->grabstate == FRAME_ERROR) {
4363                                 if ((rc = ov51x_new_frame(ov, fnum)) < 0)
4364                                         return rc;
4365                                 goto redo;
4366                         }
4367                         /* Fall through */
4368                 case FRAME_DONE:
4369                         if (ov->snap_enabled && !frame->snapshot) {
4370                                 if ((rc = ov51x_new_frame(ov, fnum)) < 0)
4371                                         return rc;
4372                                 goto redo;
4373                         }
4374
4375                         frame->grabstate = FRAME_UNUSED;
4376
4377                         /* Reset the hardware snapshot button */
4378                         /* FIXME - Is this the best place for this? */
4379                         if ((ov->snap_enabled) && (frame->snapshot)) {
4380                                 frame->snapshot = 0;
4381                                 ov51x_clear_snapshot(ov);
4382                         }
4383
4384                         /* Decompression, format conversion, etc... */
4385                         ov51x_postprocess(ov, frame);
4386
4387                         break;
4388                 } /* end switch */
4389
4390                 return 0;
4391         }
4392         case VIDIOCGFBUF:
4393         {
4394                 struct video_buffer *vb = arg;
4395
4396                 PDEBUG(4, "VIDIOCGFBUF");
4397
4398                 memset(vb, 0, sizeof(struct video_buffer));
4399
4400                 return 0;
4401         }
4402         case VIDIOCGUNIT:
4403         {
4404                 struct video_unit *vu = arg;
4405
4406                 PDEBUG(4, "VIDIOCGUNIT");
4407
4408                 memset(vu, 0, sizeof(struct video_unit));
4409
4410                 vu->video = ov->vdev->minor;
4411                 vu->vbi = VIDEO_NO_UNIT;
4412                 vu->radio = VIDEO_NO_UNIT;
4413                 vu->audio = VIDEO_NO_UNIT;
4414                 vu->teletext = VIDEO_NO_UNIT;
4415
4416                 return 0;
4417         }
4418         case OV511IOC_WI2C:
4419         {
4420                 struct ov511_i2c_struct *w = arg;
4421
4422                 return i2c_w_slave(ov, w->slave, w->reg, w->value, w->mask);
4423         }
4424         case OV511IOC_RI2C:
4425         {
4426                 struct ov511_i2c_struct *r = arg;
4427                 int rc;
4428
4429                 rc = i2c_r_slave(ov, r->slave, r->reg);
4430                 if (rc < 0)
4431                         return rc;
4432
4433                 r->value = rc;
4434                 return 0;
4435         }
4436         default:
4437                 PDEBUG(3, "Unsupported IOCtl: 0x%X", cmd);
4438                 return -ENOIOCTLCMD;
4439         } /* end switch */
4440
4441         return 0;
4442 }
4443
4444 static int
4445 ov51x_v4l1_ioctl(struct inode *inode, struct file *file,
4446                  unsigned int cmd, unsigned long arg)
4447 {
4448         struct video_device *vdev = file->private_data;
4449         struct usb_ov511 *ov = video_get_drvdata(vdev);
4450         int rc;
4451
4452         if (mutex_lock_interruptible(&ov->lock))
4453                 return -EINTR;
4454
4455         rc = video_usercopy(inode, file, cmd, arg, ov51x_v4l1_ioctl_internal);
4456
4457         mutex_unlock(&ov->lock);
4458         return rc;
4459 }
4460
4461 static ssize_t
4462 ov51x_v4l1_read(struct file *file, char __user *buf, size_t cnt, loff_t *ppos)
4463 {
4464         struct video_device *vdev = file->private_data;
4465         int noblock = file->f_flags&O_NONBLOCK;
4466         unsigned long count = cnt;
4467         struct usb_ov511 *ov = video_get_drvdata(vdev);
4468         int i, rc = 0, frmx = -1;
4469         struct ov511_frame *frame;
4470
4471         if (mutex_lock_interruptible(&ov->lock))
4472                 return -EINTR;
4473
4474         PDEBUG(4, "%ld bytes, noblock=%d", count, noblock);
4475
4476         if (!vdev || !buf) {
4477                 rc = -EFAULT;
4478                 goto error;
4479         }
4480
4481         if (!ov->dev) {
4482                 rc = -EIO;
4483                 goto error;
4484         }
4485
4486 // FIXME: Only supports two frames
4487         /* See if a frame is completed, then use it. */
4488         if (ov->frame[0].grabstate >= FRAME_DONE)       /* _DONE or _ERROR */
4489                 frmx = 0;
4490         else if (ov->frame[1].grabstate >= FRAME_DONE)/* _DONE or _ERROR */
4491                 frmx = 1;
4492
4493         /* If nonblocking we return immediately */
4494         if (noblock && (frmx == -1)) {
4495                 rc = -EAGAIN;
4496                 goto error;
4497         }
4498
4499         /* If no FRAME_DONE, look for a FRAME_GRABBING state. */
4500         /* See if a frame is in process (grabbing), then use it. */
4501         if (frmx == -1) {
4502                 if (ov->frame[0].grabstate == FRAME_GRABBING)
4503                         frmx = 0;
4504                 else if (ov->frame[1].grabstate == FRAME_GRABBING)
4505                         frmx = 1;
4506         }
4507
4508         /* If no frame is active, start one. */
4509         if (frmx == -1) {
4510                 if ((rc = ov51x_new_frame(ov, frmx = 0))) {
4511                         err("read: ov51x_new_frame error");
4512                         goto error;
4513                 }
4514         }
4515
4516         frame = &ov->frame[frmx];
4517
4518 restart:
4519         if (!ov->dev) {
4520                 rc = -EIO;
4521                 goto error;
4522         }
4523
4524         /* Wait while we're grabbing the image */
4525         PDEBUG(4, "Waiting image grabbing");
4526         rc = wait_event_interruptible(frame->wq,
4527                 (frame->grabstate == FRAME_DONE)
4528                 || (frame->grabstate == FRAME_ERROR));
4529
4530         if (rc)
4531                 goto error;
4532
4533         PDEBUG(4, "Got image, frame->grabstate = %d", frame->grabstate);
4534         PDEBUG(4, "bytes_recvd = %d", frame->bytes_recvd);
4535
4536         if (frame->grabstate == FRAME_ERROR) {
4537                 frame->bytes_read = 0;
4538                 err("** ick! ** Errored frame %d", ov->curframe);
4539                 if (ov51x_new_frame(ov, frmx)) {
4540                         err("read: ov51x_new_frame error");
4541                         goto error;
4542                 }
4543                 goto restart;
4544         }
4545
4546
4547         /* Repeat until we get a snapshot frame */
4548         if (ov->snap_enabled)
4549                 PDEBUG(4, "Waiting snapshot frame");
4550         if (ov->snap_enabled && !frame->snapshot) {
4551                 frame->bytes_read = 0;
4552                 if ((rc = ov51x_new_frame(ov, frmx))) {
4553                         err("read: ov51x_new_frame error");
4554                         goto error;
4555                 }
4556                 goto restart;
4557         }
4558
4559         /* Clear the snapshot */
4560         if (ov->snap_enabled && frame->snapshot) {
4561                 frame->snapshot = 0;
4562                 ov51x_clear_snapshot(ov);
4563         }
4564
4565         /* Decompression, format conversion, etc... */
4566         ov51x_postprocess(ov, frame);
4567
4568         PDEBUG(4, "frmx=%d, bytes_read=%ld, length=%ld", frmx,
4569                 frame->bytes_read,
4570                 get_frame_length(frame));
4571
4572         /* copy bytes to user space; we allow for partials reads */
4573 //      if ((count + frame->bytes_read)
4574 //          > get_frame_length((struct ov511_frame *)frame))
4575 //              count = frame->scanlength - frame->bytes_read;
4576
4577         /* FIXME - count hardwired to be one frame... */
4578         count = get_frame_length(frame);
4579
4580         PDEBUG(4, "Copy to user space: %ld bytes", count);
4581         if ((i = copy_to_user(buf, frame->data + frame->bytes_read, count))) {
4582                 PDEBUG(4, "Copy failed! %d bytes not copied", i);
4583                 rc = -EFAULT;
4584                 goto error;
4585         }
4586
4587         frame->bytes_read += count;
4588         PDEBUG(4, "{copy} count used=%ld, new bytes_read=%ld",
4589                 count, frame->bytes_read);
4590
4591         /* If all data have been read... */
4592         if (frame->bytes_read
4593             >= get_frame_length(frame)) {
4594                 frame->bytes_read = 0;
4595
4596 // FIXME: Only supports two frames
4597                 /* Mark it as available to be used again. */
4598                 ov->frame[frmx].grabstate = FRAME_UNUSED;
4599                 if ((rc = ov51x_new_frame(ov, !frmx))) {
4600                         err("ov51x_new_frame returned error");
4601                         goto error;
4602                 }
4603         }
4604
4605         PDEBUG(4, "read finished, returning %ld (sweet)", count);
4606
4607         mutex_unlock(&ov->lock);
4608         return count;
4609
4610 error:
4611         mutex_unlock(&ov->lock);
4612         return rc;
4613 }
4614
4615 static int
4616 ov51x_v4l1_mmap(struct file *file, struct vm_area_struct *vma)
4617 {
4618         struct video_device *vdev = file->private_data;
4619         unsigned long start = vma->vm_start;
4620         unsigned long size  = vma->vm_end - vma->vm_start;
4621         struct usb_ov511 *ov = video_get_drvdata(vdev);
4622         unsigned long page, pos;
4623
4624         if (ov->dev == NULL)
4625                 return -EIO;
4626
4627         PDEBUG(4, "mmap: %ld (%lX) bytes", size, size);
4628
4629         if (size > (((OV511_NUMFRAMES
4630                       * MAX_DATA_SIZE(ov->maxwidth, ov->maxheight)
4631                       + PAGE_SIZE - 1) & ~(PAGE_SIZE - 1))))
4632                 return -EINVAL;
4633
4634         if (mutex_lock_interruptible(&ov->lock))
4635                 return -EINTR;
4636
4637         pos = (unsigned long)ov->fbuf;
4638         while (size > 0) {
4639                 page = vmalloc_to_pfn((void *)pos);
4640                 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED)) {
4641                         mutex_unlock(&ov->lock);
4642                         return -EAGAIN;
4643                 }
4644                 start += PAGE_SIZE;
4645                 pos += PAGE_SIZE;
4646                 if (size > PAGE_SIZE)
4647                         size -= PAGE_SIZE;
4648                 else
4649                         size = 0;
4650         }
4651
4652         mutex_unlock(&ov->lock);
4653         return 0;
4654 }
4655
4656 static struct file_operations ov511_fops = {
4657         .owner =        THIS_MODULE,
4658         .open =         ov51x_v4l1_open,
4659         .release =      ov51x_v4l1_close,
4660         .read =         ov51x_v4l1_read,
4661         .mmap =         ov51x_v4l1_mmap,
4662         .ioctl =        ov51x_v4l1_ioctl,
4663         .compat_ioctl = v4l_compat_ioctl32,
4664         .llseek =       no_llseek,
4665 };
4666
4667 static struct video_device vdev_template = {
4668         .owner =        THIS_MODULE,
4669         .name =         "OV511 USB Camera",
4670         .type =         VID_TYPE_CAPTURE,
4671         .hardware =     VID_HARDWARE_OV511,
4672         .fops =         &ov511_fops,
4673         .release =      video_device_release,
4674         .minor =        -1,
4675 };
4676
4677 /****************************************************************************
4678  *
4679  * OV511 and sensor configuration
4680  *
4681  ***************************************************************************/
4682
4683 /* This initializes the OV7610, OV7620, or OV76BE sensor. The OV76BE uses
4684  * the same register settings as the OV7610, since they are very similar.
4685  */
4686 static int
4687 ov7xx0_configure(struct usb_ov511 *ov)
4688 {
4689         int i, success;
4690         int rc;
4691
4692         /* Lawrence Glaister <lg@jfm.bc.ca> reports:
4693          *
4694          * Register 0x0f in the 7610 has the following effects:
4695          *
4696          * 0x85 (AEC method 1): Best overall, good contrast range
4697          * 0x45 (AEC method 2): Very overexposed
4698          * 0xa5 (spec sheet default): Ok, but the black level is
4699          *      shifted resulting in loss of contrast
4700          * 0x05 (old driver setting): very overexposed, too much
4701          *      contrast
4702          */
4703         static struct ov511_regvals aRegvalsNorm7610[] = {
4704                 { OV511_I2C_BUS, 0x10, 0xff },
4705                 { OV511_I2C_BUS, 0x16, 0x06 },
4706                 { OV511_I2C_BUS, 0x28, 0x24 },
4707                 { OV511_I2C_BUS, 0x2b, 0xac },
4708                 { OV511_I2C_BUS, 0x12, 0x00 },
4709                 { OV511_I2C_BUS, 0x38, 0x81 },
4710                 { OV511_I2C_BUS, 0x28, 0x24 },  /* 0c */
4711                 { OV511_I2C_BUS, 0x0f, 0x85 },  /* lg's setting */
4712                 { OV511_I2C_BUS, 0x15, 0x01 },
4713                 { OV511_I2C_BUS, 0x20, 0x1c },
4714                 { OV511_I2C_BUS, 0x23, 0x2a },
4715                 { OV511_I2C_BUS, 0x24, 0x10 },
4716                 { OV511_I2C_BUS, 0x25, 0x8a },
4717                 { OV511_I2C_BUS, 0x26, 0xa2 },
4718                 { OV511_I2C_BUS, 0x27, 0xc2 },
4719                 { OV511_I2C_BUS, 0x2a, 0x04 },
4720                 { OV511_I2C_BUS, 0x2c, 0xfe },
4721                 { OV511_I2C_BUS, 0x2d, 0x93 },
4722                 { OV511_I2C_BUS, 0x30, 0x71 },
4723                 { OV511_I2C_BUS, 0x31, 0x60 },
4724                 { OV511_I2C_BUS, 0x32, 0x26 },
4725                 { OV511_I2C_BUS, 0x33, 0x20 },
4726                 { OV511_I2C_BUS, 0x34, 0x48 },
4727                 { OV511_I2C_BUS, 0x12, 0x24 },
4728                 { OV511_I2C_BUS, 0x11, 0x01 },
4729                 { OV511_I2C_BUS, 0x0c, 0x24 },
4730                 { OV511_I2C_BUS, 0x0d, 0x24 },
4731                 { OV511_DONE_BUS, 0x0, 0x00 },
4732         };
4733
4734         static struct ov511_regvals aRegvalsNorm7620[] = {
4735                 { OV511_I2C_BUS, 0x00, 0x00 },
4736                 { OV511_I2C_BUS, 0x01, 0x80 },
4737                 { OV511_I2C_BUS, 0x02, 0x80 },
4738                 { OV511_I2C_BUS, 0x03, 0xc0 },
4739                 { OV511_I2C_BUS, 0x06, 0x60 },
4740                 { OV511_I2C_BUS, 0x07, 0x00 },
4741                 { OV511_I2C_BUS, 0x0c, 0x24 },
4742                 { OV511_I2C_BUS, 0x0c, 0x24 },
4743                 { OV511_I2C_BUS, 0x0d, 0x24 },
4744                 { OV511_I2C_BUS, 0x11, 0x01 },
4745                 { OV511_I2C_BUS, 0x12, 0x24 },
4746                 { OV511_I2C_BUS, 0x13, 0x01 },
4747                 { OV511_I2C_BUS, 0x14, 0x84 },
4748                 { OV511_I2C_BUS, 0x15, 0x01 },
4749                 { OV511_I2C_BUS, 0x16, 0x03 },
4750                 { OV511_I2C_BUS, 0x17, 0x2f },
4751                 { OV511_I2C_BUS, 0x18, 0xcf },
4752                 { OV511_I2C_BUS, 0x19, 0x06 },
4753                 { OV511_I2C_BUS, 0x1a, 0xf5 },
4754                 { OV511_I2C_BUS, 0x1b, 0x00 },
4755                 { OV511_I2C_BUS, 0x20, 0x18 },
4756                 { OV511_I2C_BUS, 0x21, 0x80 },
4757                 { OV511_I2C_BUS, 0x22, 0x80 },
4758                 { OV511_I2C_BUS, 0x23, 0x00 },
4759                 { OV511_I2C_BUS, 0x26, 0xa2 },
4760                 { OV511_I2C_BUS, 0x27, 0xea },
4761                 { OV511_I2C_BUS, 0x28, 0x20 },
4762                 { OV511_I2C_BUS, 0x29, 0x00 },
4763                 { OV511_I2C_BUS, 0x2a, 0x10 },
4764                 { OV511_I2C_BUS, 0x2b, 0x00 },
4765                 { OV511_I2C_BUS, 0x2c, 0x88 },
4766                 { OV511_I2C_BUS, 0x2d, 0x91 },
4767                 { OV511_I2C_BUS, 0x2e, 0x80 },
4768                 { OV511_I2C_BUS, 0x2f, 0x44 },
4769                 { OV511_I2C_BUS, 0x60, 0x27 },
4770                 { OV511_I2C_BUS, 0x61, 0x02 },
4771                 { OV511_I2C_BUS, 0x62, 0x5f },
4772                 { OV511_I2C_BUS, 0x63, 0xd5 },
4773                 { OV511_I2C_BUS, 0x64, 0x57 },
4774                 { OV511_I2C_BUS, 0x65, 0x83 },
4775                 { OV511_I2C_BUS, 0x66, 0x55 },
4776                 { OV511_I2C_BUS, 0x67, 0x92 },
4777                 { OV511_I2C_BUS, 0x68, 0xcf },
4778                 { OV511_I2C_BUS, 0x69, 0x76 },
4779                 { OV511_I2C_BUS, 0x6a, 0x22 },
4780                 { OV511_I2C_BUS, 0x6b, 0x00 },
4781                 { OV511_I2C_BUS, 0x6c, 0x02 },
4782                 { OV511_I2C_BUS, 0x6d, 0x44 },
4783                 { OV511_I2C_BUS, 0x6e, 0x80 },
4784                 { OV511_I2C_BUS, 0x6f, 0x1d },
4785                 { OV511_I2C_BUS, 0x70, 0x8b },
4786                 { OV511_I2C_BUS, 0x71, 0x00 },
4787                 { OV511_I2C_BUS, 0x72, 0x14 },
4788                 { OV511_I2C_BUS, 0x73, 0x54 },
4789                 { OV511_I2C_BUS, 0x74, 0x00 },
4790                 { OV511_I2C_BUS, 0x75, 0x8e },
4791                 { OV511_I2C_BUS, 0x76, 0x00 },
4792                 { OV511_I2C_BUS, 0x77, 0xff },
4793                 { OV511_I2C_BUS, 0x78, 0x80 },
4794                 { OV511_I2C_BUS, 0x79, 0x80 },
4795                 { OV511_I2C_BUS, 0x7a, 0x80 },
4796                 { OV511_I2C_BUS, 0x7b, 0xe2 },
4797                 { OV511_I2C_BUS, 0x7c, 0x00 },
4798                 { OV511_DONE_BUS, 0x0, 0x00 },
4799         };
4800
4801         PDEBUG(4, "starting configuration");
4802
4803         /* This looks redundant, but is necessary for WebCam 3 */
4804         ov->primary_i2c_slave = OV7xx0_SID;
4805         if (ov51x_set_slave_ids(ov, OV7xx0_SID) < 0)
4806                 return -1;
4807
4808         if (init_ov_sensor(ov) >= 0) {
4809                 PDEBUG(1, "OV7xx0 sensor initalized (method 1)");
4810         } else {
4811                 /* Reset the 76xx */
4812                 if (i2c_w(ov, 0x12, 0x80) < 0)
4813                         return -1;
4814
4815                 /* Wait for it to initialize */
4816                 msleep(150);
4817
4818                 i = 0;
4819                 success = 0;
4820                 while (i <= i2c_detect_tries) {
4821                         if ((i2c_r(ov, OV7610_REG_ID_HIGH) == 0x7F) &&
4822                             (i2c_r(ov, OV7610_REG_ID_LOW) == 0xA2)) {
4823                                 success = 1;
4824                                 break;
4825                         } else {
4826                                 i++;
4827                         }
4828                 }
4829
4830 // Was (i == i2c_detect_tries) previously. This obviously used to always report
4831 // success. Whether anyone actually depended on that bug is unknown
4832                 if ((i >= i2c_detect_tries) && (success == 0)) {
4833                         err("Failed to read sensor ID. You might not have an");
4834                         err("OV7610/20, or it may be not responding. Report");
4835                         err("this to " EMAIL);
4836                         err("This is only a warning. You can attempt to use");
4837                         err("your camera anyway");
4838 // Only issue a warning for now
4839 //                      return -1;
4840                 } else {
4841                         PDEBUG(1, "OV7xx0 initialized (method 2, %dx)", i+1);
4842                 }
4843         }
4844
4845         /* Detect sensor (sub)type */
4846         rc = i2c_r(ov, OV7610_REG_COM_I);
4847
4848         if (rc < 0) {
4849                 err("Error detecting sensor type");
4850                 return -1;
4851         } else if ((rc & 3) == 3) {
4852                 info("Sensor is an OV7610");
4853                 ov->sensor = SEN_OV7610;
4854         } else if ((rc & 3) == 1) {
4855                 /* I don't know what's different about the 76BE yet. */
4856                 if (i2c_r(ov, 0x15) & 1)
4857                         info("Sensor is an OV7620AE");
4858                 else
4859                         info("Sensor is an OV76BE");
4860
4861                 /* OV511+ will return all zero isoc data unless we
4862                  * configure the sensor as a 7620. Someone needs to
4863                  * find the exact reg. setting that causes this. */
4864                 if (ov->bridge == BRG_OV511PLUS) {
4865                         info("Enabling 511+/7620AE workaround");
4866                         ov->sensor = SEN_OV7620;
4867                 } else {
4868                         ov->sensor = SEN_OV76BE;
4869                 }
4870         } else if ((rc & 3) == 0) {
4871                 info("Sensor is an OV7620");
4872                 ov->sensor = SEN_OV7620;
4873         } else {
4874                 err("Unknown image sensor version: %d", rc & 3);
4875                 return -1;
4876         }
4877
4878         if (ov->sensor == SEN_OV7620) {
4879                 PDEBUG(4, "Writing 7620 registers");
4880                 if (write_regvals(ov, aRegvalsNorm7620))
4881                         return -1;
4882         } else {
4883                 PDEBUG(4, "Writing 7610 registers");
4884                 if (write_regvals(ov, aRegvalsNorm7610))
4885                         return -1;
4886         }
4887
4888         /* Set sensor-specific vars */
4889         ov->maxwidth = 640;
4890         ov->maxheight = 480;
4891         ov->minwidth = 64;
4892         ov->minheight = 48;
4893
4894         // FIXME: These do not match the actual settings yet
4895         ov->brightness = 0x80 << 8;
4896         ov->contrast = 0x80 << 8;
4897         ov->colour = 0x80 << 8;
4898         ov->hue = 0x80 << 8;
4899
4900         return 0;
4901 }
4902
4903 /* This initializes the OV6620, OV6630, OV6630AE, or OV6630AF sensor. */
4904 static int
4905 ov6xx0_configure(struct usb_ov511 *ov)
4906 {
4907         int rc;
4908
4909         static struct ov511_regvals aRegvalsNorm6x20[] = {
4910                 { OV511_I2C_BUS, 0x12, 0x80 }, /* reset */
4911                 { OV511_I2C_BUS, 0x11, 0x01 },
4912                 { OV511_I2C_BUS, 0x03, 0x60 },
4913                 { OV511_I2C_BUS, 0x05, 0x7f }, /* For when autoadjust is off */
4914                 { OV511_I2C_BUS, 0x07, 0xa8 },
4915                 /* The ratio of 0x0c and 0x0d  controls the white point */
4916                 { OV511_I2C_BUS, 0x0c, 0x24 },
4917                 { OV511_I2C_BUS, 0x0d, 0x24 },
4918                 { OV511_I2C_BUS, 0x0f, 0x15 }, /* COMS */
4919                 { OV511_I2C_BUS, 0x10, 0x75 }, /* AEC Exposure time */
4920                 { OV511_I2C_BUS, 0x12, 0x24 }, /* Enable AGC */
4921                 { OV511_I2C_BUS, 0x14, 0x04 },
4922                 /* 0x16: 0x06 helps frame stability with moving objects */
4923                 { OV511_I2C_BUS, 0x16, 0x06 },
4924 //              { OV511_I2C_BUS, 0x20, 0x30 }, /* Aperture correction enable */
4925                 { OV511_I2C_BUS, 0x26, 0xb2 }, /* BLC enable */
4926                 /* 0x28: 0x05 Selects RGB format if RGB on */
4927                 { OV511_I2C_BUS, 0x28, 0x05 },
4928                 { OV511_I2C_BUS, 0x2a, 0x04 }, /* Disable framerate adjust */
4929 //              { OV511_I2C_BUS, 0x2b, 0xac }, /* Framerate; Set 2a[7] first */
4930                 { OV511_I2C_BUS, 0x2d, 0x99 },
4931                 { OV511_I2C_BUS, 0x33, 0xa0 }, /* Color Processing Parameter */
4932                 { OV511_I2C_BUS, 0x34, 0xd2 }, /* Max A/D range */
4933                 { OV511_I2C_BUS, 0x38, 0x8b },
4934                 { OV511_I2C_BUS, 0x39, 0x40 },
4935
4936                 { OV511_I2C_BUS, 0x3c, 0x39 }, /* Enable AEC mode changing */
4937                 { OV511_I2C_BUS, 0x3c, 0x3c }, /* Change AEC mode */
4938                 { OV511_I2C_BUS, 0x3c, 0x24 }, /* Disable AEC mode changing */
4939
4940                 { OV511_I2C_BUS, 0x3d, 0x80 },
4941                 /* These next two registers (0x4a, 0x4b) are undocumented. They
4942                  * control the color balance */
4943                 { OV511_I2C_BUS, 0x4a, 0x80 },
4944                 { OV511_I2C_BUS, 0x4b, 0x80 },
4945                 { OV511_I2C_BUS, 0x4d, 0xd2 }, /* This reduces noise a bit */
4946                 { OV511_I2C_BUS, 0x4e, 0xc1 },
4947                 { OV511_I2C_BUS, 0x4f, 0x04 },
4948 // Do 50-53 have any effect?
4949 // Toggle 0x12[2] off and on here?
4950                 { OV511_DONE_BUS, 0x0, 0x00 },  /* END MARKER */
4951         };
4952
4953         static struct ov511_regvals aRegvalsNorm6x30[] = {
4954         /*OK*/  { OV511_I2C_BUS, 0x12, 0x80 }, /* reset */
4955                 { OV511_I2C_BUS, 0x11, 0x00 },
4956         /*OK*/  { OV511_I2C_BUS, 0x03, 0x60 },
4957         /*0A?*/ { OV511_I2C_BUS, 0x05, 0x7f }, /* For when autoadjust is off */
4958                 { OV511_I2C_BUS, 0x07, 0xa8 },
4959                 /* The ratio of 0x0c and 0x0d  controls the white point */
4960         /*OK*/  { OV511_I2C_BUS, 0x0c, 0x24 },
4961         /*OK*/  { OV511_I2C_BUS, 0x0d, 0x24 },
4962         /*A*/   { OV511_I2C_BUS, 0x0e, 0x20 },
4963 //      /*04?*/ { OV511_I2C_BUS, 0x14, 0x80 },
4964                 { OV511_I2C_BUS, 0x16, 0x03 },
4965 //      /*OK*/  { OV511_I2C_BUS, 0x20, 0x30 }, /* Aperture correction enable */
4966                 // 21 & 22? The suggested values look wrong. Go with default
4967         /*A*/   { OV511_I2C_BUS, 0x23, 0xc0 },
4968         /*A*/   { OV511_I2C_BUS, 0x25, 0x9a }, // Check this against default
4969 //      /*OK*/  { OV511_I2C_BUS, 0x26, 0xb2 }, /* BLC enable */
4970
4971                 /* 0x28: 0x05 Selects RGB format if RGB on */
4972 //      /*04?*/ { OV511_I2C_BUS, 0x28, 0x05 },
4973 //      /*04?*/ { OV511_I2C_BUS, 0x28, 0x45 }, // DEBUG: Tristate UV bus
4974
4975         /*OK*/  { OV511_I2C_BUS, 0x2a, 0x04 }, /* Disable framerate adjust */
4976 //      /*OK*/  { OV511_I2C_BUS, 0x2b, 0xac }, /* Framerate; Set 2a[7] first */
4977                 { OV511_I2C_BUS, 0x2d, 0x99 },
4978 //      /*A*/   { OV511_I2C_BUS, 0x33, 0x26 }, // Reserved bits on 6620
4979 //      /*d2?*/ { OV511_I2C_BUS, 0x34, 0x03 }, /* Max A/D range */
4980 //      /*8b?*/ { OV511_I2C_BUS, 0x38, 0x83 },
4981 //      /*40?*/ { OV511_I2C_BUS, 0x39, 0xc0 }, // 6630 adds bit 7
4982 //              { OV511_I2C_BUS, 0x3c, 0x39 }, /* Enable AEC mode changing */
4983 //              { OV511_I2C_BUS, 0x3c, 0x3c }, /* Change AEC mode */
4984 //              { OV511_I2C_BUS, 0x3c, 0x24 }, /* Disable AEC mode changing */
4985                 { OV511_I2C_BUS, 0x3d, 0x80 },
4986 //      /*A*/   { OV511_I2C_BUS, 0x3f, 0x0e },
4987
4988                 /* These next two registers (0x4a, 0x4b) are undocumented. They
4989                  * control the color balance */
4990 //      /*OK?*/ { OV511_I2C_BUS, 0x4a, 0x80 }, // Check these
4991 //      /*OK?*/ { OV511_I2C_BUS, 0x4b, 0x80 },
4992                 { OV511_I2C_BUS, 0x4d, 0x10 }, /* U = 0.563u, V = 0.714v */
4993         /*c1?*/ { OV511_I2C_BUS, 0x4e, 0x40 },
4994
4995                 /* UV average mode, color killer: strongest */
4996                 { OV511_I2C_BUS, 0x4f, 0x07 },
4997
4998                 { OV511_I2C_BUS, 0x54, 0x23 }, /* Max AGC gain: 18dB */
4999                 { OV511_I2C_BUS, 0x57, 0x81 }, /* (default) */
5000                 { OV511_I2C_BUS, 0x59, 0x01 }, /* AGC dark current comp: +1 */
5001                 { OV511_I2C_BUS, 0x5a, 0x2c }, /* (undocumented) */
5002                 { OV511_I2C_BUS, 0x5b, 0x0f }, /* AWB chrominance levels */
5003 //              { OV511_I2C_BUS, 0x5c, 0x10 },
5004                 { OV511_DONE_BUS, 0x0, 0x00 },  /* END MARKER */
5005         };
5006
5007         PDEBUG(4, "starting sensor configuration");
5008
5009         if (init_ov_sensor(ov) < 0) {
5010                 err("Failed to read sensor ID. You might not have an OV6xx0,");
5011                 err("or it may be not responding. Report this to " EMAIL);
5012                 return -1;
5013         } else {
5014                 PDEBUG(1, "OV6xx0 sensor detected");
5015         }
5016
5017         /* Detect sensor (sub)type */
5018         rc = i2c_r(ov, OV7610_REG_COM_I);
5019
5020         if (rc < 0) {
5021                 err("Error detecting sensor type");
5022                 return -1;
5023         }
5024
5025         if ((rc & 3) == 0) {
5026                 ov->sensor = SEN_OV6630;
5027                 info("Sensor is an OV6630");
5028         } else if ((rc & 3) == 1) {
5029                 ov->sensor = SEN_OV6620;
5030                 info("Sensor is an OV6620");
5031         } else if ((rc & 3) == 2) {
5032                 ov->sensor = SEN_OV6630;
5033                 info("Sensor is an OV6630AE");
5034         } else if ((rc & 3) == 3) {
5035                 ov->sensor = SEN_OV6630;
5036                 info("Sensor is an OV6630AF");
5037         }
5038
5039         /* Set sensor-specific vars */
5040         ov->maxwidth = 352;
5041         ov->maxheight = 288;
5042         ov->minwidth = 64;
5043         ov->minheight = 48;
5044
5045         // FIXME: These do not match the actual settings yet
5046         ov->brightness = 0x80 << 8;
5047         ov->contrast = 0x80 << 8;
5048         ov->colour = 0x80 << 8;
5049         ov->hue = 0x80 << 8;
5050
5051         if (ov->sensor == SEN_OV6620) {
5052                 PDEBUG(4, "Writing 6x20 registers");
5053                 if (write_regvals(ov, aRegvalsNorm6x20))
5054                         return -1;
5055         } else {
5056                 PDEBUG(4, "Writing 6x30 registers");
5057                 if (write_regvals(ov, aRegvalsNorm6x30))
5058                         return -1;
5059         }
5060
5061         return 0;
5062 }
5063
5064 /* This initializes the KS0127 and KS0127B video decoders. */
5065 static int 
5066 ks0127_configure(struct usb_ov511 *ov)
5067 {
5068         int rc;
5069
5070 // FIXME: I don't know how to sync or reset it yet
5071 #if 0
5072         if (ov51x_init_ks_sensor(ov) < 0) {
5073                 err("Failed to initialize the KS0127");
5074                 return -1;
5075         } else {
5076                 PDEBUG(1, "KS012x(B) sensor detected");
5077         }
5078 #endif
5079
5080         /* Detect decoder subtype */
5081         rc = i2c_r(ov, 0x00);
5082         if (rc < 0) {
5083                 err("Error detecting sensor type");
5084                 return -1;
5085         } else if (rc & 0x08) {
5086                 rc = i2c_r(ov, 0x3d);
5087                 if (rc < 0) {
5088                         err("Error detecting sensor type");
5089                         return -1;
5090                 } else if ((rc & 0x0f) == 0) {
5091                         info("Sensor is a KS0127");
5092                         ov->sensor = SEN_KS0127;
5093                 } else if ((rc & 0x0f) == 9) {
5094                         info("Sensor is a KS0127B Rev. A");
5095                         ov->sensor = SEN_KS0127B;
5096                 }
5097         } else {
5098                 err("Error: Sensor is an unsupported KS0122");
5099                 return -1;
5100         }
5101
5102         /* Set sensor-specific vars */
5103         ov->maxwidth = 640;
5104         ov->maxheight = 480;
5105         ov->minwidth = 64;
5106         ov->minheight = 48;
5107
5108         // FIXME: These do not match the actual settings yet
5109         ov->brightness = 0x80 << 8;
5110         ov->contrast = 0x80 << 8;
5111         ov->colour = 0x80 << 8;
5112         ov->hue = 0x80 << 8;
5113
5114         /* This device is not supported yet. Bail out now... */
5115         err("This sensor is not supported yet.");
5116         return -1;
5117
5118         return 0;
5119 }
5120
5121 /* This initializes the SAA7111A video decoder. */
5122 static int
5123 saa7111a_configure(struct usb_ov511 *ov)
5124 {
5125         int rc;
5126
5127         /* Since there is no register reset command, all registers must be
5128          * written, otherwise gives erratic results */
5129         static struct ov511_regvals aRegvalsNormSAA7111A[] = {
5130                 { OV511_I2C_BUS, 0x06, 0xce },
5131                 { OV511_I2C_BUS, 0x07, 0x00 },
5132                 { OV511_I2C_BUS, 0x10, 0x44 }, /* YUV422, 240/286 lines */
5133                 { OV511_I2C_BUS, 0x0e, 0x01 }, /* NTSC M or PAL BGHI */
5134                 { OV511_I2C_BUS, 0x00, 0x00 },
5135                 { OV511_I2C_BUS, 0x01, 0x00 },
5136                 { OV511_I2C_BUS, 0x03, 0x23 },
5137                 { OV511_I2C_BUS, 0x04, 0x00 },
5138                 { OV511_I2C_BUS, 0x05, 0x00 },
5139                 { OV511_I2C_BUS, 0x08, 0xc8 }, /* Auto field freq */
5140                 { OV511_I2C_BUS, 0x09, 0x01 }, /* Chrom. trap off, APER=0.25 */
5141                 { OV511_I2C_BUS, 0x0a, 0x80 }, /* BRIG=128 */
5142                 { OV511_I2C_BUS, 0x0b, 0x40 }, /* CONT=1.0 */
5143                 { OV511_I2C_BUS, 0x0c, 0x40 }, /* SATN=1.0 */
5144                 { OV511_I2C_BUS, 0x0d, 0x00 }, /* HUE=0 */
5145                 { OV511_I2C_BUS, 0x0f, 0x00 },
5146                 { OV511_I2C_BUS, 0x11, 0x0c },
5147                 { OV511_I2C_BUS, 0x12, 0x00 },
5148                 { OV511_I2C_BUS, 0x13, 0x00 },
5149                 { OV511_I2C_BUS, 0x14, 0x00 },
5150                 { OV511_I2C_BUS, 0x15, 0x00 },
5151                 { OV511_I2C_BUS, 0x16, 0x00 },
5152                 { OV511_I2C_BUS, 0x17, 0x00 },
5153                 { OV511_I2C_BUS, 0x02, 0xc0 },  /* Composite input 0 */
5154                 { OV511_DONE_BUS, 0x0, 0x00 },
5155         };
5156
5157 // FIXME: I don't know how to sync or reset it yet
5158 #if 0
5159         if (ov51x_init_saa_sensor(ov) < 0) {
5160                 err("Failed to initialize the SAA7111A");
5161                 return -1;
5162         } else {
5163                 PDEBUG(1, "SAA7111A sensor detected");
5164         }
5165 #endif
5166
5167         /* 640x480 not supported with PAL */
5168         if (ov->pal) {
5169                 ov->maxwidth = 320;
5170                 ov->maxheight = 240;            /* Even field only */
5171         } else {
5172                 ov->maxwidth = 640;
5173                 ov->maxheight = 480;            /* Even/Odd fields */
5174         }
5175
5176         ov->minwidth = 320;
5177         ov->minheight = 240;            /* Even field only */
5178
5179         ov->has_decoder = 1;
5180         ov->num_inputs = 8;
5181         ov->norm = VIDEO_MODE_AUTO;
5182         ov->stop_during_set = 0;        /* Decoder guarantees stable image */
5183
5184         /* Decoder doesn't change these values, so we use these instead of
5185          * acutally reading the registers (which doesn't work) */
5186         ov->brightness = 0x80 << 8;
5187         ov->contrast = 0x40 << 9;
5188         ov->colour = 0x40 << 9;
5189         ov->hue = 32768;
5190
5191         PDEBUG(4, "Writing SAA7111A registers");
5192         if (write_regvals(ov, aRegvalsNormSAA7111A))
5193                 return -1;
5194
5195         /* Detect version of decoder. This must be done after writing the
5196          * initial regs or the decoder will lock up. */
5197         rc = i2c_r(ov, 0x00);
5198
5199         if (rc < 0) {
5200                 err("Error detecting sensor version");
5201                 return -1;
5202         } else {
5203                 info("Sensor is an SAA7111A (version 0x%x)", rc);
5204                 ov->sensor = SEN_SAA7111A;
5205         }
5206
5207         // FIXME: Fix this for OV518(+)
5208         /* Latch to negative edge of clock. Otherwise, we get incorrect
5209          * colors and jitter in the digital signal. */
5210         if (ov->bclass == BCL_OV511)
5211                 reg_w(ov, 0x11, 0x00);
5212         else
5213                 warn("SAA7111A not yet supported with OV518/OV518+");
5214
5215         return 0;
5216 }
5217
5218 /* This initializes the OV511/OV511+ and the sensor */
5219 static int 
5220 ov511_configure(struct usb_ov511 *ov)
5221 {
5222         static struct ov511_regvals aRegvalsInit511[] = {
5223                 { OV511_REG_BUS, R51x_SYS_RESET,        0x7f },
5224                 { OV511_REG_BUS, R51x_SYS_INIT,         0x01 },
5225                 { OV511_REG_BUS, R51x_SYS_RESET,        0x7f },
5226                 { OV511_REG_BUS, R51x_SYS_INIT,         0x01 },
5227                 { OV511_REG_BUS, R51x_SYS_RESET,        0x3f },
5228                 { OV511_REG_BUS, R51x_SYS_INIT,         0x01 },
5229                 { OV511_REG_BUS, R51x_SYS_RESET,        0x3d },
5230                 { OV511_DONE_BUS, 0x0, 0x00},
5231         };
5232
5233         static struct ov511_regvals aRegvalsNorm511[] = {
5234                 { OV511_REG_BUS, R511_DRAM_FLOW_CTL,    0x01 },
5235                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x00 },
5236                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x02 },
5237                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x00 },
5238                 { OV511_REG_BUS, R511_FIFO_OPTS,        0x1f },
5239                 { OV511_REG_BUS, R511_COMP_EN,          0x00 },
5240                 { OV511_REG_BUS, R511_COMP_LUT_EN,      0x03 },
5241                 { OV511_DONE_BUS, 0x0, 0x00 },
5242         };
5243
5244         static struct ov511_regvals aRegvalsNorm511Plus[] = {
5245                 { OV511_REG_BUS, R511_DRAM_FLOW_CTL,    0xff },
5246                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x00 },
5247                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x02 },
5248                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x00 },
5249                 { OV511_REG_BUS, R511_FIFO_OPTS,        0xff },
5250                 { OV511_REG_BUS, R511_COMP_EN,          0x00 },
5251                 { OV511_REG_BUS, R511_COMP_LUT_EN,      0x03 },
5252                 { OV511_DONE_BUS, 0x0, 0x00 },
5253         };
5254
5255         PDEBUG(4, "");
5256
5257         ov->customid = reg_r(ov, R511_SYS_CUST_ID);
5258         if (ov->customid < 0) {
5259                 err("Unable to read camera bridge registers");
5260                 goto error;
5261         }
5262
5263         PDEBUG (1, "CustomID = %d", ov->customid);
5264         ov->desc = symbolic(camlist, ov->customid);
5265         info("model: %s", ov->desc);
5266
5267         if (0 == strcmp(ov->desc, NOT_DEFINED_STR)) {
5268                 err("Camera type (%d) not recognized", ov->customid);
5269                 err("Please notify " EMAIL " of the name,");
5270                 err("manufacturer, model, and this number of your camera.");
5271                 err("Also include the output of the detection process.");
5272         } 
5273
5274         if (ov->customid == 70)         /* USB Life TV (PAL/SECAM) */
5275                 ov->pal = 1;
5276
5277         if (write_regvals(ov, aRegvalsInit511))
5278                 goto error;
5279
5280         if (ov->led_policy == LED_OFF || ov->led_policy == LED_AUTO)
5281                 ov51x_led_control(ov, 0);
5282
5283         /* The OV511+ has undocumented bits in the flow control register.
5284          * Setting it to 0xff fixes the corruption with moving objects. */
5285         if (ov->bridge == BRG_OV511) {
5286                 if (write_regvals(ov, aRegvalsNorm511))
5287                         goto error;
5288         } else if (ov->bridge == BRG_OV511PLUS) {
5289                 if (write_regvals(ov, aRegvalsNorm511Plus))
5290                         goto error;
5291         } else {
5292                 err("Invalid bridge");
5293         }
5294
5295         if (ov511_init_compression(ov))
5296                 goto error;
5297
5298         ov->packet_numbering = 1;
5299         ov511_set_packet_size(ov, 0);
5300
5301         ov->snap_enabled = snapshot;
5302
5303         /* Test for 7xx0 */
5304         PDEBUG(3, "Testing for 0V7xx0");
5305         ov->primary_i2c_slave = OV7xx0_SID;
5306         if (ov51x_set_slave_ids(ov, OV7xx0_SID) < 0)
5307                 goto error;
5308
5309         if (i2c_w(ov, 0x12, 0x80) < 0) {
5310                 /* Test for 6xx0 */
5311                 PDEBUG(3, "Testing for 0V6xx0");
5312                 ov->primary_i2c_slave = OV6xx0_SID;
5313                 if (ov51x_set_slave_ids(ov, OV6xx0_SID) < 0)
5314                         goto error;
5315
5316                 if (i2c_w(ov, 0x12, 0x80) < 0) {
5317                         /* Test for 8xx0 */
5318                         PDEBUG(3, "Testing for 0V8xx0");
5319                         ov->primary_i2c_slave = OV8xx0_SID;
5320                         if (ov51x_set_slave_ids(ov, OV8xx0_SID) < 0)
5321                                 goto error;
5322
5323                         if (i2c_w(ov, 0x12, 0x80) < 0) {
5324                                 /* Test for SAA7111A */
5325                                 PDEBUG(3, "Testing for SAA7111A");
5326                                 ov->primary_i2c_slave = SAA7111A_SID;
5327                                 if (ov51x_set_slave_ids(ov, SAA7111A_SID) < 0)
5328                                         goto error;
5329
5330                                 if (i2c_w(ov, 0x0d, 0x00) < 0) {
5331                                         /* Test for KS0127 */
5332                                         PDEBUG(3, "Testing for KS0127");
5333                                         ov->primary_i2c_slave = KS0127_SID;
5334                                         if (ov51x_set_slave_ids(ov, KS0127_SID) < 0)
5335                                                 goto error;
5336
5337                                         if (i2c_w(ov, 0x10, 0x00) < 0) {
5338                                                 err("Can't determine sensor slave IDs");
5339                                                 goto error;
5340                                         } else {
5341                                                 if (ks0127_configure(ov) < 0) {
5342                                                         err("Failed to configure KS0127");
5343                                                         goto error;
5344                                                 }
5345                                         }
5346                                 } else {
5347                                         if (saa7111a_configure(ov) < 0) {
5348                                                 err("Failed to configure SAA7111A");
5349                                                 goto error;
5350                                         }
5351                                 }
5352                         } else {
5353                                 err("Detected unsupported OV8xx0 sensor");
5354                                 goto error;
5355                         }
5356                 } else {
5357                         if (ov6xx0_configure(ov) < 0) {
5358                                 err("Failed to configure OV6xx0");
5359                                 goto error;
5360                         }
5361                 }
5362         } else {
5363                 if (ov7xx0_configure(ov) < 0) {
5364                         err("Failed to configure OV7xx0");
5365                         goto error;
5366                 }
5367         }
5368
5369         return 0;
5370
5371 error:
5372         err("OV511 Config failed");
5373
5374         return -EBUSY;
5375 }
5376
5377 /* This initializes the OV518/OV518+ and the sensor */
5378 static int
5379 ov518_configure(struct usb_ov511 *ov)
5380 {
5381         /* For 518 and 518+ */
5382         static struct ov511_regvals aRegvalsInit518[] = {
5383                 { OV511_REG_BUS, R51x_SYS_RESET,        0x40 },
5384                 { OV511_REG_BUS, R51x_SYS_INIT,         0xe1 },
5385                 { OV511_REG_BUS, R51x_SYS_RESET,        0x3e },
5386                 { OV511_REG_BUS, R51x_SYS_INIT,         0xe1 },
5387                 { OV511_REG_BUS, R51x_SYS_RESET,        0x00 },
5388                 { OV511_REG_BUS, R51x_SYS_INIT,         0xe1 },
5389                 { OV511_REG_BUS, 0x46,                  0x00 }, 
5390                 { OV511_REG_BUS, 0x5d,                  0x03 },
5391                 { OV511_DONE_BUS, 0x0, 0x00},
5392         };
5393
5394         static struct ov511_regvals aRegvalsNorm518[] = {
5395                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x02 }, /* Reset */
5396                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x01 }, /* Enable */
5397                 { OV511_REG_BUS, 0x31,                  0x0f },
5398                 { OV511_REG_BUS, 0x5d,                  0x03 },
5399                 { OV511_REG_BUS, 0x24,                  0x9f },
5400                 { OV511_REG_BUS, 0x25,                  0x90 },
5401                 { OV511_REG_BUS, 0x20,                  0x00 },
5402                 { OV511_REG_BUS, 0x51,                  0x04 },
5403                 { OV511_REG_BUS, 0x71,                  0x19 },
5404                 { OV511_DONE_BUS, 0x0, 0x00 },
5405         };
5406
5407         static struct ov511_regvals aRegvalsNorm518Plus[] = {
5408                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x02 }, /* Reset */
5409                 { OV511_REG_BUS, R51x_SYS_SNAP,         0x01 }, /* Enable */
5410                 { OV511_REG_BUS, 0x31,                  0x0f },
5411                 { OV511_REG_BUS, 0x5d,                  0x03 },
5412                 { OV511_REG_BUS, 0x24,                  0x9f },
5413                 { OV511_REG_BUS, 0x25,                  0x90 },
5414                 { OV511_REG_BUS, 0x20,                  0x60 },
5415                 { OV511_REG_BUS, 0x51,                  0x02 },
5416                 { OV511_REG_BUS, 0x71,                  0x19 },
5417                 { OV511_REG_BUS, 0x40,                  0xff },
5418                 { OV511_REG_BUS, 0x41,                  0x42 },
5419                 { OV511_REG_BUS, 0x46,                  0x00 },
5420                 { OV511_REG_BUS, 0x33,                  0x04 },
5421                 { OV511_REG_BUS, 0x21,                  0x19 },
5422                 { OV511_REG_BUS, 0x3f,                  0x10 },
5423                 { OV511_DONE_BUS, 0x0, 0x00 },
5424         };
5425
5426         PDEBUG(4, "");
5427
5428         /* First 5 bits of custom ID reg are a revision ID on OV518 */
5429         info("Device revision %d", 0x1F & reg_r(ov, R511_SYS_CUST_ID));
5430
5431         /* Give it the default description */
5432         ov->desc = symbolic(camlist, 0);
5433
5434         if (write_regvals(ov, aRegvalsInit518))
5435                 goto error;
5436
5437         /* Set LED GPIO pin to output mode */
5438         if (reg_w_mask(ov, 0x57, 0x00, 0x02) < 0)
5439                 goto error;
5440
5441         /* LED is off by default with OV518; have to explicitly turn it on */
5442         if (ov->led_policy == LED_OFF || ov->led_policy == LED_AUTO)
5443                 ov51x_led_control(ov, 0);
5444         else
5445                 ov51x_led_control(ov, 1);
5446
5447         /* Don't require compression if dumppix is enabled; otherwise it's
5448          * required. OV518 has no uncompressed mode, to save RAM. */
5449         if (!dumppix && !ov->compress) {
5450                 ov->compress = 1;
5451                 warn("Compression required with OV518...enabling");
5452         }
5453
5454         if (ov->bridge == BRG_OV518) {
5455                 if (write_regvals(ov, aRegvalsNorm518))
5456                         goto error;
5457         } else if (ov->bridge == BRG_OV518PLUS) {
5458                 if (write_regvals(ov, aRegvalsNorm518Plus))
5459                         goto error;
5460         } else {
5461                 err("Invalid bridge");
5462         }
5463
5464         if (reg_w(ov, 0x2f, 0x80) < 0)
5465                 goto error;
5466
5467         if (ov518_init_compression(ov))
5468                 goto error;
5469
5470         if (ov->bridge == BRG_OV518)
5471         {
5472                 struct usb_interface *ifp;
5473                 struct usb_host_interface *alt;
5474                 __u16 mxps = 0;
5475
5476                 ifp = usb_ifnum_to_if(ov->dev, 0);
5477                 if (ifp) {
5478                         alt = usb_altnum_to_altsetting(ifp, 7);
5479                         if (alt)
5480                                 mxps = le16_to_cpu(alt->endpoint[0].desc.wMaxPacketSize);
5481                 }
5482
5483                 /* Some OV518s have packet numbering by default, some don't */
5484                 if (mxps == 897)
5485                         ov->packet_numbering = 1;
5486                 else
5487                         ov->packet_numbering = 0;
5488         } else {
5489                 /* OV518+ has packet numbering turned on by default */
5490                 ov->packet_numbering = 1;
5491         }
5492
5493         ov518_set_packet_size(ov, 0);
5494
5495         ov->snap_enabled = snapshot;
5496
5497         /* Test for 76xx */
5498         ov->primary_i2c_slave = OV7xx0_SID;
5499         if (ov51x_set_slave_ids(ov, OV7xx0_SID) < 0)
5500                 goto error;
5501
5502         /* The OV518 must be more aggressive about sensor detection since
5503          * I2C write will never fail if the sensor is not present. We have
5504          * to try to initialize the sensor to detect its presence */
5505
5506         if (init_ov_sensor(ov) < 0) {
5507                 /* Test for 6xx0 */
5508                 ov->primary_i2c_slave = OV6xx0_SID;
5509                 if (ov51x_set_slave_ids(ov, OV6xx0_SID) < 0)
5510                         goto error;
5511
5512                 if (init_ov_sensor(ov) < 0) {
5513                         /* Test for 8xx0 */
5514                         ov->primary_i2c_slave = OV8xx0_SID;
5515                         if (ov51x_set_slave_ids(ov, OV8xx0_SID) < 0)
5516                                 goto error;
5517
5518                         if (init_ov_sensor(ov) < 0) {
5519                                 err("Can't determine sensor slave IDs");
5520                                 goto error;
5521                         } else {
5522                                 err("Detected unsupported OV8xx0 sensor");
5523                                 goto error;
5524                         }
5525                 } else {
5526                         if (ov6xx0_configure(ov) < 0) {
5527                                 err("Failed to configure OV6xx0");
5528                                 goto error;
5529                         }
5530                 }
5531         } else {
5532                 if (ov7xx0_configure(ov) < 0) {
5533                         err("Failed to configure OV7xx0");
5534                         goto error;
5535                 }
5536         }
5537
5538         ov->maxwidth = 352;
5539         ov->maxheight = 288;
5540
5541         // The OV518 cannot go as low as the sensor can
5542         ov->minwidth = 160;
5543         ov->minheight = 120;
5544
5545         return 0;
5546
5547 error:
5548         err("OV518 Config failed");
5549
5550         return -EBUSY;
5551 }
5552
5553 /****************************************************************************
5554  *  sysfs
5555  ***************************************************************************/
5556
5557 static inline struct usb_ov511 *cd_to_ov(struct class_device *cd)
5558 {
5559         struct video_device *vdev = to_video_device(cd);
5560         return video_get_drvdata(vdev);
5561 }
5562
5563 static ssize_t show_custom_id(struct class_device *cd, char *buf)
5564 {
5565         struct usb_ov511 *ov = cd_to_ov(cd);
5566         return sprintf(buf, "%d\n", ov->customid);
5567
5568 static CLASS_DEVICE_ATTR(custom_id, S_IRUGO, show_custom_id, NULL);
5569
5570 static ssize_t show_model(struct class_device *cd, char *buf)
5571 {
5572         struct usb_ov511 *ov = cd_to_ov(cd);
5573         return sprintf(buf, "%s\n", ov->desc);
5574
5575 static CLASS_DEVICE_ATTR(model, S_IRUGO, show_model, NULL);
5576
5577 static ssize_t show_bridge(struct class_device *cd, char *buf)
5578 {
5579         struct usb_ov511 *ov = cd_to_ov(cd);
5580         return sprintf(buf, "%s\n", symbolic(brglist, ov->bridge));
5581
5582 static CLASS_DEVICE_ATTR(bridge, S_IRUGO, show_bridge, NULL);
5583
5584 static ssize_t show_sensor(struct class_device *cd, char *buf)
5585 {
5586         struct usb_ov511 *ov = cd_to_ov(cd);
5587         return sprintf(buf, "%s\n", symbolic(senlist, ov->sensor));
5588
5589 static CLASS_DEVICE_ATTR(sensor, S_IRUGO, show_sensor, NULL);
5590
5591 static ssize_t show_brightness(struct class_device *cd, char *buf)
5592 {
5593         struct usb_ov511 *ov = cd_to_ov(cd);
5594         unsigned short x;
5595
5596         if (!ov->dev)
5597                 return -ENODEV;
5598         sensor_get_brightness(ov, &x);
5599         return sprintf(buf, "%d\n", x >> 8);
5600
5601 static CLASS_DEVICE_ATTR(brightness, S_IRUGO, show_brightness, NULL);
5602
5603 static ssize_t show_saturation(struct class_device *cd, char *buf)
5604 {
5605         struct usb_ov511 *ov = cd_to_ov(cd);
5606         unsigned short x;
5607
5608         if (!ov->dev)
5609                 return -ENODEV;
5610         sensor_get_saturation(ov, &x);
5611         return sprintf(buf, "%d\n", x >> 8);
5612
5613 static CLASS_DEVICE_ATTR(saturation, S_IRUGO, show_saturation, NULL);
5614
5615 static ssize_t show_contrast(struct class_device *cd, char *buf)
5616 {
5617         struct usb_ov511 *ov = cd_to_ov(cd);
5618         unsigned short x;
5619
5620         if (!ov->dev)
5621                 return -ENODEV;
5622         sensor_get_contrast(ov, &x);
5623         return sprintf(buf, "%d\n", x >> 8);
5624
5625 static CLASS_DEVICE_ATTR(contrast, S_IRUGO, show_contrast, NULL);
5626
5627 static ssize_t show_hue(struct class_device *cd, char *buf)
5628 {
5629         struct usb_ov511 *ov = cd_to_ov(cd);
5630         unsigned short x;
5631
5632         if (!ov->dev)
5633                 return -ENODEV;
5634         sensor_get_hue(ov, &x);
5635         return sprintf(buf, "%d\n", x >> 8);
5636
5637 static CLASS_DEVICE_ATTR(hue, S_IRUGO, show_hue, NULL);
5638
5639 static ssize_t show_exposure(struct class_device *cd, char *buf)
5640 {
5641         struct usb_ov511 *ov = cd_to_ov(cd);
5642         unsigned char exp;
5643
5644         if (!ov->dev)
5645                 return -ENODEV;
5646         sensor_get_exposure(ov, &exp);
5647         return sprintf(buf, "%d\n", exp >> 8);
5648
5649 static CLASS_DEVICE_ATTR(exposure, S_IRUGO, show_exposure, NULL);
5650
5651 static void ov_create_sysfs(struct video_device *vdev)
5652 {
5653         video_device_create_file(vdev, &class_device_attr_custom_id);
5654         video_device_create_file(vdev, &class_device_attr_model);
5655         video_device_create_file(vdev, &class_device_attr_bridge);
5656         video_device_create_file(vdev, &class_device_attr_sensor);
5657         video_device_create_file(vdev, &class_device_attr_brightness);
5658         video_device_create_file(vdev, &class_device_attr_saturation);
5659         video_device_create_file(vdev, &class_device_attr_contrast);
5660         video_device_create_file(vdev, &class_device_attr_hue);
5661         video_device_create_file(vdev, &class_device_attr_exposure);
5662 }
5663
5664 /****************************************************************************
5665  *  USB routines
5666  ***************************************************************************/
5667
5668 static int
5669 ov51x_probe(struct usb_interface *intf, const struct usb_device_id *id)
5670 {
5671         struct usb_device *dev = interface_to_usbdev(intf);
5672         struct usb_interface_descriptor *idesc;
5673         struct usb_ov511 *ov;
5674         int i;
5675
5676         PDEBUG(1, "probing for device...");
5677
5678         /* We don't handle multi-config cameras */
5679         if (dev->descriptor.bNumConfigurations != 1)
5680                 return -ENODEV;
5681
5682         idesc = &intf->cur_altsetting->desc;
5683
5684         if (idesc->bInterfaceClass != 0xFF)
5685                 return -ENODEV;
5686         if (idesc->bInterfaceSubClass != 0x00)
5687                 return -ENODEV;
5688
5689         if ((ov = kmalloc(sizeof(*ov), GFP_KERNEL)) == NULL) {
5690                 err("couldn't kmalloc ov struct");
5691                 goto error_out;
5692         }
5693
5694         memset(ov, 0, sizeof(*ov));
5695
5696         ov->dev = dev;
5697         ov->iface = idesc->bInterfaceNumber;
5698         ov->led_policy = led;
5699         ov->compress = compress;
5700         ov->lightfreq = lightfreq;
5701         ov->num_inputs = 1;        /* Video decoder init functs. change this */
5702         ov->stop_during_set = !fastset;
5703         ov->backlight = backlight;
5704         ov->mirror = mirror;
5705         ov->auto_brt = autobright;
5706         ov->auto_gain = autogain;
5707         ov->auto_exp = autoexp;
5708
5709         switch (le16_to_cpu(dev->descriptor.idProduct)) {
5710         case PROD_OV511:
5711                 ov->bridge = BRG_OV511;
5712                 ov->bclass = BCL_OV511;
5713                 break;
5714         case PROD_OV511PLUS:
5715                 ov->bridge = BRG_OV511PLUS;
5716                 ov->bclass = BCL_OV511;
5717                 break;
5718         case PROD_OV518:
5719                 ov->bridge = BRG_OV518;
5720                 ov->bclass = BCL_OV518;
5721                 break;
5722         case PROD_OV518PLUS:
5723                 ov->bridge = BRG_OV518PLUS;
5724                 ov->bclass = BCL_OV518;
5725                 break;
5726         case PROD_ME2CAM:
5727                 if (le16_to_cpu(dev->descriptor.idVendor) != VEND_MATTEL)
5728                         goto error;
5729                 ov->bridge = BRG_OV511PLUS;
5730                 ov->bclass = BCL_OV511;
5731                 break;
5732         default:
5733                 err("Unknown product ID 0x%04x", le16_to_cpu(dev->descriptor.idProduct));
5734                 goto error;
5735         }
5736
5737         info("USB %s video device found", symbolic(brglist, ov->bridge));
5738
5739         init_waitqueue_head(&ov->wq);
5740
5741         mutex_init(&ov->lock);  /* to 1 == available */
5742         mutex_init(&ov->buf_lock);
5743         mutex_init(&ov->i2c_lock);
5744         mutex_init(&ov->cbuf_lock);
5745
5746         ov->buf_state = BUF_NOT_ALLOCATED;
5747
5748         if (usb_make_path(dev, ov->usb_path, OV511_USB_PATH_LEN) < 0) {
5749                 err("usb_make_path error");
5750                 goto error;
5751         }
5752
5753         /* Allocate control transfer buffer. */
5754         /* Must be kmalloc()'ed, for DMA compatibility */
5755         ov->cbuf = kmalloc(OV511_CBUF_SIZE, GFP_KERNEL);
5756         if (!ov->cbuf)
5757                 goto error;
5758
5759         if (ov->bclass == BCL_OV518) {
5760                 if (ov518_configure(ov) < 0)
5761                         goto error;
5762         } else {
5763                 if (ov511_configure(ov) < 0)
5764                         goto error;
5765         }
5766
5767         for (i = 0; i < OV511_NUMFRAMES; i++) {
5768                 ov->frame[i].framenum = i;
5769                 init_waitqueue_head(&ov->frame[i].wq);
5770         }
5771
5772         for (i = 0; i < OV511_NUMSBUF; i++) {
5773                 ov->sbuf[i].ov = ov;
5774                 spin_lock_init(&ov->sbuf[i].lock);
5775                 ov->sbuf[i].n = i;
5776         }
5777
5778         /* Unnecessary? (This is done on open(). Need to make sure variables
5779          * are properly initialized without this before removing it, though). */
5780         if (ov51x_set_default_params(ov) < 0)
5781                 goto error;
5782
5783 #ifdef OV511_DEBUG
5784         if (dump_bridge) {
5785                 if (ov->bclass == BCL_OV511)
5786                         ov511_dump_regs(ov);
5787                 else
5788                         ov518_dump_regs(ov);
5789         }
5790 #endif
5791
5792         ov->vdev = video_device_alloc();
5793         if (!ov->vdev)
5794                 goto error;
5795
5796         memcpy(ov->vdev, &vdev_template, sizeof(*ov->vdev));
5797         ov->vdev->dev = &dev->dev;
5798         video_set_drvdata(ov->vdev, ov);
5799
5800         for (i = 0; i < OV511_MAX_UNIT_VIDEO; i++) {
5801                 /* Minor 0 cannot be specified; assume user wants autodetect */
5802                 if (unit_video[i] == 0)
5803                         break;
5804
5805                 if (video_register_device(ov->vdev, VFL_TYPE_GRABBER,
5806                         unit_video[i]) >= 0) {
5807                         break;
5808                 }
5809         }
5810
5811         /* Use the next available one */
5812         if ((ov->vdev->minor == -1) &&
5813             video_register_device(ov->vdev, VFL_TYPE_GRABBER, -1) < 0) {
5814                 err("video_register_device failed");
5815                 goto error;
5816         }
5817
5818         info("Device at %s registered to minor %d", ov->usb_path,
5819              ov->vdev->minor);
5820
5821         usb_set_intfdata(intf, ov);
5822         ov_create_sysfs(ov->vdev);
5823         return 0;
5824
5825 error:
5826         if (ov->vdev) {
5827                 if (-1 == ov->vdev->minor)
5828                         video_device_release(ov->vdev);
5829                 else
5830                         video_unregister_device(ov->vdev);
5831                 ov->vdev = NULL;
5832         }
5833
5834         if (ov->cbuf) {
5835                 mutex_lock(&ov->cbuf_lock);
5836                 kfree(ov->cbuf);
5837                 ov->cbuf = NULL;
5838                 mutex_unlock(&ov->cbuf_lock);
5839         }
5840
5841         kfree(ov);
5842         ov = NULL;
5843
5844 error_out:
5845         err("Camera initialization failed");
5846         return -EIO;
5847 }
5848
5849 static void
5850 ov51x_disconnect(struct usb_interface *intf)
5851 {
5852         struct usb_ov511 *ov = usb_get_intfdata(intf);
5853         int n;
5854
5855         PDEBUG(3, "");
5856
5857         usb_set_intfdata (intf, NULL);
5858
5859         if (!ov)
5860                 return;
5861
5862         if (ov->vdev)
5863                 video_unregister_device(ov->vdev);
5864
5865         for (n = 0; n < OV511_NUMFRAMES; n++)
5866                 ov->frame[n].grabstate = FRAME_ERROR;
5867
5868         ov->curframe = -1;
5869
5870         /* This will cause the process to request another frame */
5871         for (n = 0; n < OV511_NUMFRAMES; n++)
5872                 wake_up_interruptible(&ov->frame[n].wq);
5873
5874         wake_up_interruptible(&ov->wq);
5875
5876         ov->streaming = 0;
5877         ov51x_unlink_isoc(ov);
5878
5879         ov->dev = NULL;
5880
5881         /* Free the memory */
5882         if (ov && !ov->user) {
5883                 mutex_lock(&ov->cbuf_lock);
5884                 kfree(ov->cbuf);
5885                 ov->cbuf = NULL;
5886                 mutex_unlock(&ov->cbuf_lock);
5887
5888                 ov51x_dealloc(ov);
5889                 kfree(ov);
5890                 ov = NULL;
5891         }
5892
5893         PDEBUG(3, "Disconnect complete");
5894 }
5895
5896 static struct usb_driver ov511_driver = {
5897         .name =         "ov511",
5898         .id_table =     device_table,
5899         .probe =        ov51x_probe,
5900         .disconnect =   ov51x_disconnect
5901 };
5902
5903 /****************************************************************************
5904  *
5905  *  Module routines
5906  *
5907  ***************************************************************************/
5908
5909 static int __init
5910 usb_ov511_init(void)
5911 {
5912         int retval;
5913
5914         retval = usb_register(&ov511_driver);
5915         if (retval)
5916                 goto out;
5917
5918         info(DRIVER_VERSION " : " DRIVER_DESC);
5919
5920 out:
5921         return retval;
5922 }
5923
5924 static void __exit
5925 usb_ov511_exit(void)
5926 {
5927         usb_deregister(&ov511_driver);
5928         info("driver deregistered");
5929
5930 }
5931
5932 module_init(usb_ov511_init);
5933 module_exit(usb_ov511_exit);
5934