linux/drivers/media/video/w9968cf.c
<<
>>
Prefs
   1/***************************************************************************
   2 * Video4Linux driver for W996[87]CF JPEG USB Dual Mode Camera Chip.       *
   3 *                                                                         *
   4 * Copyright (C) 2002-2004 by Luca Risolia <luca.risolia@studio.unibo.it>  *
   5 *                                                                         *
   6 * - Memory management code from bttv driver by Ralph Metzler,             *
   7 *   Marcus Metzler and Gerd Knorr.                                        *
   8 * - I2C interface to kernel, high-level image sensor control routines and *
   9 *   some symbolic names from OV511 driver by Mark W. McClelland.          *
  10 * - Low-level I2C fast write function by Piotr Czerczak.                  *
  11 * - Low-level I2C read function by Frederic Jouault.                      *
  12 *                                                                         *
  13 * This program is free software; you can redistribute it and/or modify    *
  14 * it under the terms of the GNU General Public License as published by    *
  15 * the Free Software Foundation; either version 2 of the License, or       *
  16 * (at your option) any later version.                                     *
  17 *                                                                         *
  18 * This program is distributed in the hope that it will be useful,         *
  19 * but WITHOUT ANY WARRANTY; without even the implied warranty of          *
  20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the           *
  21 * GNU General Public License for more details.                            *
  22 *                                                                         *
  23 * You should have received a copy of the GNU General Public License       *
  24 * along with this program; if not, write to the Free Software             *
  25 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.               *
  26 ***************************************************************************/
  27
  28#include <linux/module.h>
  29#include <linux/kernel.h>
  30#include <linux/kmod.h>
  31#include <linux/init.h>
  32#include <linux/fs.h>
  33#include <linux/vmalloc.h>
  34#include <linux/slab.h>
  35#include <linux/mm.h>
  36#include <linux/string.h>
  37#include <linux/errno.h>
  38#include <linux/sched.h>
  39#include <linux/ioctl.h>
  40#include <linux/delay.h>
  41#include <linux/stddef.h>
  42#include <asm/page.h>
  43#include <asm/uaccess.h>
  44#include <linux/page-flags.h>
  45#include <linux/videodev.h>
  46#include <media/v4l2-ioctl.h>
  47
  48#include "w9968cf.h"
  49#include "w9968cf_decoder.h"
  50
  51static struct w9968cf_vpp_t* w9968cf_vpp;
  52static DECLARE_WAIT_QUEUE_HEAD(w9968cf_vppmod_wait);
  53
  54static LIST_HEAD(w9968cf_dev_list); /* head of V4L registered cameras list */
  55static DEFINE_MUTEX(w9968cf_devlist_mutex); /* semaphore for list traversal */
  56
  57static DECLARE_RWSEM(w9968cf_disconnect); /* prevent races with open() */
  58
  59
  60/****************************************************************************
  61 * Module macros and parameters                                             *
  62 ****************************************************************************/
  63
  64MODULE_DEVICE_TABLE(usb, winbond_id_table);
  65
  66MODULE_AUTHOR(W9968CF_MODULE_AUTHOR" "W9968CF_AUTHOR_EMAIL);
  67MODULE_DESCRIPTION(W9968CF_MODULE_NAME);
  68MODULE_VERSION(W9968CF_MODULE_VERSION);
  69MODULE_LICENSE(W9968CF_MODULE_LICENSE);
  70MODULE_SUPPORTED_DEVICE("Video");
  71
  72static unsigned short simcams = W9968CF_SIMCAMS;
  73static short video_nr[]={[0 ... W9968CF_MAX_DEVICES-1] = -1}; /*-1=first free*/
  74static unsigned int packet_size[] = {[0 ... W9968CF_MAX_DEVICES-1] =
  75                                     W9968CF_PACKET_SIZE};
  76static unsigned short max_buffers[] = {[0 ... W9968CF_MAX_DEVICES-1] =
  77                                       W9968CF_BUFFERS};
  78static int double_buffer[] = {[0 ... W9968CF_MAX_DEVICES-1] =
  79                              W9968CF_DOUBLE_BUFFER};
  80static int clamping[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_CLAMPING};
  81static unsigned short filter_type[]= {[0 ... W9968CF_MAX_DEVICES-1] =
  82                                      W9968CF_FILTER_TYPE};
  83static int largeview[]= {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_LARGEVIEW};
  84static unsigned short decompression[] = {[0 ... W9968CF_MAX_DEVICES-1] =
  85                                         W9968CF_DECOMPRESSION};
  86static int upscaling[]= {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_UPSCALING};
  87static unsigned short force_palette[] = {[0 ... W9968CF_MAX_DEVICES-1] = 0};
  88static int force_rgb[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_FORCE_RGB};
  89static int autobright[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_AUTOBRIGHT};
  90static int autoexp[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_AUTOEXP};
  91static unsigned short lightfreq[] = {[0 ... W9968CF_MAX_DEVICES-1] =
  92                                     W9968CF_LIGHTFREQ};
  93static int bandingfilter[] = {[0 ... W9968CF_MAX_DEVICES-1]=
  94                              W9968CF_BANDINGFILTER};
  95static short clockdiv[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_CLOCKDIV};
  96static int backlight[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_BACKLIGHT};
  97static int mirror[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_MIRROR};
  98static int monochrome[] = {[0 ... W9968CF_MAX_DEVICES-1]=W9968CF_MONOCHROME};
  99static unsigned int brightness[] = {[0 ... W9968CF_MAX_DEVICES-1] =
 100                                    W9968CF_BRIGHTNESS};
 101static unsigned int hue[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_HUE};
 102static unsigned int colour[]={[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_COLOUR};
 103static unsigned int contrast[] = {[0 ... W9968CF_MAX_DEVICES-1] =
 104                                  W9968CF_CONTRAST};
 105static unsigned int whiteness[] = {[0 ... W9968CF_MAX_DEVICES-1] =
 106                                   W9968CF_WHITENESS};
 107#ifdef W9968CF_DEBUG
 108static unsigned short debug = W9968CF_DEBUG_LEVEL;
 109static int specific_debug = W9968CF_SPECIFIC_DEBUG;
 110#endif
 111
 112static unsigned int param_nv[24]; /* number of values per parameter */
 113
 114module_param(simcams, ushort, 0644);
 115module_param_array(video_nr, short, &param_nv[0], 0444);
 116module_param_array(packet_size, uint, &param_nv[1], 0444);
 117module_param_array(max_buffers, ushort, &param_nv[2], 0444);
 118module_param_array(double_buffer, bool, &param_nv[3], 0444);
 119module_param_array(clamping, bool, &param_nv[4], 0444);
 120module_param_array(filter_type, ushort, &param_nv[5], 0444);
 121module_param_array(largeview, bool, &param_nv[6], 0444);
 122module_param_array(decompression, ushort, &param_nv[7], 0444);
 123module_param_array(upscaling, bool, &param_nv[8], 0444);
 124module_param_array(force_palette, ushort, &param_nv[9], 0444);
 125module_param_array(force_rgb, ushort, &param_nv[10], 0444);
 126module_param_array(autobright, bool, &param_nv[11], 0444);
 127module_param_array(autoexp, bool, &param_nv[12], 0444);
 128module_param_array(lightfreq, ushort, &param_nv[13], 0444);
 129module_param_array(bandingfilter, bool, &param_nv[14], 0444);
 130module_param_array(clockdiv, short, &param_nv[15], 0444);
 131module_param_array(backlight, bool, &param_nv[16], 0444);
 132module_param_array(mirror, bool, &param_nv[17], 0444);
 133module_param_array(monochrome, bool, &param_nv[18], 0444);
 134module_param_array(brightness, uint, &param_nv[19], 0444);
 135module_param_array(hue, uint, &param_nv[20], 0444);
 136module_param_array(colour, uint, &param_nv[21], 0444);
 137module_param_array(contrast, uint, &param_nv[22], 0444);
 138module_param_array(whiteness, uint, &param_nv[23], 0444);
 139#ifdef W9968CF_DEBUG
 140module_param(debug, ushort, 0644);
 141module_param(specific_debug, bool, 0644);
 142#endif
 143
 144MODULE_PARM_DESC(simcams,
 145                 "\n<n> Number of cameras allowed to stream simultaneously."
 146                 "\nn may vary from 0 to "
 147                 __MODULE_STRING(W9968CF_MAX_DEVICES)"."
 148                 "\nDefault value is "__MODULE_STRING(W9968CF_SIMCAMS)"."
 149                 "\n");
 150MODULE_PARM_DESC(video_nr,
 151                 "\n<-1|n[,...]> Specify V4L minor mode number."
 152                 "\n -1 = use next available (default)"
 153                 "\n  n = use minor number n (integer >= 0)"
 154                 "\nYou can specify up to "__MODULE_STRING(W9968CF_MAX_DEVICES)
 155                 " cameras this way."
 156                 "\nFor example:"
 157                 "\nvideo_nr=-1,2,-1 would assign minor number 2 to"
 158                 "\nthe second camera and use auto for the first"
 159                 "\none and for every other camera."
 160                 "\n");
 161MODULE_PARM_DESC(packet_size,
 162                 "\n<n[,...]> Specify the maximum data payload"
 163                 "\nsize in bytes for alternate settings, for each device."
 164                 "\nn is scaled between 63 and 1023 "
 165                 "(default is "__MODULE_STRING(W9968CF_PACKET_SIZE)")."
 166                 "\n");
 167MODULE_PARM_DESC(max_buffers,
 168                 "\n<n[,...]> For advanced users."
 169                 "\nSpecify the maximum number of video frame buffers"
 170                 "\nto allocate for each device, from 2 to "
 171                 __MODULE_STRING(W9968CF_MAX_BUFFERS)
 172                 ". (default is "__MODULE_STRING(W9968CF_BUFFERS)")."
 173                 "\n");
 174MODULE_PARM_DESC(double_buffer,
 175                 "\n<0|1[,...]> "
 176                 "Hardware double buffering: 0 disabled, 1 enabled."
 177                 "\nIt should be enabled if you want smooth video output: if"
 178                 "\nyou obtain out of sync. video, disable it, or try to"
 179                 "\ndecrease the 'clockdiv' module parameter value."
 180                 "\nDefault value is "__MODULE_STRING(W9968CF_DOUBLE_BUFFER)
 181                 " for every device."
 182                 "\n");
 183MODULE_PARM_DESC(clamping,
 184                 "\n<0|1[,...]> Video data clamping: 0 disabled, 1 enabled."
 185                 "\nDefault value is "__MODULE_STRING(W9968CF_CLAMPING)
 186                 " for every device."
 187                 "\n");
 188MODULE_PARM_DESC(filter_type,
 189                 "\n<0|1|2[,...]> Video filter type."
 190                 "\n0 none, 1 (1-2-1) 3-tap filter, "
 191                 "2 (2-3-6-3-2) 5-tap filter."
 192                 "\nDefault value is "__MODULE_STRING(W9968CF_FILTER_TYPE)
 193                 " for every device."
 194                 "\nThe filter is used to reduce noise and aliasing artifacts"
 195                 "\nproduced by the CCD or CMOS image sensor, and the scaling"
 196                 " process."
 197                 "\n");
 198MODULE_PARM_DESC(largeview,
 199                 "\n<0|1[,...]> Large view: 0 disabled, 1 enabled."
 200                 "\nDefault value is "__MODULE_STRING(W9968CF_LARGEVIEW)
 201                 " for every device."
 202                 "\n");
 203MODULE_PARM_DESC(upscaling,
 204                 "\n<0|1[,...]> Software scaling (for non-compressed video):"
 205                 "\n0 disabled, 1 enabled."
 206                 "\nDisable it if you have a slow CPU or you don't have"
 207                 " enough memory."
 208                 "\nDefault value is "__MODULE_STRING(W9968CF_UPSCALING)
 209                 " for every device."
 210                 "\nIf 'w9968cf-vpp' is not present, this parameter is"
 211                 " set to 0."
 212                 "\n");
 213MODULE_PARM_DESC(decompression,
 214                 "\n<0|1|2[,...]> Software video decompression:"
 215                 "\n- 0 disables decompression (doesn't allow formats needing"
 216                 " decompression)"
 217                 "\n- 1 forces decompression (allows formats needing"
 218                 " decompression only);"
 219                 "\n- 2 allows any permitted formats."
 220                 "\nFormats supporting compressed video are YUV422P and"
 221                 " YUV420P/YUV420 "
 222                 "\nin any resolutions where both width and height are "
 223                 "a multiple of 16."
 224                 "\nDefault value is "__MODULE_STRING(W9968CF_DECOMPRESSION)
 225                 " for every device."
 226                 "\nIf 'w9968cf-vpp' is not present, forcing decompression is "
 227                 "\nnot allowed; in this case this parameter is set to 2."
 228                 "\n");
 229MODULE_PARM_DESC(force_palette,
 230                 "\n<0"
 231                 "|" __MODULE_STRING(VIDEO_PALETTE_UYVY)
 232                 "|" __MODULE_STRING(VIDEO_PALETTE_YUV420)
 233                 "|" __MODULE_STRING(VIDEO_PALETTE_YUV422P)
 234                 "|" __MODULE_STRING(VIDEO_PALETTE_YUV420P)
 235                 "|" __MODULE_STRING(VIDEO_PALETTE_YUYV)
 236                 "|" __MODULE_STRING(VIDEO_PALETTE_YUV422)
 237                 "|" __MODULE_STRING(VIDEO_PALETTE_GREY)
 238                 "|" __MODULE_STRING(VIDEO_PALETTE_RGB555)
 239                 "|" __MODULE_STRING(VIDEO_PALETTE_RGB565)
 240                 "|" __MODULE_STRING(VIDEO_PALETTE_RGB24)
 241                 "|" __MODULE_STRING(VIDEO_PALETTE_RGB32)
 242                 "[,...]>"
 243                 " Force picture palette."
 244                 "\nIn order:"
 245                 "\n- 0 allows any of the following formats:"
 246                 "\n- UYVY    16 bpp - Original video, compression disabled"
 247                 "\n- YUV420  12 bpp - Original video, compression enabled"
 248                 "\n- YUV422P 16 bpp - Original video, compression enabled"
 249                 "\n- YUV420P 12 bpp - Original video, compression enabled"
 250                 "\n- YUVY    16 bpp - Software conversion from UYVY"
 251                 "\n- YUV422  16 bpp - Software conversion from UYVY"
 252                 "\n- GREY     8 bpp - Software conversion from UYVY"
 253                 "\n- RGB555  16 bpp - Software conversion from UYVY"
 254                 "\n- RGB565  16 bpp - Software conversion from UYVY"
 255                 "\n- RGB24   24 bpp - Software conversion from UYVY"
 256                 "\n- RGB32   32 bpp - Software conversion from UYVY"
 257                 "\nWhen not 0, this parameter will override 'decompression'."
 258                 "\nDefault value is 0 for every device."
 259                 "\nInitial palette is "
 260                 __MODULE_STRING(W9968CF_PALETTE_DECOMP_ON)"."
 261                 "\nIf 'w9968cf-vpp' is not present, this parameter is"
 262                 " set to 9 (UYVY)."
 263                 "\n");
 264MODULE_PARM_DESC(force_rgb,
 265                 "\n<0|1[,...]> Read RGB video data instead of BGR:"
 266                 "\n 1 = use RGB component ordering."
 267                 "\n 0 = use BGR component ordering."
 268                 "\nThis parameter has effect when using RGBX palettes only."
 269                 "\nDefault value is "__MODULE_STRING(W9968CF_FORCE_RGB)
 270                 " for every device."
 271                 "\n");
 272MODULE_PARM_DESC(autobright,
 273                 "\n<0|1[,...]> Image sensor automatically changes brightness:"
 274                 "\n 0 = no, 1 = yes"
 275                 "\nDefault value is "__MODULE_STRING(W9968CF_AUTOBRIGHT)
 276                 " for every device."
 277                 "\n");
 278MODULE_PARM_DESC(autoexp,
 279                 "\n<0|1[,...]> Image sensor automatically changes exposure:"
 280                 "\n 0 = no, 1 = yes"
 281                 "\nDefault value is "__MODULE_STRING(W9968CF_AUTOEXP)
 282                 " for every device."
 283                 "\n");
 284MODULE_PARM_DESC(lightfreq,
 285                 "\n<50|60[,...]> Light frequency in Hz:"
 286                 "\n 50 for European and Asian lighting,"
 287                 " 60 for American lighting."
 288                 "\nDefault value is "__MODULE_STRING(W9968CF_LIGHTFREQ)
 289                 " for every device."
 290                 "\n");
 291MODULE_PARM_DESC(bandingfilter,
 292                 "\n<0|1[,...]> Banding filter to reduce effects of"
 293                 " fluorescent lighting:"
 294                 "\n 0 disabled, 1 enabled."
 295                 "\nThis filter tries to reduce the pattern of horizontal"
 296                 "\nlight/dark bands caused by some (usually fluorescent)"
 297                 " lighting."
 298                 "\nDefault value is "__MODULE_STRING(W9968CF_BANDINGFILTER)
 299                 " for every device."
 300                 "\n");
 301MODULE_PARM_DESC(clockdiv,
 302                 "\n<-1|n[,...]> "
 303                 "Force pixel clock divisor to a specific value (for experts):"
 304                 "\n  n may vary from 0 to 127."
 305                 "\n -1 for automatic value."
 306                 "\nSee also the 'double_buffer' module parameter."
 307                 "\nDefault value is "__MODULE_STRING(W9968CF_CLOCKDIV)
 308                 " for every device."
 309                 "\n");
 310MODULE_PARM_DESC(backlight,
 311                 "\n<0|1[,...]> Objects are lit from behind:"
 312                 "\n 0 = no, 1 = yes"
 313                 "\nDefault value is "__MODULE_STRING(W9968CF_BACKLIGHT)
 314                 " for every device."
 315                 "\n");
 316MODULE_PARM_DESC(mirror,
 317                 "\n<0|1[,...]> Reverse image horizontally:"
 318                 "\n 0 = no, 1 = yes"
 319                 "\nDefault value is "__MODULE_STRING(W9968CF_MIRROR)
 320                 " for every device."
 321                 "\n");
 322MODULE_PARM_DESC(monochrome,
 323                 "\n<0|1[,...]> Use image sensor as monochrome sensor:"
 324                 "\n 0 = no, 1 = yes"
 325                 "\nNot all the sensors support monochrome color."
 326                 "\nDefault value is "__MODULE_STRING(W9968CF_MONOCHROME)
 327                 " for every device."
 328                 "\n");
 329MODULE_PARM_DESC(brightness,
 330                 "\n<n[,...]> Set picture brightness (0-65535)."
 331                 "\nDefault value is "__MODULE_STRING(W9968CF_BRIGHTNESS)
 332                 " for every device."
 333                 "\nThis parameter has no effect if 'autobright' is enabled."
 334                 "\n");
 335MODULE_PARM_DESC(hue,
 336                 "\n<n[,...]> Set picture hue (0-65535)."
 337                 "\nDefault value is "__MODULE_STRING(W9968CF_HUE)
 338                 " for every device."
 339                 "\n");
 340MODULE_PARM_DESC(colour,
 341                 "\n<n[,...]> Set picture saturation (0-65535)."
 342                 "\nDefault value is "__MODULE_STRING(W9968CF_COLOUR)
 343                 " for every device."
 344                 "\n");
 345MODULE_PARM_DESC(contrast,
 346                 "\n<n[,...]> Set picture contrast (0-65535)."
 347                 "\nDefault value is "__MODULE_STRING(W9968CF_CONTRAST)
 348                 " for every device."
 349                 "\n");
 350MODULE_PARM_DESC(whiteness,
 351                 "\n<n[,...]> Set picture whiteness (0-65535)."
 352                 "\nDefault value is "__MODULE_STRING(W9968CF_WHITENESS)
 353                 " for every device."
 354                 "\n");
 355#ifdef W9968CF_DEBUG
 356MODULE_PARM_DESC(debug,
 357                 "\n<n> Debugging information level, from 0 to 6:"
 358                 "\n0 = none (use carefully)"
 359                 "\n1 = critical errors"
 360                 "\n2 = significant informations"
 361                 "\n3 = configuration or general messages"
 362                 "\n4 = warnings"
 363                 "\n5 = called functions"
 364                 "\n6 = function internals"
 365                 "\nLevel 5 and 6 are useful for testing only, when only "
 366                 "one device is used."
 367                 "\nDefault value is "__MODULE_STRING(W9968CF_DEBUG_LEVEL)"."
 368                 "\n");
 369MODULE_PARM_DESC(specific_debug,
 370                 "\n<0|1> Enable or disable specific debugging messages:"
 371                 "\n0 = print messages concerning every level"
 372                 " <= 'debug' level."
 373                 "\n1 = print messages concerning the level"
 374                 " indicated by 'debug'."
 375                 "\nDefault value is "
 376                 __MODULE_STRING(W9968CF_SPECIFIC_DEBUG)"."
 377                 "\n");
 378#endif /* W9968CF_DEBUG */
 379
 380
 381
 382/****************************************************************************
 383 * Some prototypes                                                          *
 384 ****************************************************************************/
 385
 386/* Video4linux interface */
 387static const struct v4l2_file_operations w9968cf_fops;
 388static int w9968cf_open(struct file *);
 389static int w9968cf_release(struct file *);
 390static int w9968cf_mmap(struct file *, struct vm_area_struct *);
 391static long w9968cf_ioctl(struct file *, unsigned, unsigned long);
 392static ssize_t w9968cf_read(struct file *, char __user *, size_t, loff_t *);
 393static long w9968cf_v4l_ioctl(struct file *, unsigned int,
 394                             void __user *);
 395
 396/* USB-specific */
 397static int w9968cf_start_transfer(struct w9968cf_device*);
 398static int w9968cf_stop_transfer(struct w9968cf_device*);
 399static int w9968cf_write_reg(struct w9968cf_device*, u16 value, u16 index);
 400static int w9968cf_read_reg(struct w9968cf_device*, u16 index);
 401static int w9968cf_write_fsb(struct w9968cf_device*, u16* data);
 402static int w9968cf_write_sb(struct w9968cf_device*, u16 value);
 403static int w9968cf_read_sb(struct w9968cf_device*);
 404static int w9968cf_upload_quantizationtables(struct w9968cf_device*);
 405static void w9968cf_urb_complete(struct urb *urb);
 406
 407/* Low-level I2C (SMBus) I/O */
 408static int w9968cf_smbus_start(struct w9968cf_device*);
 409static int w9968cf_smbus_stop(struct w9968cf_device*);
 410static int w9968cf_smbus_write_byte(struct w9968cf_device*, u8 v);
 411static int w9968cf_smbus_read_byte(struct w9968cf_device*, u8* v);
 412static int w9968cf_smbus_write_ack(struct w9968cf_device*);
 413static int w9968cf_smbus_read_ack(struct w9968cf_device*);
 414static int w9968cf_smbus_refresh_bus(struct w9968cf_device*);
 415static int w9968cf_i2c_adap_read_byte(struct w9968cf_device* cam,
 416                                      u16 address, u8* value);
 417static int w9968cf_i2c_adap_read_byte_data(struct w9968cf_device*, u16 address,
 418                                           u8 subaddress, u8* value);
 419static int w9968cf_i2c_adap_write_byte(struct w9968cf_device*,
 420                                       u16 address, u8 subaddress);
 421static int w9968cf_i2c_adap_fastwrite_byte_data(struct w9968cf_device*,
 422                                                u16 address, u8 subaddress,
 423                                                u8 value);
 424
 425/* I2C interface to kernel */
 426static int w9968cf_i2c_init(struct w9968cf_device*);
 427static int w9968cf_i2c_smbus_xfer(struct i2c_adapter*, u16 addr,
 428                                  unsigned short flags, char read_write,
 429                                  u8 command, int size, union i2c_smbus_data*);
 430static u32 w9968cf_i2c_func(struct i2c_adapter*);
 431
 432/* Memory management */
 433static void* rvmalloc(unsigned long size);
 434static void rvfree(void *mem, unsigned long size);
 435static void w9968cf_deallocate_memory(struct w9968cf_device*);
 436static int  w9968cf_allocate_memory(struct w9968cf_device*);
 437
 438/* High-level image sensor control functions */
 439static int w9968cf_sensor_set_control(struct w9968cf_device*,int cid,int val);
 440static int w9968cf_sensor_get_control(struct w9968cf_device*,int cid,int *val);
 441static int w9968cf_sensor_cmd(struct w9968cf_device*,
 442                              unsigned int cmd, void *arg);
 443static int w9968cf_sensor_init(struct w9968cf_device*);
 444static int w9968cf_sensor_update_settings(struct w9968cf_device*);
 445static int w9968cf_sensor_get_picture(struct w9968cf_device*);
 446static int w9968cf_sensor_update_picture(struct w9968cf_device*,
 447                                         struct video_picture pict);
 448
 449/* Other helper functions */
 450static void w9968cf_configure_camera(struct w9968cf_device*,struct usb_device*,
 451                                     enum w9968cf_model_id,
 452                                     const unsigned short dev_nr);
 453static void w9968cf_adjust_configuration(struct w9968cf_device*);
 454static int w9968cf_turn_on_led(struct w9968cf_device*);
 455static int w9968cf_init_chip(struct w9968cf_device*);
 456static inline u16 w9968cf_valid_palette(u16 palette);
 457static inline u16 w9968cf_valid_depth(u16 palette);
 458static inline u8 w9968cf_need_decompression(u16 palette);
 459static int w9968cf_set_picture(struct w9968cf_device*, struct video_picture);
 460static int w9968cf_set_window(struct w9968cf_device*, struct video_window);
 461static int w9968cf_postprocess_frame(struct w9968cf_device*,
 462                                     struct w9968cf_frame_t*);
 463static int w9968cf_adjust_window_size(struct w9968cf_device*, u32 *w, u32 *h);
 464static void w9968cf_init_framelist(struct w9968cf_device*);
 465static void w9968cf_push_frame(struct w9968cf_device*, u8 f_num);
 466static void w9968cf_pop_frame(struct w9968cf_device*,struct w9968cf_frame_t**);
 467static void w9968cf_release_resources(struct w9968cf_device*);
 468
 469
 470
 471/****************************************************************************
 472 * Symbolic names                                                           *
 473 ****************************************************************************/
 474
 475/* Used to represent a list of values and their respective symbolic names */
 476struct w9968cf_symbolic_list {
 477        const int num;
 478        const char *name;
 479};
 480
 481/*--------------------------------------------------------------------------
 482  Returns the name of the matching element in the symbolic_list array. The
 483  end of the list must be marked with an element that has a NULL name.
 484  --------------------------------------------------------------------------*/
 485static inline const char *
 486symbolic(struct w9968cf_symbolic_list list[], const int num)
 487{
 488        int i;
 489
 490        for (i = 0; list[i].name != NULL; i++)
 491                if (list[i].num == num)
 492                        return (list[i].name);
 493
 494        return "Unknown";
 495}
 496
 497static struct w9968cf_symbolic_list camlist[] = {
 498        { W9968CF_MOD_GENERIC, "W996[87]CF JPEG USB Dual Mode Camera" },
 499        { W9968CF_MOD_CLVBWGP, "Creative Labs Video Blaster WebCam Go Plus" },
 500
 501        /* Other cameras (having the same descriptors as Generic W996[87]CF) */
 502        { W9968CF_MOD_ADPVDMA, "Aroma Digi Pen VGA Dual Mode ADG-5000" },
 503        { W9986CF_MOD_AAU, "AVerMedia AVerTV USB" },
 504        { W9968CF_MOD_CLVBWG, "Creative Labs Video Blaster WebCam Go" },
 505        { W9968CF_MOD_LL, "Lebon LDC-035A" },
 506        { W9968CF_MOD_EEEMC, "Ezonics EZ-802 EZMega Cam" },
 507        { W9968CF_MOD_OOE, "OmniVision OV8610-EDE" },
 508        { W9968CF_MOD_ODPVDMPC, "OPCOM Digi Pen VGA Dual Mode Pen Camera" },
 509        { W9968CF_MOD_PDPII, "Pretec Digi Pen-II" },
 510        { W9968CF_MOD_PDP480, "Pretec DigiPen-480" },
 511
 512        {  -1, NULL }
 513};
 514
 515static struct w9968cf_symbolic_list senlist[] = {
 516        { CC_OV76BE,   "OV76BE" },
 517        { CC_OV7610,   "OV7610" },
 518        { CC_OV7620,   "OV7620" },
 519        { CC_OV7620AE, "OV7620AE" },
 520        { CC_OV6620,   "OV6620" },
 521        { CC_OV6630,   "OV6630" },
 522        { CC_OV6630AE, "OV6630AE" },
 523        { CC_OV6630AF, "OV6630AF" },
 524        { -1, NULL }
 525};
 526
 527/* Video4Linux1 palettes */
 528static struct w9968cf_symbolic_list v4l1_plist[] = {
 529        { VIDEO_PALETTE_GREY,    "GREY" },
 530        { VIDEO_PALETTE_HI240,   "HI240" },
 531        { VIDEO_PALETTE_RGB565,  "RGB565" },
 532        { VIDEO_PALETTE_RGB24,   "RGB24" },
 533        { VIDEO_PALETTE_RGB32,   "RGB32" },
 534        { VIDEO_PALETTE_RGB555,  "RGB555" },
 535        { VIDEO_PALETTE_YUV422,  "YUV422" },
 536        { VIDEO_PALETTE_YUYV,    "YUYV" },
 537        { VIDEO_PALETTE_UYVY,    "UYVY" },
 538        { VIDEO_PALETTE_YUV420,  "YUV420" },
 539        { VIDEO_PALETTE_YUV411,  "YUV411" },
 540        { VIDEO_PALETTE_RAW,     "RAW" },
 541        { VIDEO_PALETTE_YUV422P, "YUV422P" },
 542        { VIDEO_PALETTE_YUV411P, "YUV411P" },
 543        { VIDEO_PALETTE_YUV420P, "YUV420P" },
 544        { VIDEO_PALETTE_YUV410P, "YUV410P" },
 545        { -1, NULL }
 546};
 547
 548/* Decoder error codes: */
 549static struct w9968cf_symbolic_list decoder_errlist[] = {
 550        { W9968CF_DEC_ERR_CORRUPTED_DATA, "Corrupted data" },
 551        { W9968CF_DEC_ERR_BUF_OVERFLOW,   "Buffer overflow" },
 552        { W9968CF_DEC_ERR_NO_SOI,         "SOI marker not found" },
 553        { W9968CF_DEC_ERR_NO_SOF0,        "SOF0 marker not found" },
 554        { W9968CF_DEC_ERR_NO_SOS,         "SOS marker not found" },
 555        { W9968CF_DEC_ERR_NO_EOI,         "EOI marker not found" },
 556        { -1, NULL }
 557};
 558
 559/* URB error codes: */
 560static struct w9968cf_symbolic_list urb_errlist[] = {
 561        { -ENOMEM,    "No memory for allocation of internal structures" },
 562        { -ENOSPC,    "The host controller's bandwidth is already consumed" },
 563        { -ENOENT,    "URB was canceled by unlink_urb" },
 564        { -EXDEV,     "ISO transfer only partially completed" },
 565        { -EAGAIN,    "Too match scheduled for the future" },
 566        { -ENXIO,     "URB already queued" },
 567        { -EFBIG,     "Too much ISO frames requested" },
 568        { -ENOSR,     "Buffer error (overrun)" },
 569        { -EPIPE,     "Specified endpoint is stalled (device not responding)"},
 570        { -EOVERFLOW, "Babble (too much data)" },
 571        { -EPROTO,    "Bit-stuff error (bad cable?)" },
 572        { -EILSEQ,    "CRC/Timeout" },
 573        { -ETIME,     "Device does not respond to token" },
 574        { -ETIMEDOUT, "Device does not respond to command" },
 575        { -1, NULL }
 576};
 577
 578/****************************************************************************
 579 * Memory management functions                                              *
 580 ****************************************************************************/
 581static void* rvmalloc(unsigned long size)
 582{
 583        void* mem;
 584        unsigned long adr;
 585
 586        size = PAGE_ALIGN(size);
 587        mem = vmalloc_32(size);
 588        if (!mem)
 589                return NULL;
 590
 591        memset(mem, 0, size); /* Clear the ram out, no junk to the user */
 592        adr = (unsigned long) mem;
 593        while (size > 0) {
 594                SetPageReserved(vmalloc_to_page((void *)adr));
 595                adr += PAGE_SIZE;
 596                size -= PAGE_SIZE;
 597        }
 598
 599        return mem;
 600}
 601
 602
 603static void rvfree(void* mem, unsigned long size)
 604{
 605        unsigned long adr;
 606
 607        if (!mem)
 608                return;
 609
 610        adr = (unsigned long) mem;
 611        while ((long) size > 0) {
 612                ClearPageReserved(vmalloc_to_page((void *)adr));
 613                adr += PAGE_SIZE;
 614                size -= PAGE_SIZE;
 615        }
 616        vfree(mem);
 617}
 618
 619
 620/*--------------------------------------------------------------------------
 621  Deallocate previously allocated memory.
 622  --------------------------------------------------------------------------*/
 623static void w9968cf_deallocate_memory(struct w9968cf_device* cam)
 624{
 625        u8 i;
 626
 627        /* Free the isochronous transfer buffers */
 628        for (i = 0; i < W9968CF_URBS; i++) {
 629                kfree(cam->transfer_buffer[i]);
 630                cam->transfer_buffer[i] = NULL;
 631        }
 632
 633        /* Free temporary frame buffer */
 634        if (cam->frame_tmp.buffer) {
 635                rvfree(cam->frame_tmp.buffer, cam->frame_tmp.size);
 636                cam->frame_tmp.buffer = NULL;
 637        }
 638
 639        /* Free helper buffer */
 640        if (cam->frame_vpp.buffer) {
 641                rvfree(cam->frame_vpp.buffer, cam->frame_vpp.size);
 642                cam->frame_vpp.buffer = NULL;
 643        }
 644
 645        /* Free video frame buffers */
 646        if (cam->frame[0].buffer) {
 647                rvfree(cam->frame[0].buffer, cam->nbuffers*cam->frame[0].size);
 648                cam->frame[0].buffer = NULL;
 649        }
 650
 651        cam->nbuffers = 0;
 652
 653        DBG(5, "Memory successfully deallocated")
 654}
 655
 656
 657/*--------------------------------------------------------------------------
 658  Allocate memory buffers for USB transfers and video frames.
 659  This function is called by open() only.
 660  Return 0 on success, a negative number otherwise.
 661  --------------------------------------------------------------------------*/
 662static int w9968cf_allocate_memory(struct w9968cf_device* cam)
 663{
 664        const u16 p_size = wMaxPacketSize[cam->altsetting-1];
 665        void* buff = NULL;
 666        unsigned long hw_bufsize, vpp_bufsize;
 667        u8 i, bpp;
 668
 669        /* NOTE: Deallocation is done elsewhere in case of error */
 670
 671        /* Calculate the max amount of raw data per frame from the device */
 672        hw_bufsize = cam->maxwidth*cam->maxheight*2;
 673
 674        /* Calculate the max buf. size needed for post-processing routines */
 675        bpp = (w9968cf_vpp) ? 4 : 2;
 676        if (cam->upscaling)
 677                vpp_bufsize = max(W9968CF_MAX_WIDTH*W9968CF_MAX_HEIGHT*bpp,
 678                                  cam->maxwidth*cam->maxheight*bpp);
 679        else
 680                vpp_bufsize = cam->maxwidth*cam->maxheight*bpp;
 681
 682        /* Allocate memory for the isochronous transfer buffers */
 683        for (i = 0; i < W9968CF_URBS; i++) {
 684                if (!(cam->transfer_buffer[i] =
 685                      kzalloc(W9968CF_ISO_PACKETS*p_size, GFP_KERNEL))) {
 686                        DBG(1, "Couldn't allocate memory for the isochronous "
 687                               "transfer buffers (%u bytes)",
 688                            p_size * W9968CF_ISO_PACKETS)
 689                        return -ENOMEM;
 690                }
 691        }
 692
 693        /* Allocate memory for the temporary frame buffer */
 694        if (!(cam->frame_tmp.buffer = rvmalloc(hw_bufsize))) {
 695                DBG(1, "Couldn't allocate memory for the temporary "
 696                       "video frame buffer (%lu bytes)", hw_bufsize)
 697                return -ENOMEM;
 698        }
 699        cam->frame_tmp.size = hw_bufsize;
 700        cam->frame_tmp.number = -1;
 701
 702        /* Allocate memory for the helper buffer */
 703        if (w9968cf_vpp) {
 704                if (!(cam->frame_vpp.buffer = rvmalloc(vpp_bufsize))) {
 705                        DBG(1, "Couldn't allocate memory for the helper buffer"
 706                               " (%lu bytes)", vpp_bufsize)
 707                        return -ENOMEM;
 708                }
 709                cam->frame_vpp.size = vpp_bufsize;
 710        } else
 711                cam->frame_vpp.buffer = NULL;
 712
 713        /* Allocate memory for video frame buffers */
 714        cam->nbuffers = cam->max_buffers;
 715        while (cam->nbuffers >= 2) {
 716                if ((buff = rvmalloc(cam->nbuffers * vpp_bufsize)))
 717                        break;
 718                else
 719                        cam->nbuffers--;
 720        }
 721
 722        if (!buff) {
 723                DBG(1, "Couldn't allocate memory for the video frame buffers")
 724                cam->nbuffers = 0;
 725                return -ENOMEM;
 726        }
 727
 728        if (cam->nbuffers != cam->max_buffers)
 729                DBG(2, "Couldn't allocate memory for %u video frame buffers. "
 730                       "Only memory for %u buffers has been allocated",
 731                    cam->max_buffers, cam->nbuffers)
 732
 733        for (i = 0; i < cam->nbuffers; i++) {
 734                cam->frame[i].buffer = buff + i*vpp_bufsize;
 735                cam->frame[i].size = vpp_bufsize;
 736                cam->frame[i].number = i;
 737                /* Circular list */
 738                if (i != cam->nbuffers-1)
 739                        cam->frame[i].next = &cam->frame[i+1];
 740                else
 741                        cam->frame[i].next = &cam->frame[0];
 742                cam->frame[i].status = F_UNUSED;
 743        }
 744
 745        DBG(5, "Memory successfully allocated")
 746        return 0;
 747}
 748
 749
 750
 751/****************************************************************************
 752 * USB-specific functions                                                   *
 753 ****************************************************************************/
 754
 755/*--------------------------------------------------------------------------
 756  This is an handler function which is called after the URBs are completed.
 757  It collects multiple data packets coming from the camera by putting them
 758  into frame buffers: one or more zero data length data packets are used to
 759  mark the end of a video frame; the first non-zero data packet is the start
 760  of the next video frame; if an error is encountered in a packet, the entire
 761  video frame is discarded and grabbed again.
 762  If there are no requested frames in the FIFO list, packets are collected into
 763  a temporary buffer.
 764  --------------------------------------------------------------------------*/
 765static void w9968cf_urb_complete(struct urb *urb)
 766{
 767        struct w9968cf_device* cam = (struct w9968cf_device*)urb->context;
 768        struct w9968cf_frame_t** f;
 769        unsigned int len, status;
 770        void* pos;
 771        u8 i;
 772        int err = 0;
 773
 774        if ((!cam->streaming) || cam->disconnected) {
 775                DBG(4, "Got interrupt, but not streaming")
 776                return;
 777        }
 778
 779        /* "(*f)" will be used instead of "cam->frame_current" */
 780        f = &cam->frame_current;
 781
 782        /* If a frame has been requested and we are grabbing into
 783           the temporary frame, we'll switch to that requested frame */
 784        if ((*f) == &cam->frame_tmp && *cam->requested_frame) {
 785                if (cam->frame_tmp.status == F_GRABBING) {
 786                        w9968cf_pop_frame(cam, &cam->frame_current);
 787                        (*f)->status = F_GRABBING;
 788                        (*f)->length = cam->frame_tmp.length;
 789                        memcpy((*f)->buffer, cam->frame_tmp.buffer,
 790                               (*f)->length);
 791                        DBG(6, "Switched from temp. frame to frame #%d",
 792                            (*f)->number)
 793                }
 794        }
 795
 796        for (i = 0; i < urb->number_of_packets; i++) {
 797                len = urb->iso_frame_desc[i].actual_length;
 798                status = urb->iso_frame_desc[i].status;
 799                pos = urb->iso_frame_desc[i].offset + urb->transfer_buffer;
 800
 801                if (status && len != 0) {
 802                        DBG(4, "URB failed, error in data packet "
 803                               "(error #%u, %s)",
 804                            status, symbolic(urb_errlist, status))
 805                        (*f)->status = F_ERROR;
 806                        continue;
 807                }
 808
 809                if (len) { /* start of frame */
 810
 811                        if ((*f)->status == F_UNUSED) {
 812                                (*f)->status = F_GRABBING;
 813                                (*f)->length = 0;
 814                        }
 815
 816                        /* Buffer overflows shouldn't happen, however...*/
 817                        if ((*f)->length + len > (*f)->size) {
 818                                DBG(4, "Buffer overflow: bad data packets")
 819                                (*f)->status = F_ERROR;
 820                        }
 821
 822                        if ((*f)->status == F_GRABBING) {
 823                                memcpy((*f)->buffer + (*f)->length, pos, len);
 824                                (*f)->length += len;
 825                        }
 826
 827                } else if ((*f)->status == F_GRABBING) { /* end of frame */
 828
 829                        DBG(6, "Frame #%d successfully grabbed", (*f)->number)
 830
 831                        if (cam->vpp_flag & VPP_DECOMPRESSION) {
 832                                err = w9968cf_vpp->check_headers((*f)->buffer,
 833                                                                 (*f)->length);
 834                                if (err) {
 835                                        DBG(4, "Skip corrupted frame: %s",
 836                                            symbolic(decoder_errlist, err))
 837                                        (*f)->status = F_UNUSED;
 838                                        continue; /* grab this frame again */
 839                                }
 840                        }
 841
 842                        (*f)->status = F_READY;
 843                        (*f)->queued = 0;
 844
 845                        /* Take a pointer to the new frame from the FIFO list.
 846                           If the list is empty,we'll use the temporary frame*/
 847                        if (*cam->requested_frame)
 848                                w9968cf_pop_frame(cam, &cam->frame_current);
 849                        else {
 850                                cam->frame_current = &cam->frame_tmp;
 851                                (*f)->status = F_UNUSED;
 852                        }
 853
 854                } else if ((*f)->status == F_ERROR)
 855                        (*f)->status = F_UNUSED; /* grab it again */
 856
 857                PDBGG("Frame length %lu | pack.#%u | pack.len. %u | state %d",
 858                      (unsigned long)(*f)->length, i, len, (*f)->status)
 859
 860        } /* end for */
 861
 862        /* Resubmit this URB */
 863        urb->dev = cam->usbdev;
 864        urb->status = 0;
 865        spin_lock(&cam->urb_lock);
 866        if (cam->streaming)
 867                if ((err = usb_submit_urb(urb, GFP_ATOMIC))) {
 868                        cam->misconfigured = 1;
 869                        DBG(1, "Couldn't resubmit the URB: error %d, %s",
 870                            err, symbolic(urb_errlist, err))
 871                }
 872        spin_unlock(&cam->urb_lock);
 873
 874        /* Wake up the user process */
 875        wake_up_interruptible(&cam->wait_queue);
 876}
 877
 878
 879/*---------------------------------------------------------------------------
 880  Setup the URB structures for the isochronous transfer.
 881  Submit the URBs so that the data transfer begins.
 882  Return 0 on success, a negative number otherwise.
 883  ---------------------------------------------------------------------------*/
 884static int w9968cf_start_transfer(struct w9968cf_device* cam)
 885{
 886        struct usb_device *udev = cam->usbdev;
 887        struct urb* urb;
 888        const u16 p_size = wMaxPacketSize[cam->altsetting-1];
 889        u16 w, h, d;
 890        int vidcapt;
 891        u32 t_size;
 892        int err = 0;
 893        s8 i, j;
 894
 895        for (i = 0; i < W9968CF_URBS; i++) {
 896                urb = usb_alloc_urb(W9968CF_ISO_PACKETS, GFP_KERNEL);
 897                if (!urb) {
 898                        for (j = 0; j < i; j++)
 899                                usb_free_urb(cam->urb[j]);
 900                        DBG(1, "Couldn't allocate the URB structures")
 901                        return -ENOMEM;
 902                }
 903
 904                cam->urb[i] = urb;
 905                urb->dev = udev;
 906                urb->context = (void*)cam;
 907                urb->pipe = usb_rcvisocpipe(udev, 1);
 908                urb->transfer_flags = URB_ISO_ASAP;
 909                urb->number_of_packets = W9968CF_ISO_PACKETS;
 910                urb->complete = w9968cf_urb_complete;
 911                urb->transfer_buffer = cam->transfer_buffer[i];
 912                urb->transfer_buffer_length = p_size*W9968CF_ISO_PACKETS;
 913                urb->interval = 1;
 914                for (j = 0; j < W9968CF_ISO_PACKETS; j++) {
 915                        urb->iso_frame_desc[j].offset = p_size*j;
 916                        urb->iso_frame_desc[j].length = p_size;
 917                }
 918        }
 919
 920        /* Transfer size per frame, in WORD ! */
 921        d = cam->hw_depth;
 922        w = cam->hw_width;
 923        h = cam->hw_height;
 924
 925        t_size = (w*h*d)/16;
 926
 927        err = w9968cf_write_reg(cam, 0xbf17, 0x00); /* reset everything */
 928        err += w9968cf_write_reg(cam, 0xbf10, 0x00); /* normal operation */
 929
 930        /* Transfer size */
 931        err += w9968cf_write_reg(cam, t_size & 0xffff, 0x3d); /* low bits */
 932        err += w9968cf_write_reg(cam, t_size >> 16, 0x3e);    /* high bits */
 933
 934        if (cam->vpp_flag & VPP_DECOMPRESSION)
 935                err += w9968cf_upload_quantizationtables(cam);
 936
 937        vidcapt = w9968cf_read_reg(cam, 0x16); /* read picture settings */
 938        err += w9968cf_write_reg(cam, vidcapt|0x8000, 0x16); /* capt. enable */
 939
 940        err += usb_set_interface(udev, 0, cam->altsetting);
 941        err += w9968cf_write_reg(cam, 0x8a05, 0x3c); /* USB FIFO enable */
 942
 943        if (err || (vidcapt < 0)) {
 944                for (i = 0; i < W9968CF_URBS; i++)
 945                        usb_free_urb(cam->urb[i]);
 946                DBG(1, "Couldn't tell the camera to start the data transfer")
 947                return err;
 948        }
 949
 950        w9968cf_init_framelist(cam);
 951
 952        /* Begin to grab into the temporary buffer */
 953        cam->frame_tmp.status = F_UNUSED;
 954        cam->frame_tmp.queued = 0;
 955        cam->frame_current = &cam->frame_tmp;
 956
 957        if (!(cam->vpp_flag & VPP_DECOMPRESSION))
 958                DBG(5, "Isochronous transfer size: %lu bytes/frame",
 959                    (unsigned long)t_size*2)
 960
 961        DBG(5, "Starting the isochronous transfer...")
 962
 963        cam->streaming = 1;
 964
 965        /* Submit the URBs */
 966        for (i = 0; i < W9968CF_URBS; i++) {
 967                err = usb_submit_urb(cam->urb[i], GFP_KERNEL);
 968                if (err) {
 969                        cam->streaming = 0;
 970                        for (j = i-1; j >= 0; j--) {
 971                                usb_kill_urb(cam->urb[j]);
 972                                usb_free_urb(cam->urb[j]);
 973                        }
 974                        DBG(1, "Couldn't send a transfer request to the "
 975                               "USB core (error #%d, %s)", err,
 976                            symbolic(urb_errlist, err))
 977                        return err;
 978                }
 979        }
 980
 981        return 0;
 982}
 983
 984
 985/*--------------------------------------------------------------------------
 986  Stop the isochronous transfer and set alternate setting to 0 (0Mb/s).
 987  Return 0 on success, a negative number otherwise.
 988  --------------------------------------------------------------------------*/
 989static int w9968cf_stop_transfer(struct w9968cf_device* cam)
 990{
 991        struct usb_device *udev = cam->usbdev;
 992        unsigned long lock_flags;
 993        int err = 0;
 994        s8 i;
 995
 996        if (!cam->streaming)
 997                return 0;
 998
 999        /* This avoids race conditions with usb_submit_urb()
1000           in the URB completition handler */
1001        spin_lock_irqsave(&cam->urb_lock, lock_flags);
1002        cam->streaming = 0;
1003        spin_unlock_irqrestore(&cam->urb_lock, lock_flags);
1004
1005        for (i = W9968CF_URBS-1; i >= 0; i--)
1006                if (cam->urb[i]) {
1007                        usb_kill_urb(cam->urb[i]);
1008                        usb_free_urb(cam->urb[i]);
1009                        cam->urb[i] = NULL;
1010                }
1011
1012        if (cam->disconnected)
1013                goto exit;
1014
1015        err = w9968cf_write_reg(cam, 0x0a05, 0x3c); /* stop USB transfer */
1016        err += usb_set_interface(udev, 0, 0); /* 0 Mb/s */
1017        err += w9968cf_write_reg(cam, 0x0000, 0x39); /* disable JPEG encoder */
1018        err += w9968cf_write_reg(cam, 0x0000, 0x16); /* stop video capture */
1019
1020        if (err) {
1021                DBG(2, "Failed to tell the camera to stop the isochronous "
1022                       "transfer. However this is not a critical error.")
1023                return -EIO;
1024        }
1025
1026exit:
1027        DBG(5, "Isochronous transfer stopped")
1028        return 0;
1029}
1030
1031
1032/*--------------------------------------------------------------------------
1033  Write a W9968CF register.
1034  Return 0 on success, -1 otherwise.
1035  --------------------------------------------------------------------------*/
1036static int w9968cf_write_reg(struct w9968cf_device* cam, u16 value, u16 index)
1037{
1038        struct usb_device* udev = cam->usbdev;
1039        int res;
1040
1041        res = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0,
1042                              USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE,
1043                              value, index, NULL, 0, W9968CF_USB_CTRL_TIMEOUT);
1044
1045        if (res < 0)
1046                DBG(4, "Failed to write a register "
1047                       "(value 0x%04X, index 0x%02X, error #%d, %s)",
1048                    value, index, res, symbolic(urb_errlist, res))
1049
1050        return (res >= 0) ? 0 : -1;
1051}
1052
1053
1054/*--------------------------------------------------------------------------
1055  Read a W9968CF register.
1056  Return the register value on success, -1 otherwise.
1057  --------------------------------------------------------------------------*/
1058static int w9968cf_read_reg(struct w9968cf_device* cam, u16 index)
1059{
1060        struct usb_device* udev = cam->usbdev;
1061        u16* buff = cam->control_buffer;
1062        int res;
1063
1064        res = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 1,
1065                              USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
1066                              0, index, buff, 2, W9968CF_USB_CTRL_TIMEOUT);
1067
1068        if (res < 0)
1069                DBG(4, "Failed to read a register "
1070                       "(index 0x%02X, error #%d, %s)",
1071                    index, res, symbolic(urb_errlist, res))
1072
1073        return (res >= 0) ? (int)(*buff) : -1;
1074}
1075
1076
1077/*--------------------------------------------------------------------------
1078  Write 64-bit data to the fast serial bus registers.
1079  Return 0 on success, -1 otherwise.
1080  --------------------------------------------------------------------------*/
1081static int w9968cf_write_fsb(struct w9968cf_device* cam, u16* data)
1082{
1083        struct usb_device* udev = cam->usbdev;
1084        u16 value;
1085        int res;
1086
1087        value = *data++;
1088
1089        res = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0,
1090                              USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE,
1091                              value, 0x06, data, 6, W9968CF_USB_CTRL_TIMEOUT);
1092
1093        if (res < 0)
1094                DBG(4, "Failed to write the FSB registers "
1095                       "(error #%d, %s)", res, symbolic(urb_errlist, res))
1096
1097        return (res >= 0) ? 0 : -1;
1098}
1099
1100
1101/*--------------------------------------------------------------------------
1102  Write data to the serial bus control register.
1103  Return 0 on success, a negative number otherwise.
1104  --------------------------------------------------------------------------*/
1105static int w9968cf_write_sb(struct w9968cf_device* cam, u16 value)
1106{
1107        int err = 0;
1108
1109        err = w9968cf_write_reg(cam, value, 0x01);
1110        udelay(W9968CF_I2C_BUS_DELAY);
1111
1112        return err;
1113}
1114
1115
1116/*--------------------------------------------------------------------------
1117  Read data from the serial bus control register.
1118  Return 0 on success, a negative number otherwise.
1119  --------------------------------------------------------------------------*/
1120static int w9968cf_read_sb(struct w9968cf_device* cam)
1121{
1122        int v = 0;
1123
1124        v = w9968cf_read_reg(cam, 0x01);
1125        udelay(W9968CF_I2C_BUS_DELAY);
1126
1127        return v;
1128}
1129
1130
1131/*--------------------------------------------------------------------------
1132  Upload quantization tables for the JPEG compression.
1133  This function is called by w9968cf_start_transfer().
1134  Return 0 on success, a negative number otherwise.
1135  --------------------------------------------------------------------------*/
1136static int w9968cf_upload_quantizationtables(struct w9968cf_device* cam)
1137{
1138        u16 a, b;
1139        int err = 0, i, j;
1140
1141        err += w9968cf_write_reg(cam, 0x0010, 0x39); /* JPEG clock enable */
1142
1143        for (i = 0, j = 0; i < 32; i++, j += 2) {
1144                a = Y_QUANTABLE[j] | ((unsigned)(Y_QUANTABLE[j+1]) << 8);
1145                b = UV_QUANTABLE[j] | ((unsigned)(UV_QUANTABLE[j+1]) << 8);
1146                err += w9968cf_write_reg(cam, a, 0x40+i);
1147                err += w9968cf_write_reg(cam, b, 0x60+i);
1148        }
1149        err += w9968cf_write_reg(cam, 0x0012, 0x39); /* JPEG encoder enable */
1150
1151        return err;
1152}
1153
1154
1155
1156/****************************************************************************
1157 * Low-level I2C I/O functions.                                             *
1158 * The adapter supports the following I2C transfer functions:               *
1159 * i2c_adap_fastwrite_byte_data() (at 400 kHz bit frequency only)           *
1160 * i2c_adap_read_byte_data()                                                *
1161 * i2c_adap_read_byte()                                                     *
1162 ****************************************************************************/
1163
1164static int w9968cf_smbus_start(struct w9968cf_device* cam)
1165{
1166        int err = 0;
1167
1168        err += w9968cf_write_sb(cam, 0x0011); /* SDE=1, SDA=0, SCL=1 */
1169        err += w9968cf_write_sb(cam, 0x0010); /* SDE=1, SDA=0, SCL=0 */
1170
1171        return err;
1172}
1173
1174
1175static int w9968cf_smbus_stop(struct w9968cf_device* cam)
1176{
1177        int err = 0;
1178
1179        err += w9968cf_write_sb(cam, 0x0011); /* SDE=1, SDA=0, SCL=1 */
1180        err += w9968cf_write_sb(cam, 0x0013); /* SDE=1, SDA=1, SCL=1 */
1181
1182        return err;
1183}
1184
1185
1186static int w9968cf_smbus_write_byte(struct w9968cf_device* cam, u8 v)
1187{
1188        u8 bit;
1189        int err = 0, sda;
1190
1191        for (bit = 0 ; bit < 8 ; bit++) {
1192                sda = (v & 0x80) ? 2 : 0;
1193                v <<= 1;
1194                /* SDE=1, SDA=sda, SCL=0 */
1195                err += w9968cf_write_sb(cam, 0x10 | sda);
1196                /* SDE=1, SDA=sda, SCL=1 */
1197                err += w9968cf_write_sb(cam, 0x11 | sda);
1198                /* SDE=1, SDA=sda, SCL=0 */
1199                err += w9968cf_write_sb(cam, 0x10 | sda);
1200        }
1201
1202        return err;
1203}
1204
1205
1206static int w9968cf_smbus_read_byte(struct w9968cf_device* cam, u8* v)
1207{
1208        u8 bit;
1209        int err = 0;
1210
1211        *v = 0;
1212        for (bit = 0 ; bit < 8 ; bit++) {
1213                *v <<= 1;
1214                err += w9968cf_write_sb(cam, 0x0013);
1215                *v |= (w9968cf_read_sb(cam) & 0x0008) ? 1 : 0;
1216                err += w9968cf_write_sb(cam, 0x0012);
1217        }
1218
1219        return err;
1220}
1221
1222
1223static int w9968cf_smbus_write_ack(struct w9968cf_device* cam)
1224{
1225        int err = 0;
1226
1227        err += w9968cf_write_sb(cam, 0x0010); /* SDE=1, SDA=0, SCL=0 */
1228        err += w9968cf_write_sb(cam, 0x0011); /* SDE=1, SDA=0, SCL=1 */
1229        err += w9968cf_write_sb(cam, 0x0010); /* SDE=1, SDA=0, SCL=0 */
1230
1231        return err;
1232}
1233
1234
1235static int w9968cf_smbus_read_ack(struct w9968cf_device* cam)
1236{
1237        int err = 0, sda;
1238
1239        err += w9968cf_write_sb(cam, 0x0013); /* SDE=1, SDA=1, SCL=1 */
1240        sda = (w9968cf_read_sb(cam) & 0x08) ? 1 : 0; /* sda = SDA */
1241        err += w9968cf_write_sb(cam, 0x0012); /* SDE=1, SDA=1, SCL=0 */
1242        if (sda < 0)
1243                err += sda;
1244        if (sda == 1) {
1245                DBG(6, "Couldn't receive the ACK")
1246                err += -1;
1247        }
1248
1249        return err;
1250}
1251
1252
1253/* This seems to refresh the communication through the serial bus */
1254static int w9968cf_smbus_refresh_bus(struct w9968cf_device* cam)
1255{
1256        int err = 0, j;
1257
1258        for (j = 1; j <= 10; j++) {
1259                err = w9968cf_write_reg(cam, 0x0020, 0x01);
1260                err += w9968cf_write_reg(cam, 0x0000, 0x01);
1261                if (err)
1262                        break;
1263        }
1264
1265        return err;
1266}
1267
1268
1269/* SMBus protocol: S Addr Wr [A] Subaddr [A] Value [A] P */
1270static int
1271w9968cf_i2c_adap_fastwrite_byte_data(struct w9968cf_device* cam,
1272                                     u16 address, u8 subaddress,u8 value)
1273{
1274        u16* data = cam->data_buffer;
1275        int err = 0;
1276
1277        err += w9968cf_smbus_refresh_bus(cam);
1278
1279        /* Enable SBUS outputs */
1280        err += w9968cf_write_sb(cam, 0x0020);
1281
1282        data[0] = 0x082f | ((address & 0x80) ? 0x1500 : 0x0);
1283        data[0] |= (address & 0x40) ? 0x4000 : 0x0;
1284        data[1] = 0x2082 | ((address & 0x40) ? 0x0005 : 0x0);
1285        data[1] |= (address & 0x20) ? 0x0150 : 0x0;
1286        data[1] |= (address & 0x10) ? 0x5400 : 0x0;
1287        data[2] = 0x8208 | ((address & 0x08) ? 0x0015 : 0x0);
1288        data[2] |= (address & 0x04) ? 0x0540 : 0x0;
1289        data[2] |= (address & 0x02) ? 0x5000 : 0x0;
1290        data[3] = 0x1d20 | ((address & 0x02) ? 0x0001 : 0x0);
1291        data[3] |= (address & 0x01) ? 0x0054 : 0x0;
1292
1293        err += w9968cf_write_fsb(cam, data);
1294
1295        data[0] = 0x8208 | ((subaddress & 0x80) ? 0x0015 : 0x0);
1296        data[0] |= (subaddress & 0x40) ? 0x0540 : 0x0;
1297        data[0] |= (subaddress & 0x20) ? 0x5000 : 0x0;
1298        data[1] = 0x0820 | ((subaddress & 0x20) ? 0x0001 : 0x0);
1299        data[1] |= (subaddress & 0x10) ? 0x0054 : 0x0;
1300        data[1] |= (subaddress & 0x08) ? 0x1500 : 0x0;
1301        data[1] |= (subaddress & 0x04) ? 0x4000 : 0x0;
1302        data[2] = 0x2082 | ((subaddress & 0x04) ? 0x0005 : 0x0);
1303        data[2] |= (subaddress & 0x02) ? 0x0150 : 0x0;
1304        data[2] |= (subaddress & 0x01) ? 0x5400 : 0x0;
1305        data[3] = 0x001d;
1306
1307        err += w9968cf_write_fsb(cam, data);
1308
1309        data[0] = 0x8208 | ((value & 0x80) ? 0x0015 : 0x0);
1310        data[0] |= (value & 0x40) ? 0x0540 : 0x0;
1311        data[0] |= (value & 0x20) ? 0x5000 : 0x0;
1312        data[1] = 0x0820 | ((value & 0x20) ? 0x0001 : 0x0);
1313        data[1] |= (value & 0x10) ? 0x0054 : 0x0;
1314        data[1] |= (value & 0x08) ? 0x1500 : 0x0;
1315        data[1] |= (value & 0x04) ? 0x4000 : 0x0;
1316        data[2] = 0x2082 | ((value & 0x04) ? 0x0005 : 0x0);
1317        data[2] |= (value & 0x02) ? 0x0150 : 0x0;
1318        data[2] |= (value & 0x01) ? 0x5400 : 0x0;
1319        data[3] = 0xfe1d;
1320
1321        err += w9968cf_write_fsb(cam, data);
1322
1323        /* Disable SBUS outputs */
1324        err += w9968cf_write_sb(cam, 0x0000);
1325
1326        if (!err)
1327                DBG(5, "I2C write byte data done, addr.0x%04X, subaddr.0x%02X "
1328                       "value 0x%02X", address, subaddress, value)
1329        else
1330                DBG(5, "I2C write byte data failed, addr.0x%04X, "
1331                       "subaddr.0x%02X, value 0x%02X",
1332                    address, subaddress, value)
1333
1334        return err;
1335}
1336
1337
1338/* SMBus protocol: S Addr Wr [A] Subaddr [A] P S Addr+1 Rd [A] [Value] NA P */
1339static int
1340w9968cf_i2c_adap_read_byte_data(struct w9968cf_device* cam,
1341                                u16 address, u8 subaddress,
1342                                u8* value)
1343{
1344        int err = 0;
1345
1346        /* Serial data enable */
1347        err += w9968cf_write_sb(cam, 0x0013); /* don't change ! */
1348
1349        err += w9968cf_smbus_start(cam);
1350        err += w9968cf_smbus_write_byte(cam, address);
1351        err += w9968cf_smbus_read_ack(cam);
1352        err += w9968cf_smbus_write_byte(cam, subaddress);
1353        err += w9968cf_smbus_read_ack(cam);
1354        err += w9968cf_smbus_stop(cam);
1355        err += w9968cf_smbus_start(cam);
1356        err += w9968cf_smbus_write_byte(cam, address + 1);
1357        err += w9968cf_smbus_read_ack(cam);
1358        err += w9968cf_smbus_read_byte(cam, value);
1359        err += w9968cf_smbus_write_ack(cam);
1360        err += w9968cf_smbus_stop(cam);
1361
1362        /* Serial data disable */
1363        err += w9968cf_write_sb(cam, 0x0000);
1364
1365        if (!err)
1366                DBG(5, "I2C read byte data done, addr.0x%04X, "
1367                       "subaddr.0x%02X, value 0x%02X",
1368                    address, subaddress, *value)
1369        else
1370                DBG(5, "I2C read byte data failed, addr.0x%04X, "
1371                       "subaddr.0x%02X, wrong value 0x%02X",
1372                    address, subaddress, *value)
1373
1374        return err;
1375}
1376
1377
1378/* SMBus protocol: S Addr+1 Rd [A] [Value] NA P */
1379static int
1380w9968cf_i2c_adap_read_byte(struct w9968cf_device* cam,
1381                           u16 address, u8* value)
1382{
1383        int err = 0;
1384
1385        /* Serial data enable */
1386        err += w9968cf_write_sb(cam, 0x0013);
1387
1388        err += w9968cf_smbus_start(cam);
1389        err += w9968cf_smbus_write_byte(cam, address + 1);
1390        err += w9968cf_smbus_read_ack(cam);
1391        err += w9968cf_smbus_read_byte(cam, value);
1392        err += w9968cf_smbus_write_ack(cam);
1393        err += w9968cf_smbus_stop(cam);
1394
1395        /* Serial data disable */
1396        err += w9968cf_write_sb(cam, 0x0000);
1397
1398        if (!err)
1399                DBG(5, "I2C read byte done, addr.0x%04X, "
1400                       "value 0x%02X", address, *value)
1401        else
1402                DBG(5, "I2C read byte failed, addr.0x%04X, "
1403                       "wrong value 0x%02X", address, *value)
1404
1405        return err;
1406}
1407
1408
1409/* SMBus protocol: S Addr Wr [A] Value [A] P */
1410static int
1411w9968cf_i2c_adap_write_byte(struct w9968cf_device* cam,
1412                            u16 address, u8 value)
1413{
1414        DBG(4, "i2c_write_byte() is an unsupported transfer mode")
1415        return -EINVAL;
1416}
1417
1418
1419
1420/****************************************************************************
1421 * I2C interface to kernel                                                  *
1422 ****************************************************************************/
1423
1424static int
1425w9968cf_i2c_smbus_xfer(struct i2c_adapter *adapter, u16 addr,
1426                       unsigned short flags, char read_write, u8 command,
1427                       int size, union i2c_smbus_data *data)
1428{
1429        struct v4l2_device *v4l2_dev = i2c_get_adapdata(adapter);
1430        struct w9968cf_device *cam = to_cam(v4l2_dev);
1431        u8 i;
1432        int err = 0;
1433
1434        if (size == I2C_SMBUS_BYTE) {
1435                /* Why addr <<= 1? See OVXXX0_SID defines in ovcamchip.h */
1436                addr <<= 1;
1437
1438                if (read_write == I2C_SMBUS_WRITE)
1439                        err = w9968cf_i2c_adap_write_byte(cam, addr, command);
1440                else if (read_write == I2C_SMBUS_READ)
1441                        for (i = 1; i <= W9968CF_I2C_RW_RETRIES; i++) {
1442                                err = w9968cf_i2c_adap_read_byte(cam, addr,
1443                                                         &data->byte);
1444                                if (err) {
1445                                        if (w9968cf_smbus_refresh_bus(cam)) {
1446                                                err = -EIO;
1447                                                break;
1448                                        }
1449                                } else
1450                                        break;
1451                        }
1452        } else if (size == I2C_SMBUS_BYTE_DATA) {
1453                addr <<= 1;
1454
1455                if (read_write == I2C_SMBUS_WRITE)
1456                        err = w9968cf_i2c_adap_fastwrite_byte_data(cam, addr,
1457                                                          command, data->byte);
1458                else if (read_write == I2C_SMBUS_READ) {
1459                        for (i = 1; i <= W9968CF_I2C_RW_RETRIES; i++) {
1460                                err = w9968cf_i2c_adap_read_byte_data(cam,addr,
1461                                                         command, &data->byte);
1462                                if (err) {
1463                                        if (w9968cf_smbus_refresh_bus(cam)) {
1464                                                err = -EIO;
1465                                                break;
1466                                        }
1467                                } else
1468                                        break;
1469                        }
1470
1471                } else
1472                        return -EINVAL;
1473
1474        } else {
1475                DBG(4, "Unsupported I2C transfer mode (%d)", size)
1476                return -EINVAL;
1477        }
1478        return err;
1479}
1480
1481
1482static u32 w9968cf_i2c_func(struct i2c_adapter* adap)
1483{
1484        return I2C_FUNC_SMBUS_READ_BYTE |
1485               I2C_FUNC_SMBUS_READ_BYTE_DATA  |
1486               I2C_FUNC_SMBUS_WRITE_BYTE_DATA;
1487}
1488
1489
1490static int w9968cf_i2c_init(struct w9968cf_device* cam)
1491{
1492        int err = 0;
1493
1494        static struct i2c_algorithm algo = {
1495                .smbus_xfer =    w9968cf_i2c_smbus_xfer,
1496                .functionality = w9968cf_i2c_func,
1497        };
1498
1499        static struct i2c_adapter adap = {
1500                .owner =             THIS_MODULE,
1501                .algo =              &algo,
1502        };
1503
1504        memcpy(&cam->i2c_adapter, &adap, sizeof(struct i2c_adapter));
1505        strcpy(cam->i2c_adapter.name, "w9968cf");
1506        cam->i2c_adapter.dev.parent = &cam->usbdev->dev;
1507        i2c_set_adapdata(&cam->i2c_adapter, &cam->v4l2_dev);
1508
1509        DBG(6, "Registering I2C adapter with kernel...")
1510
1511        err = i2c_add_adapter(&cam->i2c_adapter);
1512        if (err)
1513                DBG(1, "Failed to register the I2C adapter")
1514        else
1515                DBG(5, "I2C adapter registered")
1516
1517        return err;
1518}
1519
1520
1521
1522/****************************************************************************
1523 * Helper functions                                                         *
1524 ****************************************************************************/
1525
1526/*--------------------------------------------------------------------------
1527  Turn on the LED on some webcams. A beep should be heard too.
1528  Return 0 on success, a negative number otherwise.
1529  --------------------------------------------------------------------------*/
1530static int w9968cf_turn_on_led(struct w9968cf_device* cam)
1531{
1532        int err = 0;
1533
1534        err += w9968cf_write_reg(cam, 0xff00, 0x00); /* power-down */
1535        err += w9968cf_write_reg(cam, 0xbf17, 0x00); /* reset everything */
1536        err += w9968cf_write_reg(cam, 0xbf10, 0x00); /* normal operation */
1537        err += w9968cf_write_reg(cam, 0x0010, 0x01); /* serial bus, SDS high */
1538        err += w9968cf_write_reg(cam, 0x0000, 0x01); /* serial bus, SDS low */
1539        err += w9968cf_write_reg(cam, 0x0010, 0x01); /* ..high 'beep-beep' */
1540
1541        if (err)
1542                DBG(2, "Couldn't turn on the LED")
1543
1544        DBG(5, "LED turned on")
1545
1546        return err;
1547}
1548
1549
1550/*--------------------------------------------------------------------------
1551  Write some registers for the device initialization.
1552  This function is called once on open().
1553  Return 0 on success, a negative number otherwise.
1554  --------------------------------------------------------------------------*/
1555static int w9968cf_init_chip(struct w9968cf_device* cam)
1556{
1557        unsigned long hw_bufsize = cam->maxwidth*cam->maxheight*2,
1558                      y0 = 0x0000,
1559                      u0 = y0 + hw_bufsize/2,
1560                      v0 = u0 + hw_bufsize/4,
1561                      y1 = v0 + hw_bufsize/4,
1562                      u1 = y1 + hw_bufsize/2,
1563                      v1 = u1 + hw_bufsize/4;
1564        int err = 0;
1565
1566        err += w9968cf_write_reg(cam, 0xff00, 0x00); /* power off */
1567        err += w9968cf_write_reg(cam, 0xbf10, 0x00); /* power on */
1568
1569        err += w9968cf_write_reg(cam, 0x405d, 0x03); /* DRAM timings */
1570        err += w9968cf_write_reg(cam, 0x0030, 0x04); /* SDRAM timings */
1571
1572        err += w9968cf_write_reg(cam, y0 & 0xffff, 0x20); /* Y buf.0, low */
1573        err += w9968cf_write_reg(cam, y0 >> 16, 0x21);    /* Y buf.0, high */
1574        err += w9968cf_write_reg(cam, u0 & 0xffff, 0x24); /* U buf.0, low */
1575        err += w9968cf_write_reg(cam, u0 >> 16, 0x25);    /* U buf.0, high */
1576        err += w9968cf_write_reg(cam, v0 & 0xffff, 0x28); /* V buf.0, low */
1577        err += w9968cf_write_reg(cam, v0 >> 16, 0x29);    /* V buf.0, high */
1578
1579        err += w9968cf_write_reg(cam, y1 & 0xffff, 0x22); /* Y buf.1, low */
1580        err += w9968cf_write_reg(cam, y1 >> 16, 0x23);    /* Y buf.1, high */
1581        err += w9968cf_write_reg(cam, u1 & 0xffff, 0x26); /* U buf.1, low */
1582        err += w9968cf_write_reg(cam, u1 >> 16, 0x27);    /* U buf.1, high */
1583        err += w9968cf_write_reg(cam, v1 & 0xffff, 0x2a); /* V buf.1, low */
1584        err += w9968cf_write_reg(cam, v1 >> 16, 0x2b);    /* V buf.1, high */
1585
1586        err += w9968cf_write_reg(cam, y1 & 0xffff, 0x32); /* JPEG buf 0 low */
1587        err += w9968cf_write_reg(cam, y1 >> 16, 0x33);    /* JPEG buf 0 high */
1588
1589        err += w9968cf_write_reg(cam, y1 & 0xffff, 0x34); /* JPEG buf 1 low */
1590        err += w9968cf_write_reg(cam, y1 >> 16, 0x35);    /* JPEG bug 1 high */
1591
1592        err += w9968cf_write_reg(cam, 0x0000, 0x36);/* JPEG restart interval */
1593        err += w9968cf_write_reg(cam, 0x0804, 0x37);/*JPEG VLE FIFO threshold*/
1594        err += w9968cf_write_reg(cam, 0x0000, 0x38);/* disable hw up-scaling */
1595        err += w9968cf_write_reg(cam, 0x0000, 0x3f); /* JPEG/MCTL test data */
1596
1597        err += w9968cf_set_picture(cam, cam->picture); /* this before */
1598        err += w9968cf_set_window(cam, cam->window);
1599
1600        if (err)
1601                DBG(1, "Chip initialization failed")
1602        else
1603                DBG(5, "Chip successfully initialized")
1604
1605        return err;
1606}
1607
1608
1609/*--------------------------------------------------------------------------
1610  Return non-zero if the palette is supported, 0 otherwise.
1611  --------------------------------------------------------------------------*/
1612static inline u16 w9968cf_valid_palette(u16 palette)
1613{
1614        u8 i = 0;
1615        while (w9968cf_formatlist[i].palette != 0) {
1616                if (palette == w9968cf_formatlist[i].palette)
1617                        return palette;
1618                i++;
1619        }
1620        return 0;
1621}
1622
1623
1624/*--------------------------------------------------------------------------
1625  Return the depth corresponding to the given palette.
1626  Palette _must_ be supported !
1627  --------------------------------------------------------------------------*/
1628static inline u16 w9968cf_valid_depth(u16 palette)
1629{
1630        u8 i=0;
1631        while (w9968cf_formatlist[i].palette != palette)
1632                i++;
1633
1634        return w9968cf_formatlist[i].depth;
1635}
1636
1637
1638/*--------------------------------------------------------------------------
1639  Return non-zero if the format requires decompression, 0 otherwise.
1640  --------------------------------------------------------------------------*/
1641static inline u8 w9968cf_need_decompression(u16 palette)
1642{
1643        u8 i = 0;
1644        while (w9968cf_formatlist[i].palette != 0) {
1645                if (palette == w9968cf_formatlist[i].palette)
1646                        return w9968cf_formatlist[i].compression;
1647                i++;
1648        }
1649        return 0;
1650}
1651
1652
1653/*--------------------------------------------------------------------------
1654  Change the picture settings of the camera.
1655  Return 0 on success, a negative number otherwise.
1656  --------------------------------------------------------------------------*/
1657static int
1658w9968cf_set_picture(struct w9968cf_device* cam, struct video_picture pict)
1659{
1660        u16 fmt, hw_depth, hw_palette, reg_v = 0x0000;
1661        int err = 0;
1662
1663        /* Make sure we are using a valid depth */
1664        pict.depth = w9968cf_valid_depth(pict.palette);
1665
1666        fmt = pict.palette;
1667
1668        hw_depth = pict.depth; /* depth used by the winbond chip */
1669        hw_palette = pict.palette; /* palette used by the winbond chip */
1670
1671        /* VS & HS polarities */
1672        reg_v = (cam->vs_polarity << 12) | (cam->hs_polarity << 11);
1673
1674        switch (fmt)
1675        {
1676                case VIDEO_PALETTE_UYVY:
1677                        reg_v |= 0x0000;
1678                        cam->vpp_flag = VPP_NONE;
1679                        break;
1680                case VIDEO_PALETTE_YUV422P:
1681                        reg_v |= 0x0002;
1682                        cam->vpp_flag = VPP_DECOMPRESSION;
1683                        break;
1684                case VIDEO_PALETTE_YUV420:
1685                case VIDEO_PALETTE_YUV420P:
1686                        reg_v |= 0x0003;
1687                        cam->vpp_flag = VPP_DECOMPRESSION;
1688                        break;
1689                case VIDEO_PALETTE_YUYV:
1690                case VIDEO_PALETTE_YUV422:
1691                        reg_v |= 0x0000;
1692                        cam->vpp_flag = VPP_SWAP_YUV_BYTES;
1693                        hw_palette = VIDEO_PALETTE_UYVY;
1694                        break;
1695                /* Original video is used instead of RGBX palettes.
1696                   Software conversion later. */
1697                case VIDEO_PALETTE_GREY:
1698                case VIDEO_PALETTE_RGB555:
1699                case VIDEO_PALETTE_RGB565:
1700                case VIDEO_PALETTE_RGB24:
1701                case VIDEO_PALETTE_RGB32:
1702                        reg_v |= 0x0000; /* UYVY 16 bit is used */
1703                        hw_depth = 16;
1704                        hw_palette = VIDEO_PALETTE_UYVY;
1705                        cam->vpp_flag = VPP_UYVY_TO_RGBX;
1706                        break;
1707        }
1708
1709        /* NOTE: due to memory issues, it is better to disable the hardware
1710                 double buffering during compression */
1711        if (cam->double_buffer && !(cam->vpp_flag & VPP_DECOMPRESSION))
1712                reg_v |= 0x0080;
1713
1714        if (cam->clamping)
1715                reg_v |= 0x0020;
1716
1717        if (cam->filter_type == 1)
1718                reg_v |= 0x0008;
1719        else if (cam->filter_type == 2)
1720                reg_v |= 0x000c;
1721
1722        if ((err = w9968cf_write_reg(cam, reg_v, 0x16)))
1723                goto error;
1724
1725        if ((err = w9968cf_sensor_update_picture(cam, pict)))
1726                goto error;
1727
1728        /* If all went well, update the device data structure */
1729        memcpy(&cam->picture, &pict, sizeof(pict));
1730        cam->hw_depth = hw_depth;
1731        cam->hw_palette = hw_palette;
1732
1733        /* Settings changed, so we clear the frame buffers */
1734        memset(cam->frame[0].buffer, 0, cam->nbuffers*cam->frame[0].size);
1735
1736        DBG(4, "Palette is %s, depth is %u bpp",
1737            symbolic(v4l1_plist, pict.palette), pict.depth)
1738
1739        return 0;
1740
1741error:
1742        DBG(1, "Failed to change picture settings")
1743        return err;
1744}
1745
1746
1747/*--------------------------------------------------------------------------
1748  Change the capture area size of the camera.
1749  This function _must_ be called _after_ w9968cf_set_picture().
1750  Return 0 on success, a negative number otherwise.
1751  --------------------------------------------------------------------------*/
1752static int
1753w9968cf_set_window(struct w9968cf_device* cam, struct video_window win)
1754{
1755        u16 x, y, w, h, scx, scy, cw, ch, ax, ay;
1756        unsigned long fw, fh;
1757        struct ovcamchip_window s_win;
1758        int err = 0;
1759
1760        /* Work around to avoid FP arithmetics */
1761        #define SC(x) ((x) << 10)
1762        #define UNSC(x) ((x) >> 10)
1763
1764        /* Make sure we are using a supported resolution */
1765        if ((err = w9968cf_adjust_window_size(cam, &win.width, &win.height)))
1766                goto error;
1767
1768        /* Scaling factors */
1769        fw = SC(win.width) / cam->maxwidth;
1770        fh = SC(win.height) / cam->maxheight;
1771
1772        /* Set up the width and height values used by the chip */
1773        if ((win.width > cam->maxwidth) || (win.height > cam->maxheight)) {
1774                cam->vpp_flag |= VPP_UPSCALE;
1775                /* Calculate largest w,h mantaining the same w/h ratio */
1776                w = (fw >= fh) ? cam->maxwidth : SC(win.width)/fh;
1777                h = (fw >= fh) ? SC(win.height)/fw : cam->maxheight;
1778                if (w < cam->minwidth) /* just in case */
1779                        w = cam->minwidth;
1780                if (h < cam->minheight) /* just in case */
1781                        h = cam->minheight;
1782        } else {
1783                cam->vpp_flag &= ~VPP_UPSCALE;
1784                w = win.width;
1785                h = win.height;
1786        }
1787
1788        /* x,y offsets of the cropped area */
1789        scx = cam->start_cropx;
1790        scy = cam->start_cropy;
1791
1792        /* Calculate cropped area manteining the right w/h ratio */
1793        if (cam->largeview && !(cam->vpp_flag & VPP_UPSCALE)) {
1794                cw = (fw >= fh) ? cam->maxwidth : SC(win.width)/fh;
1795                ch = (fw >= fh) ? SC(win.height)/fw : cam->maxheight;
1796        } else {
1797                cw = w;
1798                ch = h;
1799        }
1800
1801        /* Setup the window of the sensor */
1802        s_win.format = VIDEO_PALETTE_UYVY;
1803        s_win.width = cam->maxwidth;
1804        s_win.height = cam->maxheight;
1805        s_win.quarter = 0; /* full progressive video */
1806
1807        /* Center it */
1808        s_win.x = (s_win.width - cw) / 2;
1809        s_win.y = (s_win.height - ch) / 2;
1810
1811        /* Clock divisor */
1812        if (cam->clockdiv >= 0)
1813                s_win.clockdiv = cam->clockdiv; /* manual override */
1814        else
1815                switch (cam->sensor) {
1816                        case CC_OV6620:
1817                                s_win.clockdiv = 0;
1818                                break;
1819                        case CC_OV6630:
1820                                s_win.clockdiv = 0;
1821                                break;
1822                        case CC_OV76BE:
1823                        case CC_OV7610:
1824                        case CC_OV7620:
1825                                s_win.clockdiv = 0;
1826                                break;
1827                        default:
1828                                s_win.clockdiv = W9968CF_DEF_CLOCKDIVISOR;
1829                }
1830
1831        /* We have to scale win.x and win.y offsets */
1832        if ( (cam->largeview && !(cam->vpp_flag & VPP_UPSCALE))
1833             || (cam->vpp_flag & VPP_UPSCALE) ) {
1834                ax = SC(win.x)/fw;
1835                ay = SC(win.y)/fh;
1836        } else {
1837                ax = win.x;
1838                ay = win.y;
1839        }
1840
1841        if ((ax + cw) > cam->maxwidth)
1842                ax = cam->maxwidth - cw;
1843
1844        if ((ay + ch) > cam->maxheight)
1845                ay = cam->maxheight - ch;
1846
1847        /* Adjust win.x, win.y */
1848        if ( (cam->largeview && !(cam->vpp_flag & VPP_UPSCALE))
1849             || (cam->vpp_flag & VPP_UPSCALE) ) {
1850                win.x = UNSC(ax*fw);
1851                win.y = UNSC(ay*fh);
1852        } else {
1853                win.x = ax;
1854                win.y = ay;
1855        }
1856
1857        /* Offsets used by the chip */
1858        x = ax + s_win.x;
1859        y = ay + s_win.y;
1860
1861        /* Go ! */
1862        if ((err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_S_MODE, &s_win)))
1863                goto error;
1864
1865        err += w9968cf_write_reg(cam, scx + x, 0x10);
1866        err += w9968cf_write_reg(cam, scy + y, 0x11);
1867        err += w9968cf_write_reg(cam, scx + x + cw, 0x12);
1868        err += w9968cf_write_reg(cam, scy + y + ch, 0x13);
1869        err += w9968cf_write_reg(cam, w, 0x14);
1870        err += w9968cf_write_reg(cam, h, 0x15);
1871
1872        /* JPEG width & height */
1873        err += w9968cf_write_reg(cam, w, 0x30);
1874        err += w9968cf_write_reg(cam, h, 0x31);
1875
1876        /* Y & UV frame buffer strides (in WORD) */
1877        if (cam->vpp_flag & VPP_DECOMPRESSION) {
1878                err += w9968cf_write_reg(cam, w/2, 0x2c);
1879                err += w9968cf_write_reg(cam, w/4, 0x2d);
1880        } else
1881                err += w9968cf_write_reg(cam, w, 0x2c);
1882
1883        if (err)
1884                goto error;
1885
1886        /* If all went well, update the device data structure */
1887        memcpy(&cam->window, &win, sizeof(win));
1888        cam->hw_width = w;
1889        cam->hw_height = h;
1890
1891        /* Settings changed, so we clear the frame buffers */
1892        memset(cam->frame[0].buffer, 0, cam->nbuffers*cam->frame[0].size);
1893
1894        DBG(4, "The capture area is %dx%d, Offset (x,y)=(%u,%u)",
1895            win.width, win.height, win.x, win.y)
1896
1897        PDBGG("x=%u ,y=%u, w=%u, h=%u, ax=%u, ay=%u, s_win.x=%u, s_win.y=%u, "
1898              "cw=%u, ch=%u, win.x=%u, win.y=%u, win.width=%u, win.height=%u",
1899              x, y, w, h, ax, ay, s_win.x, s_win.y, cw, ch, win.x, win.y,
1900              win.width, win.height)
1901
1902        return 0;
1903
1904error:
1905        DBG(1, "Failed to change the capture area size")
1906        return err;
1907}
1908
1909
1910/*--------------------------------------------------------------------------
1911  Adjust the asked values for window width and height.
1912  Return 0 on success, -1 otherwise.
1913  --------------------------------------------------------------------------*/
1914static int
1915w9968cf_adjust_window_size(struct w9968cf_device *cam, u32 *width, u32 *height)
1916{
1917        unsigned int maxw, maxh, align;
1918
1919        maxw = cam->upscaling && !(cam->vpp_flag & VPP_DECOMPRESSION) &&
1920               w9968cf_vpp ? max((u16)W9968CF_MAX_WIDTH, cam->maxwidth)
1921                           : cam->maxwidth;
1922        maxh = cam->upscaling && !(cam->vpp_flag & VPP_DECOMPRESSION) &&
1923               w9968cf_vpp ? max((u16)W9968CF_MAX_HEIGHT, cam->maxheight)
1924                           : cam->maxheight;
1925        align = (cam->vpp_flag & VPP_DECOMPRESSION) ? 4 : 0;
1926
1927        v4l_bound_align_image(width, cam->minwidth, maxw, align,
1928                              height, cam->minheight, maxh, align, 0);
1929
1930        PDBGG("Window size adjusted w=%u, h=%u ", *width, *height)
1931
1932        return 0;
1933}
1934
1935
1936/*--------------------------------------------------------------------------
1937  Initialize the FIFO list of requested frames.
1938  --------------------------------------------------------------------------*/
1939static void w9968cf_init_framelist(struct w9968cf_device* cam)
1940{
1941        u8 i;
1942
1943        for (i = 0; i < cam->nbuffers; i++) {
1944                cam->requested_frame[i] = NULL;
1945                cam->frame[i].queued = 0;
1946                cam->frame[i].status = F_UNUSED;
1947        }
1948}
1949
1950
1951/*--------------------------------------------------------------------------
1952  Add a frame in the FIFO list of requested frames.
1953  This function is called in process context.
1954  --------------------------------------------------------------------------*/
1955static void w9968cf_push_frame(struct w9968cf_device* cam, u8 f_num)
1956{
1957        u8 f;
1958        unsigned long lock_flags;
1959
1960        spin_lock_irqsave(&cam->flist_lock, lock_flags);
1961
1962        for (f=0; cam->requested_frame[f] != NULL; f++);
1963        cam->requested_frame[f] = &cam->frame[f_num];
1964        cam->frame[f_num].queued = 1;
1965        cam->frame[f_num].status = F_UNUSED; /* clear the status */
1966
1967        spin_unlock_irqrestore(&cam->flist_lock, lock_flags);
1968
1969        DBG(6, "Frame #%u pushed into the FIFO list. Position %u", f_num, f)
1970}
1971
1972
1973/*--------------------------------------------------------------------------
1974  Read, store and remove the first pointer in the FIFO list of requested
1975  frames. This function is called in interrupt context.
1976  --------------------------------------------------------------------------*/
1977static void
1978w9968cf_pop_frame(struct w9968cf_device* cam, struct w9968cf_frame_t** framep)
1979{
1980        u8 i;
1981
1982        spin_lock(&cam->flist_lock);
1983
1984        *framep = cam->requested_frame[0];
1985
1986        /* Shift the list of pointers */
1987        for (i = 0; i < cam->nbuffers-1; i++)
1988                cam->requested_frame[i] = cam->requested_frame[i+1];
1989        cam->requested_frame[i] = NULL;
1990
1991        spin_unlock(&cam->flist_lock);
1992
1993        DBG(6,"Popped frame #%d from the list", (*framep)->number)
1994}
1995
1996
1997/*--------------------------------------------------------------------------
1998  High-level video post-processing routine on grabbed frames.
1999  Return 0 on success, a negative number otherwise.
2000  --------------------------------------------------------------------------*/
2001static int
2002w9968cf_postprocess_frame(struct w9968cf_device* cam,
2003                          struct w9968cf_frame_t* fr)
2004{
2005        void *pIn = fr->buffer, *pOut = cam->frame_vpp.buffer, *tmp;
2006        u16 w = cam->window.width,
2007            h = cam->window.height,
2008            d = cam->picture.depth,
2009            fmt = cam->picture.palette,
2010            rgb = cam->force_rgb,
2011            hw_w = cam->hw_width,
2012            hw_h = cam->hw_height,
2013            hw_d = cam->hw_depth;
2014        int err = 0;
2015
2016        #define _PSWAP(pIn, pOut) {tmp = (pIn); (pIn) = (pOut); (pOut) = tmp;}
2017
2018        if (cam->vpp_flag & VPP_DECOMPRESSION) {
2019                memcpy(pOut, pIn, fr->length);
2020                _PSWAP(pIn, pOut)
2021                err = w9968cf_vpp->decode(pIn, fr->length, hw_w, hw_h, pOut);
2022                PDBGG("Compressed frame length: %lu",(unsigned long)fr->length)
2023                fr->length = (hw_w*hw_h*hw_d)/8;
2024                _PSWAP(pIn, pOut)
2025                if (err) {
2026                        DBG(4, "An error occurred while decoding the frame: "
2027                               "%s", symbolic(decoder_errlist, err))
2028                        return err;
2029                } else
2030                        DBG(6, "Frame decoded")
2031        }
2032
2033        if (cam->vpp_flag & VPP_SWAP_YUV_BYTES) {
2034                w9968cf_vpp->swap_yuvbytes(pIn, fr->length);
2035                DBG(6, "Original UYVY component ordering changed")
2036        }
2037
2038        if (cam->vpp_flag & VPP_UPSCALE) {
2039                w9968cf_vpp->scale_up(pIn, pOut, hw_w, hw_h, hw_d, w, h);
2040                fr->length = (w*h*hw_d)/8;
2041                _PSWAP(pIn, pOut)
2042                DBG(6, "Vertical up-scaling done: %u,%u,%ubpp->%u,%u",
2043                    hw_w, hw_h, hw_d, w, h)
2044        }
2045
2046        if (cam->vpp_flag & VPP_UYVY_TO_RGBX) {
2047                w9968cf_vpp->uyvy_to_rgbx(pIn, fr->length, pOut, fmt, rgb);
2048                fr->length = (w*h*d)/8;
2049                _PSWAP(pIn, pOut)
2050                DBG(6, "UYVY-16bit to %s conversion done",
2051                    symbolic(v4l1_plist, fmt))
2052        }
2053
2054        if (pOut == fr->buffer)
2055                memcpy(fr->buffer, cam->frame_vpp.buffer, fr->length);
2056
2057        return 0;
2058}
2059
2060
2061
2062/****************************************************************************
2063 * Image sensor control routines                                            *
2064 ****************************************************************************/
2065
2066static int
2067w9968cf_sensor_set_control(struct w9968cf_device* cam, int cid, int val)
2068{
2069        struct ovcamchip_control ctl;
2070        int err;
2071
2072        ctl.id = cid;
2073        ctl.value = val;
2074
2075        err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_S_CTRL, &ctl);
2076
2077        return err;
2078}
2079
2080
2081static int
2082w9968cf_sensor_get_control(struct w9968cf_device* cam, int cid, int* val)
2083{
2084        struct ovcamchip_control ctl;
2085        int err;
2086
2087        ctl.id = cid;
2088
2089        err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_G_CTRL, &ctl);
2090        if (!err)
2091                *val = ctl.value;
2092
2093        return err;
2094}
2095
2096
2097static int
2098w9968cf_sensor_cmd(struct w9968cf_device* cam, unsigned int cmd, void* arg)
2099{
2100        int rc;
2101
2102        rc = v4l2_subdev_call(cam->sensor_sd, core, ioctl, cmd, arg);
2103        /* The I2C driver returns -EPERM on non-supported controls */
2104        return (rc < 0 && rc != -EPERM) ? rc : 0;
2105}
2106
2107
2108/*--------------------------------------------------------------------------
2109  Update some settings of the image sensor.
2110  Returns: 0 on success, a negative number otherwise.
2111  --------------------------------------------------------------------------*/
2112static int w9968cf_sensor_update_settings(struct w9968cf_device* cam)
2113{
2114        int err = 0;
2115
2116        /* Auto brightness */
2117        err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_AUTOBRIGHT,
2118                                         cam->auto_brt);
2119        if (err)
2120                return err;
2121
2122        /* Auto exposure */
2123        err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_AUTOEXP,
2124                                         cam->auto_exp);
2125        if (err)
2126                return err;
2127
2128        /* Banding filter */
2129        err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_BANDFILT,
2130                                         cam->bandfilt);
2131        if (err)
2132                return err;
2133
2134        /* Light frequency */
2135        err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_FREQ,
2136                                         cam->lightfreq);
2137        if (err)
2138                return err;
2139
2140        /* Back light */
2141        err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_BACKLIGHT,
2142                                         cam->backlight);
2143        if (err)
2144                return err;
2145
2146        /* Mirror */
2147        err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_MIRROR,
2148                                         cam->mirror);
2149        if (err)
2150                return err;
2151
2152        return 0;
2153}
2154
2155
2156/*--------------------------------------------------------------------------
2157  Get some current picture settings from the image sensor and update the
2158  internal 'picture' structure of the camera.
2159  Returns: 0 on success, a negative number otherwise.
2160  --------------------------------------------------------------------------*/
2161static int w9968cf_sensor_get_picture(struct w9968cf_device* cam)
2162{
2163        int err, v;
2164
2165        err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_CONT, &v);
2166        if (err)
2167                return err;
2168        cam->picture.contrast = v;
2169
2170        err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_BRIGHT, &v);
2171        if (err)
2172                return err;
2173        cam->picture.brightness = v;
2174
2175        err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_SAT, &v);
2176        if (err)
2177                return err;
2178        cam->picture.colour = v;
2179
2180        err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_HUE, &v);
2181        if (err)
2182                return err;
2183        cam->picture.hue = v;
2184
2185        DBG(5, "Got picture settings from the image sensor")
2186
2187        PDBGG("Brightness, contrast, hue, colour, whiteness are "
2188              "%u,%u,%u,%u,%u", cam->picture.brightness,cam->picture.contrast,
2189              cam->picture.hue, cam->picture.colour, cam->picture.whiteness)
2190
2191        return 0;
2192}
2193
2194
2195/*--------------------------------------------------------------------------
2196  Update picture settings of the image sensor.
2197  Returns: 0 on success, a negative number otherwise.
2198  --------------------------------------------------------------------------*/
2199static int
2200w9968cf_sensor_update_picture(struct w9968cf_device* cam,
2201                              struct video_picture pict)
2202{
2203        int err = 0;
2204
2205        if ((!cam->sensor_initialized)
2206            || pict.contrast != cam->picture.contrast) {
2207                err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_CONT,
2208                                                 pict.contrast);
2209                if (err)
2210                        goto fail;
2211                DBG(4, "Contrast changed from %u to %u",
2212                    cam->picture.contrast, pict.contrast)
2213                cam->picture.contrast = pict.contrast;
2214        }
2215
2216        if (((!cam->sensor_initialized) ||
2217            pict.brightness != cam->picture.brightness) && (!cam->auto_brt)) {
2218                err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_BRIGHT,
2219                                                 pict.brightness);
2220                if (err)
2221                        goto fail;
2222                DBG(4, "Brightness changed from %u to %u",
2223                    cam->picture.brightness, pict.brightness)
2224                cam->picture.brightness = pict.brightness;
2225        }
2226
2227        if ((!cam->sensor_initialized) || pict.colour != cam->picture.colour) {
2228                err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_SAT,
2229                                                 pict.colour);
2230                if (err)
2231                        goto fail;
2232                DBG(4, "Colour changed from %u to %u",
2233                    cam->picture.colour, pict.colour)
2234                cam->picture.colour = pict.colour;
2235        }
2236
2237        if ((!cam->sensor_initialized) || pict.hue != cam->picture.hue) {
2238                err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_HUE,
2239                                                 pict.hue);
2240                if (err)
2241                        goto fail;
2242                DBG(4, "Hue changed from %u to %u",
2243                    cam->picture.hue, pict.hue)
2244                cam->picture.hue = pict.hue;
2245        }
2246
2247        return 0;
2248
2249fail:
2250        DBG(4, "Failed to change sensor picture setting")
2251        return err;
2252}
2253
2254
2255
2256/****************************************************************************
2257 * Camera configuration                                                     *
2258 ****************************************************************************/
2259
2260/*--------------------------------------------------------------------------
2261  This function is called when a supported image sensor is detected.
2262  Return 0 if the initialization succeeds, a negative number otherwise.
2263  --------------------------------------------------------------------------*/
2264static int w9968cf_sensor_init(struct w9968cf_device* cam)
2265{
2266        int err = 0;
2267
2268        if ((err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_INITIALIZE,
2269                                      &cam->monochrome)))
2270                goto error;
2271
2272        if ((err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_Q_SUBTYPE,
2273                                      &cam->sensor)))
2274                goto error;
2275
2276        /* NOTE: Make sure width and height are a multiple of 16 */
2277        switch (v4l2_i2c_subdev_addr(cam->sensor_sd)) {
2278                case OV6xx0_SID:
2279                        cam->maxwidth = 352;
2280                        cam->maxheight = 288;
2281                        cam->minwidth = 64;
2282                        cam->minheight = 48;
2283                        break;
2284                case OV7xx0_SID:
2285                        cam->maxwidth = 640;
2286                        cam->maxheight = 480;
2287                        cam->minwidth = 64;
2288                        cam->minheight = 48;
2289                        break;
2290                default:
2291                        DBG(1, "Not supported image sensor detected for %s",
2292                            symbolic(camlist, cam->id))
2293                        return -EINVAL;
2294        }
2295
2296        /* These values depend on the ones in the ovxxx0.c sources */
2297        switch (cam->sensor) {
2298                case CC_OV7620:
2299                        cam->start_cropx = 287;
2300                        cam->start_cropy = 35;
2301                        /* Seems to work around a bug in the image sensor */
2302                        cam->vs_polarity = 1;
2303                        cam->hs_polarity = 1;
2304                        break;
2305                default:
2306                        cam->start_cropx = 320;
2307                        cam->start_cropy = 35;
2308                        cam->vs_polarity = 1;
2309                        cam->hs_polarity = 0;
2310        }
2311
2312        if ((err = w9968cf_sensor_update_settings(cam)))
2313                goto error;
2314
2315        if ((err = w9968cf_sensor_update_picture(cam, cam->picture)))
2316                goto error;
2317
2318        cam->sensor_initialized = 1;
2319
2320        DBG(2, "%s image sensor initialized", symbolic(senlist, cam->sensor))
2321        return 0;
2322
2323error:
2324        cam->sensor_initialized = 0;
2325        cam->sensor = CC_UNKNOWN;
2326        DBG(1, "Image sensor initialization failed for %s (%s). "
2327               "Try to detach and attach this device again",
2328            symbolic(camlist, cam->id), video_device_node_name(cam->v4ldev))
2329        return err;
2330}
2331
2332
2333/*--------------------------------------------------------------------------
2334  Fill some basic fields in the main device data structure.
2335  This function is called once on w9968cf_usb_probe() for each recognized
2336  camera.
2337  --------------------------------------------------------------------------*/
2338static void
2339w9968cf_configure_camera(struct w9968cf_device* cam,
2340                         struct usb_device* udev,
2341                         enum w9968cf_model_id mod_id,
2342                         const unsigned short dev_nr)
2343{
2344        mutex_init(&cam->fileop_mutex);
2345        init_waitqueue_head(&cam->open);
2346        spin_lock_init(&cam->urb_lock);
2347        spin_lock_init(&cam->flist_lock);
2348
2349        cam->users = 0;
2350        cam->disconnected = 0;
2351        cam->id = mod_id;
2352        cam->sensor = CC_UNKNOWN;
2353        cam->sensor_initialized = 0;
2354
2355        /* Calculate the alternate setting number (from 1 to 16)
2356           according to the 'packet_size' module parameter */
2357        if (packet_size[dev_nr] < W9968CF_MIN_PACKET_SIZE)
2358                packet_size[dev_nr] = W9968CF_MIN_PACKET_SIZE;
2359        for (cam->altsetting = 1;
2360             packet_size[dev_nr] < wMaxPacketSize[cam->altsetting-1];
2361             cam->altsetting++);
2362
2363        cam->max_buffers = (max_buffers[dev_nr] < 2 ||
2364                            max_buffers[dev_nr] > W9968CF_MAX_BUFFERS)
2365                           ? W9968CF_BUFFERS : (u8)max_buffers[dev_nr];
2366
2367        cam->double_buffer = (double_buffer[dev_nr] == 0 ||
2368                              double_buffer[dev_nr] == 1)
2369                             ? (u8)double_buffer[dev_nr]:W9968CF_DOUBLE_BUFFER;
2370
2371        cam->clamping = (clamping[dev_nr] == 0 || clamping[dev_nr] == 1)
2372                        ? (u8)clamping[dev_nr] : W9968CF_CLAMPING;
2373
2374        cam->filter_type = (filter_type[dev_nr] == 0 ||
2375                            filter_type[dev_nr] == 1 ||
2376                            filter_type[dev_nr] == 2)
2377                           ? (u8)filter_type[dev_nr] : W9968CF_FILTER_TYPE;
2378
2379        cam->capture = 1;
2380
2381        cam->largeview = (largeview[dev_nr] == 0 || largeview[dev_nr] == 1)
2382                         ? (u8)largeview[dev_nr] : W9968CF_LARGEVIEW;
2383
2384        cam->decompression = (decompression[dev_nr] == 0 ||
2385                              decompression[dev_nr] == 1 ||
2386                              decompression[dev_nr] == 2)
2387                             ? (u8)decompression[dev_nr]:W9968CF_DECOMPRESSION;
2388
2389        cam->upscaling = (upscaling[dev_nr] == 0 ||
2390                          upscaling[dev_nr] == 1)
2391                         ? (u8)upscaling[dev_nr] : W9968CF_UPSCALING;
2392
2393        cam->auto_brt = (autobright[dev_nr] == 0 || autobright[dev_nr] == 1)
2394                        ? (u8)autobright[dev_nr] : W9968CF_AUTOBRIGHT;
2395
2396        cam->auto_exp = (autoexp[dev_nr] == 0 || autoexp[dev_nr] == 1)
2397                        ? (u8)autoexp[dev_nr] : W9968CF_AUTOEXP;
2398
2399        cam->lightfreq = (lightfreq[dev_nr] == 50 || lightfreq[dev_nr] == 60)
2400                         ? (u8)lightfreq[dev_nr] : W9968CF_LIGHTFREQ;
2401
2402        cam->bandfilt = (bandingfilter[dev_nr] == 0 ||
2403                         bandingfilter[dev_nr] == 1)
2404                        ? (u8)bandingfilter[dev_nr] : W9968CF_BANDINGFILTER;
2405
2406        cam->backlight = (backlight[dev_nr] == 0 || backlight[dev_nr] == 1)
2407                         ? (u8)backlight[dev_nr] : W9968CF_BACKLIGHT;
2408
2409        cam->clockdiv = (clockdiv[dev_nr] == -1 || clockdiv[dev_nr] >= 0)
2410                        ? (s8)clockdiv[dev_nr] : W9968CF_CLOCKDIV;
2411
2412        cam->mirror = (mirror[dev_nr] == 0 || mirror[dev_nr] == 1)
2413                      ? (u8)mirror[dev_nr] : W9968CF_MIRROR;
2414
2415        cam->monochrome = (monochrome[dev_nr] == 0 || monochrome[dev_nr] == 1)
2416                          ? monochrome[dev_nr] : W9968CF_MONOCHROME;
2417
2418        cam->picture.brightness = (u16)brightness[dev_nr];
2419        cam->picture.hue = (u16)hue[dev_nr];
2420        cam->picture.colour = (u16)colour[dev_nr];
2421        cam->picture.contrast = (u16)contrast[dev_nr];
2422        cam->picture.whiteness = (u16)whiteness[dev_nr];
2423        if (w9968cf_valid_palette((u16)force_palette[dev_nr])) {
2424                cam->picture.palette = (u16)force_palette[dev_nr];
2425                cam->force_palette = 1;
2426        } else {
2427                cam->force_palette = 0;
2428                if (cam->decompression == 0)
2429                        cam->picture.palette = W9968CF_PALETTE_DECOMP_OFF;
2430                else if (cam->decompression == 1)
2431                        cam->picture.palette = W9968CF_PALETTE_DECOMP_FORCE;
2432                else
2433                        cam->picture.palette = W9968CF_PALETTE_DECOMP_ON;
2434        }
2435        cam->picture.depth = w9968cf_valid_depth(cam->picture.palette);
2436
2437        cam->force_rgb = (force_rgb[dev_nr] == 0 || force_rgb[dev_nr] == 1)
2438                         ? (u8)force_rgb[dev_nr] : W9968CF_FORCE_RGB;
2439
2440        cam->window.x = 0;
2441        cam->window.y = 0;
2442        cam->window.width = W9968CF_WIDTH;
2443        cam->window.height = W9968CF_HEIGHT;
2444        cam->window.chromakey = 0;
2445        cam->window.clipcount = 0;
2446        cam->window.flags = 0;
2447
2448        DBG(3, "%s configured with settings #%u:",
2449            symbolic(camlist, cam->id), dev_nr)
2450
2451        DBG(3, "- Data packet size for USB isochrnous transfer: %u bytes",
2452            wMaxPacketSize[cam->altsetting-1])
2453
2454        DBG(3, "- Number of requested video frame buffers: %u",
2455            cam->max_buffers)
2456
2457        if (cam->double_buffer)
2458                DBG(3, "- Hardware double buffering enabled")
2459        else
2460                DBG(3, "- Hardware double buffering disabled")
2461
2462        if (cam->filter_type == 0)
2463                DBG(3, "- Video filtering disabled")
2464        else if (cam->filter_type == 1)
2465                DBG(3, "- Video filtering enabled: type 1-2-1")
2466        else if (cam->filter_type == 2)
2467                DBG(3, "- Video filtering enabled: type 2-3-6-3-2")
2468
2469        if (cam->clamping)
2470                DBG(3, "- Video data clamping (CCIR-601 format) enabled")
2471        else
2472                DBG(3, "- Video data clamping (CCIR-601 format) disabled")
2473
2474        if (cam->largeview)
2475                DBG(3, "- Large view enabled")
2476        else
2477                DBG(3, "- Large view disabled")
2478
2479        if ((cam->decompression) == 0 && (!cam->force_palette))
2480                DBG(3, "- Decompression disabled")
2481        else if ((cam->decompression) == 1 && (!cam->force_palette))
2482                DBG(3, "- Decompression forced")
2483        else if ((cam->decompression) == 2 && (!cam->force_palette))
2484                DBG(3, "- Decompression allowed")
2485
2486        if (cam->upscaling)
2487                DBG(3, "- Software image scaling enabled")
2488        else
2489                DBG(3, "- Software image scaling disabled")
2490
2491        if (cam->force_palette)
2492                DBG(3, "- Image palette forced to %s",
2493                    symbolic(v4l1_plist, cam->picture.palette))
2494
2495        if (cam->force_rgb)
2496                DBG(3, "- RGB component ordering will be used instead of BGR")
2497
2498        if (cam->auto_brt)
2499                DBG(3, "- Auto brightness enabled")
2500        else
2501                DBG(3, "- Auto brightness disabled")
2502
2503        if (cam->auto_exp)
2504                DBG(3, "- Auto exposure enabled")
2505        else
2506                DBG(3, "- Auto exposure disabled")
2507
2508        if (cam->backlight)
2509                DBG(3, "- Backlight exposure algorithm enabled")
2510        else
2511                DBG(3, "- Backlight exposure algorithm disabled")
2512
2513        if (cam->mirror)
2514                DBG(3, "- Mirror enabled")
2515        else
2516                DBG(3, "- Mirror disabled")
2517
2518        if (cam->bandfilt)
2519                DBG(3, "- Banding filter enabled")
2520        else
2521                DBG(3, "- Banding filter disabled")
2522
2523        DBG(3, "- Power lighting frequency: %u", cam->lightfreq)
2524
2525        if (cam->clockdiv == -1)
2526                DBG(3, "- Automatic clock divisor enabled")
2527        else
2528                DBG(3, "- Clock divisor: %d", cam->clockdiv)
2529
2530        if (cam->monochrome)
2531                DBG(3, "- Image sensor used as monochrome")
2532        else
2533                DBG(3, "- Image sensor not used as monochrome")
2534}
2535
2536
2537/*--------------------------------------------------------------------------
2538  If the video post-processing module is not loaded, some parameters
2539  must be overridden.
2540  --------------------------------------------------------------------------*/
2541static void w9968cf_adjust_configuration(struct w9968cf_device* cam)
2542{
2543        if (!w9968cf_vpp) {
2544                if (cam->decompression == 1) {
2545                        cam->decompression = 2;
2546                        DBG(2, "Video post-processing module not found: "
2547                               "'decompression' parameter forced to 2")
2548                }
2549                if (cam->upscaling) {
2550                        cam->upscaling = 0;
2551                        DBG(2, "Video post-processing module not found: "
2552                               "'upscaling' parameter forced to 0")
2553                }
2554                if (cam->picture.palette != VIDEO_PALETTE_UYVY) {
2555                        cam->force_palette = 0;
2556                        DBG(2, "Video post-processing module not found: "
2557                               "'force_palette' parameter forced to 0")
2558                }
2559                cam->picture.palette = VIDEO_PALETTE_UYVY;
2560                cam->picture.depth = w9968cf_valid_depth(cam->picture.palette);
2561        }
2562}
2563
2564
2565/*--------------------------------------------------------------------------
2566  Release the resources used by the driver.
2567  This function is called on disconnect
2568  (or on close if deallocation has been deferred)
2569  --------------------------------------------------------------------------*/
2570static void w9968cf_release_resources(struct w9968cf_device* cam)
2571{
2572        mutex_lock(&w9968cf_devlist_mutex);
2573
2574        DBG(2, "V4L device deregistered: %s",
2575            video_device_node_name(cam->v4ldev))
2576
2577        video_unregister_device(cam->v4ldev);
2578        list_del(&cam->v4llist);
2579        i2c_del_adapter(&cam->i2c_adapter);
2580        w9968cf_deallocate_memory(cam);
2581        kfree(cam->control_buffer);
2582        kfree(cam->data_buffer);
2583        v4l2_device_unregister(&cam->v4l2_dev);
2584
2585        mutex_unlock(&w9968cf_devlist_mutex);
2586}
2587
2588
2589
2590/****************************************************************************
2591 * Video4Linux interface                                                    *
2592 ****************************************************************************/
2593
2594static int w9968cf_open(struct file *filp)
2595{
2596        struct w9968cf_device* cam;
2597        int err;
2598
2599        /* This the only safe way to prevent race conditions with disconnect */
2600        if (!down_read_trylock(&w9968cf_disconnect))
2601                return -EAGAIN;
2602
2603        cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2604
2605        mutex_lock(&cam->dev_mutex);
2606
2607        if (cam->sensor == CC_UNKNOWN) {
2608                DBG(2, "No supported image sensor has been detected by the "
2609                       "'ovcamchip' module for the %s (%s). Make sure "
2610                       "it is loaded *before* (re)connecting the camera.",
2611                    symbolic(camlist, cam->id),
2612                    video_device_node_name(cam->v4ldev))
2613                mutex_unlock(&cam->dev_mutex);
2614                up_read(&w9968cf_disconnect);
2615                return -ENODEV;
2616        }
2617
2618        if (cam->users) {
2619                DBG(2, "%s (%s) has been already occupied by '%s'",
2620                    symbolic(camlist, cam->id),
2621                    video_device_node_name(cam->v4ldev), cam->command)
2622                if ((filp->f_flags & O_NONBLOCK)||(filp->f_flags & O_NDELAY)) {
2623                        mutex_unlock(&cam->dev_mutex);
2624                        up_read(&w9968cf_disconnect);
2625                        return -EWOULDBLOCK;
2626                }
2627                mutex_unlock(&cam->dev_mutex);
2628                err = wait_event_interruptible_exclusive(cam->open,
2629                                                         cam->disconnected ||
2630                                                         !cam->users);
2631                if (err) {
2632                        up_read(&w9968cf_disconnect);
2633                        return err;
2634                }
2635                if (cam->disconnected) {
2636                        up_read(&w9968cf_disconnect);
2637                        return -ENODEV;
2638                }
2639                mutex_lock(&cam->dev_mutex);
2640        }
2641
2642        DBG(5, "Opening '%s', %s ...",
2643            symbolic(camlist, cam->id), video_device_node_name(cam->v4ldev))
2644
2645        cam->streaming = 0;
2646        cam->misconfigured = 0;
2647
2648        w9968cf_adjust_configuration(cam);
2649
2650        if ((err = w9968cf_allocate_memory(cam)))
2651                goto deallocate_memory;
2652
2653        if ((err = w9968cf_init_chip(cam)))
2654                goto deallocate_memory;
2655
2656        if ((err = w9968cf_start_transfer(cam)))
2657                goto deallocate_memory;
2658
2659        filp->private_data = cam;
2660
2661        cam->users++;
2662        strcpy(cam->command, current->comm);
2663
2664        init_waitqueue_head(&cam->wait_queue);
2665
2666        DBG(5, "Video device is open")
2667
2668        mutex_unlock(&cam->dev_mutex);
2669        up_read(&w9968cf_disconnect);
2670
2671        return 0;
2672
2673deallocate_memory:
2674        w9968cf_deallocate_memory(cam);
2675        DBG(2, "Failed to open the video device")
2676        mutex_unlock(&cam->dev_mutex);
2677        up_read(&w9968cf_disconnect);
2678        return err;
2679}
2680
2681
2682static int w9968cf_release(struct file *filp)
2683{
2684        struct w9968cf_device* cam;
2685
2686        cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2687
2688        mutex_lock(&cam->dev_mutex); /* prevent disconnect() to be called */
2689
2690        w9968cf_stop_transfer(cam);
2691
2692        if (cam->disconnected) {
2693                w9968cf_release_resources(cam);
2694                mutex_unlock(&cam->dev_mutex);
2695                kfree(cam);
2696                return 0;
2697        }
2698
2699        cam->users--;
2700        w9968cf_deallocate_memory(cam);
2701        wake_up_interruptible_nr(&cam->open, 1);
2702
2703        DBG(5, "Video device closed")
2704        mutex_unlock(&cam->dev_mutex);
2705        return 0;
2706}
2707
2708
2709static ssize_t
2710w9968cf_read(struct file* filp, char __user * buf, size_t count, loff_t* f_pos)
2711{
2712        struct w9968cf_device* cam;
2713        struct w9968cf_frame_t* fr;
2714        int err = 0;
2715
2716        cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2717
2718        if (filp->f_flags & O_NONBLOCK)
2719                return -EWOULDBLOCK;
2720
2721        if (mutex_lock_interruptible(&cam->fileop_mutex))
2722                return -ERESTARTSYS;
2723
2724        if (cam->disconnected) {
2725                DBG(2, "Device not present")
2726                mutex_unlock(&cam->fileop_mutex);
2727                return -ENODEV;
2728        }
2729
2730        if (cam->misconfigured) {
2731                DBG(2, "The camera is misconfigured. Close and open it again.")
2732                mutex_unlock(&cam->fileop_mutex);
2733                return -EIO;
2734        }
2735
2736        if (!cam->frame[0].queued)
2737                w9968cf_push_frame(cam, 0);
2738
2739        if (!cam->frame[1].queued)
2740                w9968cf_push_frame(cam, 1);
2741
2742        err = wait_event_interruptible(cam->wait_queue,
2743                                       cam->frame[0].status == F_READY ||
2744                                       cam->frame[1].status == F_READY ||
2745                                       cam->disconnected);
2746        if (err) {
2747                mutex_unlock(&cam->fileop_mutex);
2748                return err;
2749        }
2750        if (cam->disconnected) {
2751                mutex_unlock(&cam->fileop_mutex);
2752                return -ENODEV;
2753        }
2754
2755        fr = (cam->frame[0].status == F_READY) ? &cam->frame[0]:&cam->frame[1];
2756
2757        if (w9968cf_vpp)
2758                w9968cf_postprocess_frame(cam, fr);
2759
2760        if (count > fr->length)
2761                count = fr->length;
2762
2763        if (copy_to_user(buf, fr->buffer, count)) {
2764                fr->status = F_UNUSED;
2765                mutex_unlock(&cam->fileop_mutex);
2766                return -EFAULT;
2767        }
2768        *f_pos += count;
2769
2770        fr->status = F_UNUSED;
2771
2772        DBG(5, "%zu bytes read", count)
2773
2774        mutex_unlock(&cam->fileop_mutex);
2775        return count;
2776}
2777
2778
2779static int w9968cf_mmap(struct file* filp, struct vm_area_struct *vma)
2780{
2781        struct w9968cf_device* cam = (struct w9968cf_device*)
2782                                     video_get_drvdata(video_devdata(filp));
2783        unsigned long vsize = vma->vm_end - vma->vm_start,
2784                      psize = cam->nbuffers * cam->frame[0].size,
2785                      start = vma->vm_start,
2786                      pos = (unsigned long)cam->frame[0].buffer,
2787                      page;
2788
2789        if (cam->disconnected) {
2790                DBG(2, "Device not present")
2791                return -ENODEV;
2792        }
2793
2794        if (cam->misconfigured) {
2795                DBG(2, "The camera is misconfigured. Close and open it again")
2796                return -EIO;
2797        }
2798
2799        PDBGG("mmapping %lu bytes...", vsize)
2800
2801        if (vsize > psize - (vma->vm_pgoff << PAGE_SHIFT))
2802                return -EINVAL;
2803
2804        while (vsize > 0) {
2805                page = vmalloc_to_pfn((void *)pos);
2806                if (remap_pfn_range(vma, start, page + vma->vm_pgoff,
2807                                                PAGE_SIZE, vma->vm_page_prot))
2808                        return -EAGAIN;
2809                start += PAGE_SIZE;
2810                pos += PAGE_SIZE;
2811                vsize -= PAGE_SIZE;
2812        }
2813
2814        DBG(5, "mmap method successfully called")
2815        return 0;
2816}
2817
2818
2819static long
2820w9968cf_ioctl(struct file *filp,
2821              unsigned int cmd, unsigned long arg)
2822{
2823        struct w9968cf_device* cam;
2824        long err;
2825
2826        cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2827
2828        if (mutex_lock_interruptible(&cam->fileop_mutex))
2829                return -ERESTARTSYS;
2830
2831        if (cam->disconnected) {
2832                DBG(2, "Device not present")
2833                mutex_unlock(&cam->fileop_mutex);
2834                return -ENODEV;
2835        }
2836
2837        if (cam->misconfigured) {
2838                DBG(2, "The camera is misconfigured. Close and open it again.")
2839                mutex_unlock(&cam->fileop_mutex);
2840                return -EIO;
2841        }
2842
2843        err = w9968cf_v4l_ioctl(filp, cmd, (void __user *)arg);
2844
2845        mutex_unlock(&cam->fileop_mutex);
2846        return err;
2847}
2848
2849
2850static long w9968cf_v4l_ioctl(struct file *filp,
2851                             unsigned int cmd, void __user *arg)
2852{
2853        struct w9968cf_device* cam;
2854        const char* v4l1_ioctls[] = {
2855                "?", "CGAP", "GCHAN", "SCHAN", "GTUNER", "STUNER",
2856                "GPICT", "SPICT", "CCAPTURE", "GWIN", "SWIN", "GFBUF",
2857                "SFBUF", "KEY", "GFREQ", "SFREQ", "GAUDIO", "SAUDIO",
2858                "SYNC", "MCAPTURE", "GMBUF", "GUNIT", "GCAPTURE", "SCAPTURE",
2859                "SPLAYMODE", "SWRITEMODE", "GPLAYINFO", "SMICROCODE",
2860                "GVBIFMT", "SVBIFMT"
2861        };
2862
2863        #define V4L1_IOCTL(cmd) \
2864                ((_IOC_NR((cmd)) < ARRAY_SIZE(v4l1_ioctls)) ? \
2865                v4l1_ioctls[_IOC_NR((cmd))] : "?")
2866
2867        cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2868
2869        switch (cmd) {
2870
2871        case VIDIOCGCAP: /* get video capability */
2872        {
2873                struct video_capability cap = {
2874                        .type = VID_TYPE_CAPTURE | VID_TYPE_SCALES,
2875                        .channels = 1,
2876                        .audios = 0,
2877                        .minwidth = cam->minwidth,
2878                        .minheight = cam->minheight,
2879                };
2880                sprintf(cap.name, "W996[87]CF USB Camera");
2881                cap.maxwidth = (cam->upscaling && w9968cf_vpp)
2882                               ? max((u16)W9968CF_MAX_WIDTH, cam->maxwidth)
2883                                 : cam->maxwidth;
2884                cap.maxheight = (cam->upscaling && w9968cf_vpp)
2885                                ? max((u16)W9968CF_MAX_HEIGHT, cam->maxheight)
2886                                  : cam->maxheight;
2887
2888                if (copy_to_user(arg, &cap, sizeof(cap)))
2889                        return -EFAULT;
2890
2891                DBG(5, "VIDIOCGCAP successfully called")
2892                return 0;
2893        }
2894
2895        case VIDIOCGCHAN: /* get video channel informations */
2896        {
2897                struct video_channel chan;
2898                if (copy_from_user(&chan, arg, sizeof(chan)))
2899                        return -EFAULT;
2900
2901                if (chan.channel != 0)
2902                        return -EINVAL;
2903
2904                strcpy(chan.name, "Camera");
2905                chan.tuners = 0;
2906                chan.flags = 0;
2907                chan.type = VIDEO_TYPE_CAMERA;
2908                chan.norm = VIDEO_MODE_AUTO;
2909
2910                if (copy_to_user(arg, &chan, sizeof(chan)))
2911                        return -EFAULT;
2912
2913                DBG(5, "VIDIOCGCHAN successfully called")
2914                return 0;
2915        }
2916
2917        case VIDIOCSCHAN: /* set active channel */
2918        {
2919                struct video_channel chan;
2920
2921                if (copy_from_user(&chan, arg, sizeof(chan)))
2922                        return -EFAULT;
2923
2924                if (chan.channel != 0)
2925                        return -EINVAL;
2926
2927                DBG(5, "VIDIOCSCHAN successfully called")
2928                return 0;
2929        }
2930
2931        case VIDIOCGPICT: /* get image properties of the picture */
2932        {
2933                if (w9968cf_sensor_get_picture(cam))
2934                        return -EIO;
2935
2936                if (copy_to_user(arg, &cam->picture, sizeof(cam->picture)))
2937                        return -EFAULT;
2938
2939                DBG(5, "VIDIOCGPICT successfully called")
2940                return 0;
2941        }
2942
2943        case VIDIOCSPICT: /* change picture settings */
2944        {
2945                struct video_picture pict;
2946                int err = 0;
2947
2948                if (copy_from_user(&pict, arg, sizeof(pict)))
2949                        return -EFAULT;
2950
2951                if ( (cam->force_palette || !w9968cf_vpp)
2952                     && pict.palette != cam->picture.palette ) {
2953                        DBG(4, "Palette %s rejected: only %s is allowed",
2954                            symbolic(v4l1_plist, pict.palette),
2955                            symbolic(v4l1_plist, cam->picture.palette))
2956                        return -EINVAL;
2957                }
2958
2959                if (!w9968cf_valid_palette(pict.palette)) {
2960                        DBG(4, "Palette %s not supported. VIDIOCSPICT failed",
2961                            symbolic(v4l1_plist, pict.palette))
2962                        return -EINVAL;
2963                }
2964
2965                if (!cam->force_palette) {
2966                   if (cam->decompression == 0) {
2967                      if (w9968cf_need_decompression(pict.palette)) {
2968                         DBG(4, "Decompression disabled: palette %s is not "
2969                                "allowed. VIDIOCSPICT failed",
2970                             symbolic(v4l1_plist, pict.palette))
2971                         return -EINVAL;
2972                      }
2973                   } else if (cam->decompression == 1) {
2974                      if (!w9968cf_need_decompression(pict.palette)) {
2975                         DBG(4, "Decompression forced: palette %s is not "
2976                                "allowed. VIDIOCSPICT failed",
2977                             symbolic(v4l1_plist, pict.palette))
2978                         return -EINVAL;
2979                      }
2980                   }
2981                }
2982
2983                if (pict.depth != w9968cf_valid_depth(pict.palette)) {
2984                        DBG(4, "Requested depth %u bpp is not valid for %s "
2985                               "palette: ignored and changed to %u bpp",
2986                            pict.depth, symbolic(v4l1_plist, pict.palette),
2987                            w9968cf_valid_depth(pict.palette))
2988                        pict.depth = w9968cf_valid_depth(pict.palette);
2989                }
2990
2991                if (pict.palette != cam->picture.palette) {
2992                        if(*cam->requested_frame
2993                           || cam->frame_current->queued) {
2994                                err = wait_event_interruptible
2995                                      ( cam->wait_queue,
2996                                        cam->disconnected ||
2997                                        (!*cam->requested_frame &&
2998                                         !cam->frame_current->queued) );
2999                                if (err)
3000                                        return err;
3001                                if (cam->disconnected)
3002                                        return -ENODEV;
3003                        }
3004
3005                        if (w9968cf_stop_transfer(cam))
3006                                goto ioctl_fail;
3007
3008                        if (w9968cf_set_picture(cam, pict))
3009                                goto ioctl_fail;
3010
3011                        if (w9968cf_start_transfer(cam))
3012                                goto ioctl_fail;
3013
3014                } else if (w9968cf_sensor_update_picture(cam, pict))
3015                        return -EIO;
3016
3017
3018                DBG(5, "VIDIOCSPICT successfully called")
3019                return 0;
3020        }
3021
3022        case VIDIOCSWIN: /* set capture area */
3023        {
3024                struct video_window win;
3025                int err = 0;
3026
3027                if (copy_from_user(&win, arg, sizeof(win)))
3028                        return -EFAULT;
3029
3030                DBG(6, "VIDIOCSWIN called: clipcount=%d, flags=%u, "
3031                       "x=%u, y=%u, %ux%u", win.clipcount, win.flags,
3032                    win.x, win.y, win.width, win.height)
3033
3034                if (win.clipcount != 0 || win.flags != 0)
3035                        return -EINVAL;
3036
3037                if ((err = w9968cf_adjust_window_size(cam, &win.width,
3038                                                      &win.height))) {
3039                        DBG(4, "Resolution not supported (%ux%u). "
3040                               "VIDIOCSWIN failed", win.width, win.height)
3041                        return err;
3042                }
3043
3044                if (win.x != cam->window.x ||
3045                    win.y != cam->window.y ||
3046                    win.width != cam->window.width ||
3047                    win.height != cam->window.height) {
3048                        if(*cam->requested_frame
3049                           || cam->frame_current->queued) {
3050                                err = wait_event_interruptible
3051                                      ( cam->wait_queue,
3052                                        cam->disconnected ||
3053                                        (!*cam->requested_frame &&
3054                                         !cam->frame_current->queued) );
3055                                if (err)
3056                                        return err;
3057                                if (cam->disconnected)
3058                                        return -ENODEV;
3059                        }
3060
3061                        if (w9968cf_stop_transfer(cam))
3062                                goto ioctl_fail;
3063
3064                        /* This _must_ be called before set_window() */
3065                        if (w9968cf_set_picture(cam, cam->picture))
3066                                goto ioctl_fail;
3067
3068                        if (w9968cf_set_window(cam, win))
3069                                goto ioctl_fail;
3070
3071                        if (w9968cf_start_transfer(cam))
3072                                goto ioctl_fail;
3073                }
3074
3075                DBG(5, "VIDIOCSWIN successfully called. ")
3076                return 0;
3077        }
3078
3079        case VIDIOCGWIN: /* get current window properties */
3080        {
3081                if (copy_to_user(arg,&cam->window,sizeof(struct video_window)))
3082                        return -EFAULT;
3083
3084                DBG(5, "VIDIOCGWIN successfully called")
3085                return 0;
3086        }
3087
3088        case VIDIOCGMBUF: /* request for memory (mapped) buffer */
3089        {
3090                struct video_mbuf mbuf;
3091                u8 i;
3092
3093                mbuf.size = cam->nbuffers * cam->frame[0].size;
3094                mbuf.frames = cam->nbuffers;
3095                for (i = 0; i < cam->nbuffers; i++)
3096                        mbuf.offsets[i] = (unsigned long)cam->frame[i].buffer -
3097                                          (unsigned long)cam->frame[0].buffer;
3098
3099                if (copy_to_user(arg, &mbuf, sizeof(mbuf)))
3100                        return -EFAULT;
3101
3102                DBG(5, "VIDIOCGMBUF successfully called")
3103                return 0;
3104        }
3105
3106        case VIDIOCMCAPTURE: /* start the capture to a frame */
3107        {
3108                struct video_mmap mmap;
3109                struct w9968cf_frame_t* fr;
3110                u32 w, h;
3111                int err = 0;
3112
3113                if (copy_from_user(&mmap, arg, sizeof(mmap)))
3114                        return -EFAULT;
3115
3116                DBG(6, "VIDIOCMCAPTURE called: frame #%u, format=%s, %dx%d",
3117                    mmap.frame, symbolic(v4l1_plist, mmap.format),
3118                    mmap.width, mmap.height)
3119
3120                if (mmap.frame >= cam->nbuffers) {
3121                        DBG(4, "Invalid frame number (%u). "
3122                               "VIDIOCMCAPTURE failed", mmap.frame)
3123                        return -EINVAL;
3124                }
3125
3126                if (mmap.format!=cam->picture.palette &&
3127                    (cam->force_palette || !w9968cf_vpp)) {
3128                        DBG(4, "Palette %s rejected: only %s is allowed",
3129                            symbolic(v4l1_plist, mmap.format),
3130                            symbolic(v4l1_plist, cam->picture.palette))
3131                        return -EINVAL;
3132                }
3133
3134                if (!w9968cf_valid_palette(mmap.format)) {
3135                        DBG(4, "Palette %s not supported. "
3136                               "VIDIOCMCAPTURE failed",
3137                            symbolic(v4l1_plist, mmap.format))
3138                        return -EINVAL;
3139                }
3140
3141                if (!cam->force_palette) {
3142                   if (cam->decompression == 0) {
3143                      if (w9968cf_need_decompression(mmap.format)) {
3144                         DBG(4, "Decompression disabled: palette %s is not "
3145                                "allowed. VIDIOCSPICT failed",
3146                             symbolic(v4l1_plist, mmap.format))
3147                         return -EINVAL;
3148                      }
3149                   } else if (cam->decompression == 1) {
3150                      if (!w9968cf_need_decompression(mmap.format)) {
3151                         DBG(4, "Decompression forced: palette %s is not "
3152                                "allowed. VIDIOCSPICT failed",
3153                             symbolic(v4l1_plist, mmap.format))
3154                         return -EINVAL;
3155                      }
3156                   }
3157                }
3158
3159                w = mmap.width; h = mmap.height;
3160                err = w9968cf_adjust_window_size(cam, &w, &h);
3161                mmap.width = w; mmap.height = h;
3162                if (err) {
3163                        DBG(4, "Resolution not supported (%dx%d). "
3164                               "VIDIOCMCAPTURE failed",
3165                            mmap.width, mmap.height)
3166                        return err;
3167                }
3168
3169                fr = &cam->frame[mmap.frame];
3170
3171                if (mmap.width  != cam->window.width ||
3172                    mmap.height != cam->window.height ||
3173                    mmap.format != cam->picture.palette) {
3174
3175                        struct video_window win;
3176                        struct video_picture pict;
3177
3178                        if(*cam->requested_frame
3179                           || cam->frame_current->queued) {
3180                                DBG(6, "VIDIOCMCAPTURE. Change settings for "
3181                                       "frame #%u: %dx%d, format %s. Wait...",
3182                                    mmap.frame, mmap.width, mmap.height,
3183                                    symbolic(v4l1_plist, mmap.format))
3184                                err = wait_event_interruptible
3185                                      ( cam->wait_queue,
3186                                        cam->disconnected ||
3187                                        (!*cam->requested_frame &&
3188                                         !cam->frame_current->queued) );
3189                                if (err)
3190                                        return err;
3191                                if (cam->disconnected)
3192                                        return -ENODEV;
3193                        }
3194
3195                        memcpy(&win, &cam->window, sizeof(win));
3196                        memcpy(&pict, &cam->picture, sizeof(pict));
3197                        win.width = mmap.width;
3198                        win.height = mmap.height;
3199                        pict.palette = mmap.format;
3200
3201                        if (w9968cf_stop_transfer(cam))
3202                                goto ioctl_fail;
3203
3204                        /* This before set_window */
3205                        if (w9968cf_set_picture(cam, pict))
3206                                goto ioctl_fail;
3207
3208                        if (w9968cf_set_window(cam, win))
3209                                goto ioctl_fail;
3210
3211                        if (w9968cf_start_transfer(cam))
3212                                goto ioctl_fail;
3213
3214                } else  if (fr->queued) {
3215
3216                        DBG(6, "Wait until frame #%u is free", mmap.frame)
3217
3218                        err = wait_event_interruptible(cam->wait_queue,
3219                                                       cam->disconnected ||
3220                                                       (!fr->queued));
3221                        if (err)
3222                                return err;
3223                        if (cam->disconnected)
3224                                return -ENODEV;
3225                }
3226
3227                w9968cf_push_frame(cam, mmap.frame);
3228                DBG(5, "VIDIOCMCAPTURE(%u): successfully called", mmap.frame)
3229                return 0;
3230        }
3231
3232        case VIDIOCSYNC: /* wait until the capture of a frame is finished */
3233        {
3234                unsigned int f_num;
3235                struct w9968cf_frame_t* fr;
3236                int err = 0;
3237
3238                if (copy_from_user(&f_num, arg, sizeof(f_num)))
3239                        return -EFAULT;
3240
3241                if (f_num >= cam->nbuffers) {
3242                        DBG(4, "Invalid frame number (%u). "
3243                               "VIDIOCMCAPTURE failed", f_num)
3244                        return -EINVAL;
3245                }
3246
3247                DBG(6, "VIDIOCSYNC called for frame #%u", f_num)
3248
3249                fr = &cam->frame[f_num];
3250
3251                switch (fr->status) {
3252                case F_UNUSED:
3253                        if (!fr->queued) {
3254                                DBG(4, "VIDIOSYNC: Frame #%u not requested!",
3255                                    f_num)
3256                                return -EFAULT;
3257                        }
3258                case F_ERROR:
3259                case F_GRABBING:
3260                        err = wait_event_interruptible(cam->wait_queue,
3261                                                       (fr->status == F_READY)
3262                                                       || cam->disconnected);
3263                        if (err)
3264                                return err;
3265                        if (cam->disconnected)
3266                                return -ENODEV;
3267                        break;
3268                case F_READY:
3269                        break;
3270                }
3271
3272                if (w9968cf_vpp)
3273                        w9968cf_postprocess_frame(cam, fr);
3274
3275                fr->status = F_UNUSED;
3276
3277                DBG(5, "VIDIOCSYNC(%u) successfully called", f_num)
3278                return 0;
3279        }
3280
3281        case VIDIOCGUNIT:/* report the unit numbers of the associated devices*/
3282        {
3283                struct video_unit unit = {
3284                        .video = cam->v4ldev->minor,
3285                        .vbi = VIDEO_NO_UNIT,
3286                        .radio = VIDEO_NO_UNIT,
3287                        .audio = VIDEO_NO_UNIT,
3288                        .teletext = VIDEO_NO_UNIT,
3289                };
3290
3291                if (copy_to_user(arg, &unit, sizeof(unit)))
3292                        return -EFAULT;
3293
3294                DBG(5, "VIDIOCGUNIT successfully called")
3295                return 0;
3296        }
3297
3298        case VIDIOCKEY:
3299                return 0;
3300
3301        case VIDIOCGFBUF:
3302        {
3303                if (clear_user(arg, sizeof(struct video_buffer)))
3304                        return -EFAULT;
3305
3306                DBG(5, "VIDIOCGFBUF successfully called")
3307                return 0;
3308        }
3309
3310        case VIDIOCGTUNER:
3311        {
3312                struct video_tuner tuner;
3313                if (copy_from_user(&tuner, arg, sizeof(tuner)))
3314                        return -EFAULT;
3315
3316                if (tuner.tuner != 0)
3317                        return -EINVAL;
3318
3319                strcpy(tuner.name, "no_tuner");
3320                tuner.rangelow = 0;
3321                tuner.rangehigh = 0;
3322                tuner.flags = VIDEO_TUNER_NORM;
3323                tuner.mode = VIDEO_MODE_AUTO;
3324                tuner.signal = 0xffff;
3325
3326                if (copy_to_user(arg, &tuner, sizeof(tuner)))
3327                        return -EFAULT;
3328
3329                DBG(5, "VIDIOCGTUNER successfully called")
3330                return 0;
3331        }
3332
3333        case VIDIOCSTUNER:
3334        {
3335                struct video_tuner tuner;
3336                if (copy_from_user(&tuner, arg, sizeof(tuner)))
3337                        return -EFAULT;
3338
3339                if (tuner.tuner != 0)
3340                        return -EINVAL;
3341
3342                if (tuner.mode != VIDEO_MODE_AUTO)
3343                        return -EINVAL;
3344
3345                DBG(5, "VIDIOCSTUNER successfully called")
3346                return 0;
3347        }
3348
3349        case VIDIOCSFBUF:
3350        case VIDIOCCAPTURE:
3351        case VIDIOCGFREQ:
3352        case VIDIOCSFREQ:
3353        case VIDIOCGAUDIO:
3354        case VIDIOCSAUDIO:
3355        case VIDIOCSPLAYMODE:
3356        case VIDIOCSWRITEMODE:
3357        case VIDIOCGPLAYINFO:
3358        case VIDIOCSMICROCODE:
3359        case VIDIOCGVBIFMT:
3360        case VIDIOCSVBIFMT:
3361                DBG(4, "Unsupported V4L1 IOCtl: VIDIOC%s "
3362                       "(type 0x%01X, "
3363                       "n. 0x%01X, "
3364                       "dir. 0x%01X, "
3365                       "size 0x%02X)",
3366                    V4L1_IOCTL(cmd),
3367                    _IOC_TYPE(cmd),_IOC_NR(cmd),_IOC_DIR(cmd),_IOC_SIZE(cmd))
3368
3369                return -EINVAL;
3370
3371        default:
3372                DBG(4, "Invalid V4L1 IOCtl: VIDIOC%s "
3373                       "type 0x%01X, "
3374                       "n. 0x%01X, "
3375                       "dir. 0x%01X, "
3376                       "size 0x%02X",
3377                    V4L1_IOCTL(cmd),
3378                    _IOC_TYPE(cmd),_IOC_NR(cmd),_IOC_DIR(cmd),_IOC_SIZE(cmd))
3379
3380                return -ENOIOCTLCMD;
3381
3382        } /* end of switch */
3383
3384ioctl_fail:
3385        cam->misconfigured = 1;
3386        DBG(1, "VIDIOC%s failed because of hardware problems. "
3387               "To use the camera, close and open it again.", V4L1_IOCTL(cmd))
3388        return -EFAULT;
3389}
3390
3391
3392static const struct v4l2_file_operations w9968cf_fops = {
3393        .owner =   THIS_MODULE,
3394        .open =    w9968cf_open,
3395        .release = w9968cf_release,
3396        .read =    w9968cf_read,
3397        .ioctl =   w9968cf_ioctl,
3398        .mmap =    w9968cf_mmap,
3399};
3400
3401
3402
3403/****************************************************************************
3404 * USB probe and V4L registration, disconnect and id_table[] definition     *
3405 ****************************************************************************/
3406
3407static int
3408w9968cf_usb_probe(struct usb_interface* intf, const struct usb_device_id* id)
3409{
3410        struct usb_device *udev = interface_to_usbdev(intf);
3411        struct w9968cf_device* cam;
3412        int err = 0;
3413        enum w9968cf_model_id mod_id;
3414        struct list_head* ptr;
3415        u8 sc = 0; /* number of simultaneous cameras */
3416        static unsigned short dev_nr; /* 0 - we are handling device number n */
3417        static unsigned short addrs[] = {
3418                OV7xx0_SID,
3419                OV6xx0_SID,
3420                I2C_CLIENT_END
3421        };
3422
3423        if (le16_to_cpu(udev->descriptor.idVendor)  == winbond_id_table[0].idVendor &&
3424            le16_to_cpu(udev->descriptor.idProduct) == winbond_id_table[0].idProduct)
3425                mod_id = W9968CF_MOD_CLVBWGP; /* see camlist[] table */
3426        else if (le16_to_cpu(udev->descriptor.idVendor)  == winbond_id_table[1].idVendor &&
3427                 le16_to_cpu(udev->descriptor.idProduct) == winbond_id_table[1].idProduct)
3428                mod_id = W9968CF_MOD_GENERIC; /* see camlist[] table */
3429        else
3430                return -ENODEV;
3431
3432        cam = (struct w9968cf_device*)
3433                  kzalloc(sizeof(struct w9968cf_device), GFP_KERNEL);
3434        if (!cam)
3435                return -ENOMEM;
3436
3437        err = v4l2_device_register(&intf->dev, &cam->v4l2_dev);
3438        if (err)
3439                goto fail0;
3440
3441        mutex_init(&cam->dev_mutex);
3442        mutex_lock(&cam->dev_mutex);
3443
3444        cam->usbdev = udev;
3445
3446        DBG(2, "%s detected", symbolic(camlist, mod_id))
3447
3448        if (simcams > W9968CF_MAX_DEVICES)
3449                simcams = W9968CF_SIMCAMS;
3450
3451        /* How many cameras are connected ? */
3452        mutex_lock(&w9968cf_devlist_mutex);
3453        list_for_each(ptr, &w9968cf_dev_list)
3454                sc++;
3455        mutex_unlock(&w9968cf_devlist_mutex);
3456
3457        if (sc >= simcams) {
3458                DBG(2, "Device rejected: too many connected cameras "
3459                       "(max. %u)", simcams)
3460                err = -EPERM;
3461                goto fail;
3462        }
3463
3464
3465        /* Allocate 2 bytes of memory for camera control USB transfers */
3466        if (!(cam->control_buffer = kzalloc(2, GFP_KERNEL))) {
3467                DBG(1,"Couldn't allocate memory for camera control transfers")
3468                err = -ENOMEM;
3469                goto fail;
3470        }
3471
3472        /* Allocate 8 bytes of memory for USB data transfers to the FSB */
3473        if (!(cam->data_buffer = kzalloc(8, GFP_KERNEL))) {
3474                DBG(1, "Couldn't allocate memory for data "
3475                       "transfers to the FSB")
3476                err = -ENOMEM;
3477                goto fail;
3478        }
3479
3480        /* Register the V4L device */
3481        cam->v4ldev = video_device_alloc();
3482        if (!cam->v4ldev) {
3483                DBG(1, "Could not allocate memory for a V4L structure")
3484                err = -ENOMEM;
3485                goto fail;
3486        }
3487
3488        strcpy(cam->v4ldev->name, symbolic(camlist, mod_id));
3489        cam->v4ldev->fops = &w9968cf_fops;
3490        cam->v4ldev->release = video_device_release;
3491        video_set_drvdata(cam->v4ldev, cam);
3492        cam->v4ldev->v4l2_dev = &cam->v4l2_dev;
3493
3494        err = video_register_device(cam->v4ldev, VFL_TYPE_GRABBER,
3495                                    video_nr[dev_nr]);
3496        if (err) {
3497                DBG(1, "V4L device registration failed")
3498                if (err == -ENFILE && video_nr[dev_nr] == -1)
3499                        DBG(2, "Couldn't find a free /dev/videoX node")
3500                video_nr[dev_nr] = -1;
3501                dev_nr = (dev_nr < W9968CF_MAX_DEVICES-1) ? dev_nr+1 : 0;
3502                goto fail;
3503        }
3504
3505        DBG(2, "V4L device registered as %s",
3506            video_device_node_name(cam->v4ldev))
3507
3508        /* Set some basic constants */
3509        w9968cf_configure_camera(cam, udev, mod_id, dev_nr);
3510
3511        /* Add a new entry into the list of V4L registered devices */
3512        mutex_lock(&w9968cf_devlist_mutex);
3513        list_add(&cam->v4llist, &w9968cf_dev_list);
3514        mutex_unlock(&w9968cf_devlist_mutex);
3515        dev_nr = (dev_nr < W9968CF_MAX_DEVICES-1) ? dev_nr+1 : 0;
3516
3517        w9968cf_turn_on_led(cam);
3518
3519        w9968cf_i2c_init(cam);
3520        cam->sensor_sd = v4l2_i2c_new_subdev(&cam->v4l2_dev,
3521                        &cam->i2c_adapter,
3522                        "ovcamchip", "ovcamchip", 0, addrs);
3523
3524        usb_set_intfdata(intf, cam);
3525        mutex_unlock(&cam->dev_mutex);
3526
3527        err = w9968cf_sensor_init(cam);
3528        return 0;
3529
3530fail: /* Free unused memory */
3531        kfree(cam->control_buffer);
3532        kfree(cam->data_buffer);
3533        if (cam->v4ldev)
3534                video_device_release(cam->v4ldev);
3535        mutex_unlock(&cam->dev_mutex);
3536        v4l2_device_unregister(&cam->v4l2_dev);
3537fail0:
3538        kfree(cam);
3539        return err;
3540}
3541
3542
3543static void w9968cf_usb_disconnect(struct usb_interface* intf)
3544{
3545        struct w9968cf_device* cam =
3546           (struct w9968cf_device*)usb_get_intfdata(intf);
3547
3548        if (cam) {
3549                down_write(&w9968cf_disconnect);
3550                /* Prevent concurrent accesses to data */
3551                mutex_lock(&cam->dev_mutex);
3552
3553                cam->disconnected = 1;
3554
3555                DBG(2, "Disconnecting %s...", symbolic(camlist, cam->id));
3556
3557                v4l2_device_disconnect(&cam->v4l2_dev);
3558
3559                wake_up_interruptible_all(&cam->open);
3560
3561                if (cam->users) {
3562                        DBG(2, "The device is open (%s)! "
3563                               "Process name: %s. Deregistration and memory "
3564                               "deallocation are deferred on close.",
3565                            video_device_node_name(cam->v4ldev), cam->command)
3566                        cam->misconfigured = 1;
3567                        w9968cf_stop_transfer(cam);
3568                        wake_up_interruptible(&cam->wait_queue);
3569                } else
3570                        w9968cf_release_resources(cam);
3571
3572                mutex_unlock(&cam->dev_mutex);
3573                up_write(&w9968cf_disconnect);
3574
3575                if (!cam->users) {
3576                        kfree(cam);
3577                }
3578        }
3579}
3580
3581
3582static struct usb_driver w9968cf_usb_driver = {
3583        .name =       "w9968cf",
3584        .id_table =   winbond_id_table,
3585        .probe =      w9968cf_usb_probe,
3586        .disconnect = w9968cf_usb_disconnect,
3587};
3588
3589
3590
3591/****************************************************************************
3592 * Module init, exit and intermodule communication                          *
3593 ****************************************************************************/
3594
3595static int __init w9968cf_module_init(void)
3596{
3597        int err;
3598
3599        KDBG(2, W9968CF_MODULE_NAME" "W9968CF_MODULE_VERSION)
3600        KDBG(3, W9968CF_MODULE_AUTHOR)
3601
3602        if ((err = usb_register(&w9968cf_usb_driver)))
3603                return err;
3604
3605        return 0;
3606}
3607
3608
3609static void __exit w9968cf_module_exit(void)
3610{
3611        /* w9968cf_usb_disconnect() will be called */
3612        usb_deregister(&w9968cf_usb_driver);
3613
3614        KDBG(2, W9968CF_MODULE_NAME" deregistered")
3615}
3616
3617
3618module_init(w9968cf_module_init);
3619module_exit(w9968cf_module_exit);
3620
3621