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