projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB (12294): b2c2: Use dvb-pll for Cablestar2
[deliverable/linux.git] / drivers / media / video / w9968cf.c
CommitLineData
1da177e4
LT		 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
1da177e4
LT		 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>
7e0a16f6 45#include <linux/videodev.h>
2864462e 46#include <media/v4l2-ioctl.h>
1da177e4
LT		 47
48#include "w9968cf.h"
49#include "w9968cf_decoder.h"
50
4186ecf8
AV		 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() */
1da177e4
LT		 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
1da177e4
LT		 72static unsigned short simcams = W9968CF_SIMCAMS;
73static short video_nr[]={[0 ... W9968CF_MAX_DEVICES-1] = -1}; /*-1=first free*/
d56410e0
MCC		 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};
1da177e4 80static int clamping[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_CLAMPING};
d56410e0
MCC		 81static unsigned short filter_type[]= {[0 ... W9968CF_MAX_DEVICES-1] =
82 W9968CF_FILTER_TYPE};
1da177e4 83static int largeview[]= {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_LARGEVIEW};
d56410e0
MCC		 84static unsigned short decompression[] = {[0 ... W9968CF_MAX_DEVICES-1] =
85 W9968CF_DECOMPRESSION};
1da177e4
LT		 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};
d56410e0
MCC		 91static unsigned short lightfreq[] = {[0 ... W9968CF_MAX_DEVICES-1] =
92 W9968CF_LIGHTFREQ};
1da177e4 93static int bandingfilter[] = {[0 ... W9968CF_MAX_DEVICES-1]=
d56410e0 94 W9968CF_BANDINGFILTER};
1da177e4
LT		 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};
d56410e0
MCC		 99static unsigned int brightness[] = {[0 ... W9968CF_MAX_DEVICES-1] =
100 W9968CF_BRIGHTNESS};
1da177e4
LT		 101static unsigned int hue[] = {[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_HUE};
102static unsigned int colour[]={[0 ... W9968CF_MAX_DEVICES-1] = W9968CF_COLOUR};
d56410e0
MCC		 103static unsigned int contrast[] = {[0 ... W9968CF_MAX_DEVICES-1] =
104 W9968CF_CONTRAST};
105static unsigned int whiteness[] = {[0 ... W9968CF_MAX_DEVICES-1] =
106 W9968CF_WHITENESS};
1da177e4
LT		 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
1da177e4
LT		 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
d56410e0
MCC		 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");
1da177e4 150MODULE_PARM_DESC(video_nr,
d56410e0
MCC		 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");
1da177e4 161MODULE_PARM_DESC(packet_size,
d56410e0
MCC		 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");
1da177e4 167MODULE_PARM_DESC(max_buffers,
d56410e0
MCC		 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");
1da177e4 213MODULE_PARM_DESC(decompression,
d56410e0
MCC		 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");
1da177e4 229MODULE_PARM_DESC(force_palette,
d56410e0
MCC		 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");
1da177e4 272MODULE_PARM_DESC(autobright,
d56410e0
MCC		 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");
1da177e4 278MODULE_PARM_DESC(autoexp,
d56410e0
MCC		 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");
1da177e4 284MODULE_PARM_DESC(lightfreq,
d56410e0
MCC		 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");
1da177e4 291MODULE_PARM_DESC(bandingfilter,
d56410e0
MCC		 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");
1da177e4 301MODULE_PARM_DESC(clockdiv,
d56410e0
MCC		 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");
1da177e4 310MODULE_PARM_DESC(backlight,
d56410e0
MCC		 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");
1da177e4 316MODULE_PARM_DESC(mirror,
d56410e0
MCC		 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");
1da177e4 322MODULE_PARM_DESC(monochrome,
d56410e0
MCC		 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");
1da177e4
LT		 355#ifdef W9968CF_DEBUG
356MODULE_PARM_DESC(debug,
d56410e0
MCC		 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");
1da177e4 369MODULE_PARM_DESC(specific_debug,
d56410e0
MCC		 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");
1da177e4
LT		 378#endif /* W9968CF_DEBUG */
379
380
381
382/****************************************************************************
383 * Some prototypes *
384 ****************************************************************************/
385
386/* Video4linux interface */
bec43661
HV		 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 *);
069b7479 391static long w9968cf_ioctl(struct file *, unsigned, unsigned long);
bec43661 392static ssize_t w9968cf_read(struct file *, char __user *, size_t, loff_t *);
069b7479 393static long w9968cf_v4l_ioctl(struct file *, unsigned int,
d56410e0 394 void __user *);
1da177e4
LT		 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*);
7d12e780 405static void w9968cf_urb_complete(struct urb *urb);
1da177e4
LT		 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,
d56410e0
MCC		 416 u16 address, u8* value);
417static int w9968cf_i2c_adap_read_byte_data(struct w9968cf_device*, u16 address,
418 u8 subaddress, u8* value);
1da177e4 419static int w9968cf_i2c_adap_write_byte(struct w9968cf_device*,
d56410e0 420 u16 address, u8 subaddress);
1da177e4 421static int w9968cf_i2c_adap_fastwrite_byte_data(struct w9968cf_device*,
d56410e0
MCC		 422 u16 address, u8 subaddress,
423 u8 value);
1da177e4
LT		 424
425/* I2C interface to kernel */
426static int w9968cf_i2c_init(struct w9968cf_device*);
d56410e0
MCC		 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*);
1da177e4 430static u32 w9968cf_i2c_func(struct i2c_adapter*);
1da177e4
LT		 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*,
d56410e0 442 unsigned int cmd, void *arg);
1da177e4
LT		 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*);
d56410e0
MCC		 446static int w9968cf_sensor_update_picture(struct w9968cf_device*,
447 struct video_picture pict);
1da177e4
LT		 448
449/* Other helper functions */
450static void w9968cf_configure_camera(struct w9968cf_device*,struct usb_device*,
d56410e0
MCC		 451 enum w9968cf_model_id,
452 const unsigned short dev_nr);
1da177e4
LT		 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);
d56410e0
MCC		 461static int w9968cf_postprocess_frame(struct w9968cf_device*,
462 struct w9968cf_frame_t*);
1c657a99 463static int w9968cf_adjust_window_size(struct w9968cf_device*, u32 *w, u32 *h);
1da177e4
LT		 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
1da177e4
LT		 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
d56410e0 481/*--------------------------------------------------------------------------
1da177e4
LT		 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 --------------------------------------------------------------------------*/
d56410e0 485static inline const char *
1da177e4
LT		 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" },
d56410e0 552 { W9968CF_DEC_ERR_NO_SOI, "SOI marker not found" },
1da177e4
LT		 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)"},
38e2bfc9 570 { -EOVERFLOW, "Babble (too much data)" },
1da177e4
LT		 571 { -EPROTO, "Bit-stuff error (bad cable?)" },
572 { -EILSEQ, "CRC/Timeout" },
38e2bfc9
PZ		 573 { -ETIME, "Device does not respond to token" },
574 { -ETIMEDOUT, "Device does not respond to command" },
1da177e4
LT		 575 { -1, NULL }
576};
577
1da177e4
LT		 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,
d56410e0 678 cam->maxwidth*cam->maxheight*bpp);
1da177e4
LT		 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] =
b10b4177 685 kzalloc(W9968CF_ISO_PACKETS*p_size, GFP_KERNEL))) {
1da177e4 686 DBG(1, "Couldn't allocate memory for the isochronous "
d56410e0 687 "transfer buffers (%u bytes)",
1da177e4
LT		 688 p_size * W9968CF_ISO_PACKETS)
689 return -ENOMEM;
690 }
1da177e4
LT		 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
d56410e0 763 a temporary buffer.
1da177e4 764 --------------------------------------------------------------------------*/
7d12e780 765static void w9968cf_urb_complete(struct urb *urb)
1da177e4
LT		 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
d56410e0 782 /* If a frame has been requested and we are grabbing into
1da177e4
LT		 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);
d56410e0 791 DBG(6, "Switched from temp. frame to frame #%d",
1da177e4
LT		 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,
d56410e0 833 (*f)->length);
1da177e4
LT		 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);
1da177e4
LT		 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
ff41efcf 904 cam->urb[i] = urb;
1da177e4
LT		 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))
d56410e0 958 DBG(5, "Isochronous transfer size: %lu bytes/frame",
1da177e4
LT		 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 "
d56410e0 975 "USB core (error #%d, %s)", err,
1da177e4
LT		 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
d56410e0 999 /* This avoids race conditions with usb_submit_urb()
1da177e4
LT		 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/*--------------------------------------------------------------------------
d56410e0 1033 Write a W9968CF register.
1da177e4
LT		 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,
d56410e0
MCC		 1042 USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE,
1043 value, index, NULL, 0, W9968CF_USB_CTRL_TIMEOUT);
1da177e4
LT		 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/*--------------------------------------------------------------------------
d56410e0 1055 Read a W9968CF register.
1da177e4
LT		 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,
d56410e0
MCC		 1065 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
1066 0, index, buff, 2, W9968CF_USB_CTRL_TIMEOUT);
1da177e4
LT		 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,
d56410e0
MCC		 1090 USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_DEVICE,
1091 value, 0x06, data, 6, W9968CF_USB_CTRL_TIMEOUT);
1da177e4
LT		 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 */
d56410e0
MCC		 1270static int
1271w9968cf_i2c_adap_fastwrite_byte_data(struct w9968cf_device* cam,
1272 u16 address, u8 subaddress,u8 value)
1da177e4
LT		 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, "
d56410e0 1331 "subaddr.0x%02X, value 0x%02X",
1da177e4
LT		 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 */
d56410e0
MCC		 1339static int
1340w9968cf_i2c_adap_read_byte_data(struct w9968cf_device* cam,
1341 u16 address, u8 subaddress,
1342 u8* value)
1da177e4
LT		 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, "
d56410e0 1367 "subaddr.0x%02X, value 0x%02X",
1da177e4
LT		 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 */
d56410e0 1379static int
1da177e4 1380w9968cf_i2c_adap_read_byte(struct w9968cf_device* cam,
d56410e0 1381 u16 address, u8* value)
1da177e4
LT		 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);
d56410e0 1394
1da177e4
LT		 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 */
d56410e0 1410static int
1da177e4 1411w9968cf_i2c_adap_write_byte(struct w9968cf_device* cam,
d56410e0 1412 u16 address, u8 value)
1da177e4
LT		 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
d56410e0
MCC		 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)
1da177e4 1428{
3160fbc5
HV		 1429 struct v4l2_device *v4l2_dev = i2c_get_adapdata(adapter);
1430 struct w9968cf_device *cam = to_cam(v4l2_dev);
1da177e4 1431 u8 i;
d56410e0 1432 int err = 0;
1da177e4 1433
1da177e4
LT		 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)
d56410e0
MCC		 1439 err = w9968cf_i2c_adap_write_byte(cam, addr, command);
1440 else if (read_write == I2C_SMBUS_READ)
3160fbc5
HV		 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 }
1da177e4
LT		 1452 } else if (size == I2C_SMBUS_BYTE_DATA) {
1453 addr <<= 1;
1454
1455 if (read_write == I2C_SMBUS_WRITE)
d56410e0
MCC		 1456 err = w9968cf_i2c_adap_fastwrite_byte_data(cam, addr,
1457 command, data->byte);
1da177e4
LT		 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,
d56410e0 1461 command, &data->byte);
1da177e4
LT		 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 }
1da177e4
LT		 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
1da177e4
LT		 1490static int w9968cf_i2c_init(struct w9968cf_device* cam)
1491{
1492 int err = 0;
1493
1494 static struct i2c_algorithm algo = {
1da177e4 1495 .smbus_xfer = w9968cf_i2c_smbus_xfer,
1da177e4
LT		 1496 .functionality = w9968cf_i2c_func,
1497 };
1498
1499 static struct i2c_adapter adap = {
c7a46533 1500 .id = I2C_HW_SMBUS_W9968CF,
1da177e4 1501 .owner = THIS_MODULE,
1da177e4
LT		 1502 .algo = &algo,
1503 };
1504
1505 memcpy(&cam->i2c_adapter, &adap, sizeof(struct i2c_adapter));
1506 strcpy(cam->i2c_adapter.name, "w9968cf");
12a917f6 1507 cam->i2c_adapter.dev.parent = &cam->usbdev->dev;
3160fbc5 1508 i2c_set_adapdata(&cam->i2c_adapter, &cam->v4l2_dev);
1da177e4
LT		 1509
1510 DBG(6, "Registering I2C adapter with kernel...")
1511
1512 err = i2c_add_adapter(&cam->i2c_adapter);
1513 if (err)
1514 DBG(1, "Failed to register the I2C adapter")
1515 else
1516 DBG(5, "I2C adapter registered")
1517
1518 return err;
1519}
1520
1521
1522
1523/****************************************************************************
1524 * Helper functions *
1525 ****************************************************************************/
1526
1527/*--------------------------------------------------------------------------
1528 Turn on the LED on some webcams. A beep should be heard too.
1529 Return 0 on success, a negative number otherwise.
1530 --------------------------------------------------------------------------*/
1531static int w9968cf_turn_on_led(struct w9968cf_device* cam)
1532{
1533 int err = 0;
1534
1535 err += w9968cf_write_reg(cam, 0xff00, 0x00); /* power-down */
1536 err += w9968cf_write_reg(cam, 0xbf17, 0x00); /* reset everything */
1537 err += w9968cf_write_reg(cam, 0xbf10, 0x00); /* normal operation */
1538 err += w9968cf_write_reg(cam, 0x0010, 0x01); /* serial bus, SDS high */
1539 err += w9968cf_write_reg(cam, 0x0000, 0x01); /* serial bus, SDS low */
1540 err += w9968cf_write_reg(cam, 0x0010, 0x01); /* ..high 'beep-beep' */
1541
1542 if (err)
1543 DBG(2, "Couldn't turn on the LED")
1544
1545 DBG(5, "LED turned on")
1546
1547 return err;
1548}
1549
1550
1551/*--------------------------------------------------------------------------
1552 Write some registers for the device initialization.
1553 This function is called once on open().
1554 Return 0 on success, a negative number otherwise.
1555 --------------------------------------------------------------------------*/
1556static int w9968cf_init_chip(struct w9968cf_device* cam)
1557{
1558 unsigned long hw_bufsize = cam->maxwidth*cam->maxheight*2,
d56410e0
MCC		 1559 y0 = 0x0000,
1560 u0 = y0 + hw_bufsize/2,
1561 v0 = u0 + hw_bufsize/4,
1562 y1 = v0 + hw_bufsize/4,
1563 u1 = y1 + hw_bufsize/2,
1564 v1 = u1 + hw_bufsize/4;
1da177e4
LT		 1565 int err = 0;
1566
1567 err += w9968cf_write_reg(cam, 0xff00, 0x00); /* power off */
1568 err += w9968cf_write_reg(cam, 0xbf10, 0x00); /* power on */
1569
1570 err += w9968cf_write_reg(cam, 0x405d, 0x03); /* DRAM timings */
1571 err += w9968cf_write_reg(cam, 0x0030, 0x04); /* SDRAM timings */
1572
1573 err += w9968cf_write_reg(cam, y0 & 0xffff, 0x20); /* Y buf.0, low */
1574 err += w9968cf_write_reg(cam, y0 >> 16, 0x21); /* Y buf.0, high */
1575 err += w9968cf_write_reg(cam, u0 & 0xffff, 0x24); /* U buf.0, low */
1576 err += w9968cf_write_reg(cam, u0 >> 16, 0x25); /* U buf.0, high */
1577 err += w9968cf_write_reg(cam, v0 & 0xffff, 0x28); /* V buf.0, low */
1578 err += w9968cf_write_reg(cam, v0 >> 16, 0x29); /* V buf.0, high */
1579
1580 err += w9968cf_write_reg(cam, y1 & 0xffff, 0x22); /* Y buf.1, low */
1581 err += w9968cf_write_reg(cam, y1 >> 16, 0x23); /* Y buf.1, high */
1582 err += w9968cf_write_reg(cam, u1 & 0xffff, 0x26); /* U buf.1, low */
1583 err += w9968cf_write_reg(cam, u1 >> 16, 0x27); /* U buf.1, high */
1584 err += w9968cf_write_reg(cam, v1 & 0xffff, 0x2a); /* V buf.1, low */
1585 err += w9968cf_write_reg(cam, v1 >> 16, 0x2b); /* V buf.1, high */
1586
1587 err += w9968cf_write_reg(cam, y1 & 0xffff, 0x32); /* JPEG buf 0 low */
1588 err += w9968cf_write_reg(cam, y1 >> 16, 0x33); /* JPEG buf 0 high */
1589
1590 err += w9968cf_write_reg(cam, y1 & 0xffff, 0x34); /* JPEG buf 1 low */
1591 err += w9968cf_write_reg(cam, y1 >> 16, 0x35); /* JPEG bug 1 high */
1592
1593 err += w9968cf_write_reg(cam, 0x0000, 0x36);/* JPEG restart interval */
1594 err += w9968cf_write_reg(cam, 0x0804, 0x37);/*JPEG VLE FIFO threshold*/
1595 err += w9968cf_write_reg(cam, 0x0000, 0x38);/* disable hw up-scaling */
1596 err += w9968cf_write_reg(cam, 0x0000, 0x3f); /* JPEG/MCTL test data */
1597
1598 err += w9968cf_set_picture(cam, cam->picture); /* this before */
1599 err += w9968cf_set_window(cam, cam->window);
1600
1601 if (err)
1602 DBG(1, "Chip initialization failed")
1603 else
1604 DBG(5, "Chip successfully initialized")
1605
1606 return err;
1607}
1608
1609
1610/*--------------------------------------------------------------------------
1611 Return non-zero if the palette is supported, 0 otherwise.
1612 --------------------------------------------------------------------------*/
1613static inline u16 w9968cf_valid_palette(u16 palette)
1614{
1615 u8 i = 0;
1616 while (w9968cf_formatlist[i].palette != 0) {
1617 if (palette == w9968cf_formatlist[i].palette)
1618 return palette;
1619 i++;
1620 }
1621 return 0;
1622}
1623
1624
1625/*--------------------------------------------------------------------------
1626 Return the depth corresponding to the given palette.
1627 Palette _must_ be supported !
1628 --------------------------------------------------------------------------*/
1629static inline u16 w9968cf_valid_depth(u16 palette)
1630{
1631 u8 i=0;
1632 while (w9968cf_formatlist[i].palette != palette)
1633 i++;
1634
1635 return w9968cf_formatlist[i].depth;
1636}
1637
1638
1639/*--------------------------------------------------------------------------
1640 Return non-zero if the format requires decompression, 0 otherwise.
1641 --------------------------------------------------------------------------*/
1642static inline u8 w9968cf_need_decompression(u16 palette)
1643{
1644 u8 i = 0;
1645 while (w9968cf_formatlist[i].palette != 0) {
1646 if (palette == w9968cf_formatlist[i].palette)
1647 return w9968cf_formatlist[i].compression;
1648 i++;
1649 }
1650 return 0;
1651}
1652
1653
1654/*--------------------------------------------------------------------------
1655 Change the picture settings of the camera.
1656 Return 0 on success, a negative number otherwise.
1657 --------------------------------------------------------------------------*/
1658static int
1659w9968cf_set_picture(struct w9968cf_device* cam, struct video_picture pict)
1660{
1661 u16 fmt, hw_depth, hw_palette, reg_v = 0x0000;
1662 int err = 0;
1663
1664 /* Make sure we are using a valid depth */
1665 pict.depth = w9968cf_valid_depth(pict.palette);
1666
1667 fmt = pict.palette;
1668
1669 hw_depth = pict.depth; /* depth used by the winbond chip */
1670 hw_palette = pict.palette; /* palette used by the winbond chip */
1671
1672 /* VS & HS polarities */
1673 reg_v = (cam->vs_polarity << 12) | (cam->hs_polarity << 11);
1674
1675 switch (fmt)
1676 {
1677 case VIDEO_PALETTE_UYVY:
1678 reg_v |= 0x0000;
1679 cam->vpp_flag = VPP_NONE;
1680 break;
1681 case VIDEO_PALETTE_YUV422P:
1682 reg_v |= 0x0002;
1683 cam->vpp_flag = VPP_DECOMPRESSION;
1684 break;
1685 case VIDEO_PALETTE_YUV420:
1686 case VIDEO_PALETTE_YUV420P:
1687 reg_v |= 0x0003;
1688 cam->vpp_flag = VPP_DECOMPRESSION;
1689 break;
1690 case VIDEO_PALETTE_YUYV:
1691 case VIDEO_PALETTE_YUV422:
1692 reg_v |= 0x0000;
1693 cam->vpp_flag = VPP_SWAP_YUV_BYTES;
1694 hw_palette = VIDEO_PALETTE_UYVY;
1695 break;
d56410e0 1696 /* Original video is used instead of RGBX palettes.
1da177e4
LT		 1697 Software conversion later. */
1698 case VIDEO_PALETTE_GREY:
1699 case VIDEO_PALETTE_RGB555:
1700 case VIDEO_PALETTE_RGB565:
1701 case VIDEO_PALETTE_RGB24:
1702 case VIDEO_PALETTE_RGB32:
1703 reg_v |= 0x0000; /* UYVY 16 bit is used */
1704 hw_depth = 16;
1705 hw_palette = VIDEO_PALETTE_UYVY;
1706 cam->vpp_flag = VPP_UYVY_TO_RGBX;
1707 break;
1708 }
1709
1710 /* NOTE: due to memory issues, it is better to disable the hardware
d56410e0 1711 double buffering during compression */
1da177e4
LT		 1712 if (cam->double_buffer && !(cam->vpp_flag & VPP_DECOMPRESSION))
1713 reg_v |= 0x0080;
1714
1715 if (cam->clamping)
1716 reg_v |= 0x0020;
1717
1718 if (cam->filter_type == 1)
1719 reg_v |= 0x0008;
1720 else if (cam->filter_type == 2)
1721 reg_v |= 0x000c;
1722
1723 if ((err = w9968cf_write_reg(cam, reg_v, 0x16)))
1724 goto error;
1725
1726 if ((err = w9968cf_sensor_update_picture(cam, pict)))
1727 goto error;
1728
1729 /* If all went well, update the device data structure */
1730 memcpy(&cam->picture, &pict, sizeof(pict));
1731 cam->hw_depth = hw_depth;
1732 cam->hw_palette = hw_palette;
1733
1734 /* Settings changed, so we clear the frame buffers */
1735 memset(cam->frame[0].buffer, 0, cam->nbuffers*cam->frame[0].size);
1736
1737 DBG(4, "Palette is %s, depth is %u bpp",
1738 symbolic(v4l1_plist, pict.palette), pict.depth)
1739
1740 return 0;
1741
1742error:
1743 DBG(1, "Failed to change picture settings")
1744 return err;
1745}
1746
1747
1748/*--------------------------------------------------------------------------
1749 Change the capture area size of the camera.
1750 This function _must_ be called _after_ w9968cf_set_picture().
1751 Return 0 on success, a negative number otherwise.
1752 --------------------------------------------------------------------------*/
1753static int
1754w9968cf_set_window(struct w9968cf_device* cam, struct video_window win)
1755{
1756 u16 x, y, w, h, scx, scy, cw, ch, ax, ay;
1757 unsigned long fw, fh;
1758 struct ovcamchip_window s_win;
1759 int err = 0;
1760
1761 /* Work around to avoid FP arithmetics */
bee8a44e
RB		 1762 #define SC(x) ((x) << 10)
1763 #define UNSC(x) ((x) >> 10)
1da177e4
LT		 1764
1765 /* Make sure we are using a supported resolution */
1c657a99 1766 if ((err = w9968cf_adjust_window_size(cam, &win.width, &win.height)))
1da177e4
LT		 1767 goto error;
1768
1769 /* Scaling factors */
bee8a44e
RB		 1770 fw = SC(win.width) / cam->maxwidth;
1771 fh = SC(win.height) / cam->maxheight;
1da177e4
LT		 1772
1773 /* Set up the width and height values used by the chip */
1774 if ((win.width > cam->maxwidth) || (win.height > cam->maxheight)) {
1775 cam->vpp_flag |= VPP_UPSCALE;
1776 /* Calculate largest w,h mantaining the same w/h ratio */
bee8a44e
RB		 1777 w = (fw >= fh) ? cam->maxwidth : SC(win.width)/fh;
1778 h = (fw >= fh) ? SC(win.height)/fw : cam->maxheight;
1da177e4
LT		 1779 if (w < cam->minwidth) /* just in case */
1780 w = cam->minwidth;
1781 if (h < cam->minheight) /* just in case */
1782 h = cam->minheight;
1783 } else {
1784 cam->vpp_flag &= ~VPP_UPSCALE;
1785 w = win.width;
1786 h = win.height;
1787 }
1788
1789 /* x,y offsets of the cropped area */
1790 scx = cam->start_cropx;
1791 scy = cam->start_cropy;
1792
1793 /* Calculate cropped area manteining the right w/h ratio */
1794 if (cam->largeview && !(cam->vpp_flag & VPP_UPSCALE)) {
bee8a44e
RB		 1795 cw = (fw >= fh) ? cam->maxwidth : SC(win.width)/fh;
1796 ch = (fw >= fh) ? SC(win.height)/fw : cam->maxheight;
1da177e4
LT		 1797 } else {
1798 cw = w;
1799 ch = h;
1800 }
1801
1802 /* Setup the window of the sensor */
1803 s_win.format = VIDEO_PALETTE_UYVY;
1804 s_win.width = cam->maxwidth;
1805 s_win.height = cam->maxheight;
1806 s_win.quarter = 0; /* full progressive video */
1807
1808 /* Center it */
1809 s_win.x = (s_win.width - cw) / 2;
1810 s_win.y = (s_win.height - ch) / 2;
1811
1812 /* Clock divisor */
1813 if (cam->clockdiv >= 0)
1814 s_win.clockdiv = cam->clockdiv; /* manual override */
1815 else
1816 switch (cam->sensor) {
1817 case CC_OV6620:
1818 s_win.clockdiv = 0;
1819 break;
1820 case CC_OV6630:
1821 s_win.clockdiv = 0;
1822 break;
1823 case CC_OV76BE:
1824 case CC_OV7610:
1825 case CC_OV7620:
1826 s_win.clockdiv = 0;
1827 break;
1828 default:
1829 s_win.clockdiv = W9968CF_DEF_CLOCKDIVISOR;
1830 }
1831
1832 /* We have to scale win.x and win.y offsets */
1833 if ( (cam->largeview && !(cam->vpp_flag & VPP_UPSCALE))
1834 || (cam->vpp_flag & VPP_UPSCALE) ) {
bee8a44e
RB		 1835 ax = SC(win.x)/fw;
1836 ay = SC(win.y)/fh;
1da177e4
LT		 1837 } else {
1838 ax = win.x;
1839 ay = win.y;
1840 }
1841
1842 if ((ax + cw) > cam->maxwidth)
1843 ax = cam->maxwidth - cw;
1844
1845 if ((ay + ch) > cam->maxheight)
1846 ay = cam->maxheight - ch;
1847
1848 /* Adjust win.x, win.y */
1849 if ( (cam->largeview && !(cam->vpp_flag & VPP_UPSCALE))
1850 || (cam->vpp_flag & VPP_UPSCALE) ) {
bee8a44e
RB		 1851 win.x = UNSC(ax*fw);
1852 win.y = UNSC(ay*fh);
1da177e4
LT		 1853 } else {
1854 win.x = ax;
1855 win.y = ay;
1856 }
1857
1858 /* Offsets used by the chip */
1859 x = ax + s_win.x;
1860 y = ay + s_win.y;
1861
1862 /* Go ! */
1863 if ((err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_S_MODE, &s_win)))
1864 goto error;
1865
1866 err += w9968cf_write_reg(cam, scx + x, 0x10);
1867 err += w9968cf_write_reg(cam, scy + y, 0x11);
1868 err += w9968cf_write_reg(cam, scx + x + cw, 0x12);
1869 err += w9968cf_write_reg(cam, scy + y + ch, 0x13);
1870 err += w9968cf_write_reg(cam, w, 0x14);
1871 err += w9968cf_write_reg(cam, h, 0x15);
1872
1873 /* JPEG width & height */
1874 err += w9968cf_write_reg(cam, w, 0x30);
1875 err += w9968cf_write_reg(cam, h, 0x31);
1876
1877 /* Y & UV frame buffer strides (in WORD) */
1878 if (cam->vpp_flag & VPP_DECOMPRESSION) {
1879 err += w9968cf_write_reg(cam, w/2, 0x2c);
1880 err += w9968cf_write_reg(cam, w/4, 0x2d);
1881 } else
1882 err += w9968cf_write_reg(cam, w, 0x2c);
1883
1884 if (err)
1885 goto error;
1886
1887 /* If all went well, update the device data structure */
1888 memcpy(&cam->window, &win, sizeof(win));
1889 cam->hw_width = w;
1890 cam->hw_height = h;
1891
1892 /* Settings changed, so we clear the frame buffers */
1893 memset(cam->frame[0].buffer, 0, cam->nbuffers*cam->frame[0].size);
1894
d56410e0 1895 DBG(4, "The capture area is %dx%d, Offset (x,y)=(%u,%u)",
1da177e4
LT		 1896 win.width, win.height, win.x, win.y)
1897
1898 PDBGG("x=%u ,y=%u, w=%u, h=%u, ax=%u, ay=%u, s_win.x=%u, s_win.y=%u, "
1899 "cw=%u, ch=%u, win.x=%u, win.y=%u, win.width=%u, win.height=%u",
1900 x, y, w, h, ax, ay, s_win.x, s_win.y, cw, ch, win.x, win.y,
1901 win.width, win.height)
1902
1903 return 0;
1904
1905error:
1906 DBG(1, "Failed to change the capture area size")
1907 return err;
1908}
1909
1910
d56410e0 1911/*--------------------------------------------------------------------------
1da177e4
LT		 1912 Adjust the asked values for window width and height.
1913 Return 0 on success, -1 otherwise.
1914 --------------------------------------------------------------------------*/
d56410e0 1915static int
1c657a99 1916w9968cf_adjust_window_size(struct w9968cf_device *cam, u32 *width, u32 *height)
1da177e4 1917{
1c657a99 1918 unsigned int maxw, maxh, align;
1da177e4
LT		 1919
1920 maxw = cam->upscaling && !(cam->vpp_flag & VPP_DECOMPRESSION) &&
1921 w9968cf_vpp ? max((u16)W9968CF_MAX_WIDTH, cam->maxwidth)
d56410e0 1922 : cam->maxwidth;
1da177e4
LT		 1923 maxh = cam->upscaling && !(cam->vpp_flag & VPP_DECOMPRESSION) &&
1924 w9968cf_vpp ? max((u16)W9968CF_MAX_HEIGHT, cam->maxheight)
d56410e0 1925 : cam->maxheight;
1c657a99 1926 align = (cam->vpp_flag & VPP_DECOMPRESSION) ? 4 : 0;
1da177e4 1927
1c657a99
TP		 1928 v4l_bound_align_image(width, cam->minwidth, maxw, align,
1929 height, cam->minheight, maxh, align, 0);
1da177e4
LT		 1930
1931 PDBGG("Window size adjusted w=%u, h=%u ", *width, *height)
1932
1933 return 0;
1934}
1935
1936
1937/*--------------------------------------------------------------------------
1938 Initialize the FIFO list of requested frames.
1939 --------------------------------------------------------------------------*/
1940static void w9968cf_init_framelist(struct w9968cf_device* cam)
1941{
1942 u8 i;
1943
1944 for (i = 0; i < cam->nbuffers; i++) {
1945 cam->requested_frame[i] = NULL;
1946 cam->frame[i].queued = 0;
1947 cam->frame[i].status = F_UNUSED;
1948 }
1949}
1950
1951
1952/*--------------------------------------------------------------------------
1953 Add a frame in the FIFO list of requested frames.
1954 This function is called in process context.
1955 --------------------------------------------------------------------------*/
1956static void w9968cf_push_frame(struct w9968cf_device* cam, u8 f_num)
1957{
1958 u8 f;
1959 unsigned long lock_flags;
1960
1961 spin_lock_irqsave(&cam->flist_lock, lock_flags);
1962
1963 for (f=0; cam->requested_frame[f] != NULL; f++);
1964 cam->requested_frame[f] = &cam->frame[f_num];
1965 cam->frame[f_num].queued = 1;
1966 cam->frame[f_num].status = F_UNUSED; /* clear the status */
1967
1968 spin_unlock_irqrestore(&cam->flist_lock, lock_flags);
1969
1970 DBG(6, "Frame #%u pushed into the FIFO list. Position %u", f_num, f)
1971}
1972
1973
1974/*--------------------------------------------------------------------------
1975 Read, store and remove the first pointer in the FIFO list of requested
1976 frames. This function is called in interrupt context.
1977 --------------------------------------------------------------------------*/
d56410e0 1978static void
1da177e4
LT		 1979w9968cf_pop_frame(struct w9968cf_device* cam, struct w9968cf_frame_t** framep)
1980{
1981 u8 i;
1982
1983 spin_lock(&cam->flist_lock);
1984
1985 *framep = cam->requested_frame[0];
1986
1987 /* Shift the list of pointers */
1988 for (i = 0; i < cam->nbuffers-1; i++)
1989 cam->requested_frame[i] = cam->requested_frame[i+1];
1990 cam->requested_frame[i] = NULL;
1991
1992 spin_unlock(&cam->flist_lock);
1993
1994 DBG(6,"Popped frame #%d from the list", (*framep)->number)
1995}
1996
1997
1998/*--------------------------------------------------------------------------
1999 High-level video post-processing routine on grabbed frames.
2000 Return 0 on success, a negative number otherwise.
2001 --------------------------------------------------------------------------*/
d56410e0
MCC		 2002static int
2003w9968cf_postprocess_frame(struct w9968cf_device* cam,
2004 struct w9968cf_frame_t* fr)
1da177e4
LT		 2005{
2006 void *pIn = fr->buffer, *pOut = cam->frame_vpp.buffer, *tmp;
2007 u16 w = cam->window.width,
2008 h = cam->window.height,
2009 d = cam->picture.depth,
2010 fmt = cam->picture.palette,
2011 rgb = cam->force_rgb,
2012 hw_w = cam->hw_width,
2013 hw_h = cam->hw_height,
2014 hw_d = cam->hw_depth;
2015 int err = 0;
2016
2017 #define _PSWAP(pIn, pOut) {tmp = (pIn); (pIn) = (pOut); (pOut) = tmp;}
2018
2019 if (cam->vpp_flag & VPP_DECOMPRESSION) {
2020 memcpy(pOut, pIn, fr->length);
2021 _PSWAP(pIn, pOut)
2022 err = w9968cf_vpp->decode(pIn, fr->length, hw_w, hw_h, pOut);
2023 PDBGG("Compressed frame length: %lu",(unsigned long)fr->length)
2024 fr->length = (hw_w*hw_h*hw_d)/8;
2025 _PSWAP(pIn, pOut)
2026 if (err) {
2027 DBG(4, "An error occurred while decoding the frame: "
2028 "%s", symbolic(decoder_errlist, err))
2029 return err;
2030 } else
2031 DBG(6, "Frame decoded")
2032 }
2033
2034 if (cam->vpp_flag & VPP_SWAP_YUV_BYTES) {
2035 w9968cf_vpp->swap_yuvbytes(pIn, fr->length);
2036 DBG(6, "Original UYVY component ordering changed")
2037 }
2038
2039 if (cam->vpp_flag & VPP_UPSCALE) {
2040 w9968cf_vpp->scale_up(pIn, pOut, hw_w, hw_h, hw_d, w, h);
2041 fr->length = (w*h*hw_d)/8;
2042 _PSWAP(pIn, pOut)
2043 DBG(6, "Vertical up-scaling done: %u,%u,%ubpp->%u,%u",
2044 hw_w, hw_h, hw_d, w, h)
2045 }
2046
2047 if (cam->vpp_flag & VPP_UYVY_TO_RGBX) {
2048 w9968cf_vpp->uyvy_to_rgbx(pIn, fr->length, pOut, fmt, rgb);
2049 fr->length = (w*h*d)/8;
2050 _PSWAP(pIn, pOut)
d56410e0 2051 DBG(6, "UYVY-16bit to %s conversion done",
1da177e4
LT		 2052 symbolic(v4l1_plist, fmt))
2053 }
2054
2055 if (pOut == fr->buffer)
2056 memcpy(fr->buffer, cam->frame_vpp.buffer, fr->length);
2057
2058 return 0;
2059}
2060
2061
2062
2063/****************************************************************************
2064 * Image sensor control routines *
2065 ****************************************************************************/
2066
d56410e0 2067static int
1da177e4
LT		 2068w9968cf_sensor_set_control(struct w9968cf_device* cam, int cid, int val)
2069{
2070 struct ovcamchip_control ctl;
2071 int err;
2072
2073 ctl.id = cid;
2074 ctl.value = val;
2075
2076 err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_S_CTRL, &ctl);
2077
2078 return err;
2079}
2080
2081
d56410e0 2082static int
1da177e4
LT		 2083w9968cf_sensor_get_control(struct w9968cf_device* cam, int cid, int* val)
2084{
2085 struct ovcamchip_control ctl;
2086 int err;
2087
2088 ctl.id = cid;
2089
2090 err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_G_CTRL, &ctl);
2091 if (!err)
2092 *val = ctl.value;
2093
2094 return err;
2095}
2096
2097
2098static int
2099w9968cf_sensor_cmd(struct w9968cf_device* cam, unsigned int cmd, void* arg)
2100{
3160fbc5 2101 int rc;
1da177e4 2102
3160fbc5 2103 rc = v4l2_subdev_call(cam->sensor_sd, core, ioctl, cmd, arg);
1da177e4
LT		 2104 /* The I2C driver returns -EPERM on non-supported controls */
2105 return (rc < 0 && rc != -EPERM) ? rc : 0;
2106}
2107
2108
2109/*--------------------------------------------------------------------------
2110 Update some settings of the image sensor.
2111 Returns: 0 on success, a negative number otherwise.
2112 --------------------------------------------------------------------------*/
2113static int w9968cf_sensor_update_settings(struct w9968cf_device* cam)
2114{
2115 int err = 0;
2116
2117 /* Auto brightness */
d56410e0
MCC		 2118 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_AUTOBRIGHT,
2119 cam->auto_brt);
1da177e4
LT		 2120 if (err)
2121 return err;
2122
2123 /* Auto exposure */
d56410e0
MCC		 2124 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_AUTOEXP,
2125 cam->auto_exp);
1da177e4
LT		 2126 if (err)
2127 return err;
2128
2129 /* Banding filter */
d56410e0
MCC		 2130 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_BANDFILT,
2131 cam->bandfilt);
1da177e4
LT		 2132 if (err)
2133 return err;
2134
2135 /* Light frequency */
2136 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_FREQ,
d56410e0 2137 cam->lightfreq);
1da177e4
LT		 2138 if (err)
2139 return err;
2140
2141 /* Back light */
2142 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_BACKLIGHT,
d56410e0 2143 cam->backlight);
1da177e4
LT		 2144 if (err)
2145 return err;
2146
2147 /* Mirror */
2148 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_MIRROR,
d56410e0 2149 cam->mirror);
1da177e4
LT		 2150 if (err)
2151 return err;
2152
2153 return 0;
2154}
2155
2156
2157/*--------------------------------------------------------------------------
2158 Get some current picture settings from the image sensor and update the
2159 internal 'picture' structure of the camera.
2160 Returns: 0 on success, a negative number otherwise.
2161 --------------------------------------------------------------------------*/
2162static int w9968cf_sensor_get_picture(struct w9968cf_device* cam)
2163{
2164 int err, v;
2165
2166 err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_CONT, &v);
2167 if (err)
2168 return err;
2169 cam->picture.contrast = v;
2170
2171 err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_BRIGHT, &v);
2172 if (err)
2173 return err;
2174 cam->picture.brightness = v;
2175
2176 err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_SAT, &v);
2177 if (err)
2178 return err;
2179 cam->picture.colour = v;
2180
2181 err = w9968cf_sensor_get_control(cam, OVCAMCHIP_CID_HUE, &v);
2182 if (err)
2183 return err;
2184 cam->picture.hue = v;
2185
2186 DBG(5, "Got picture settings from the image sensor")
2187
2188 PDBGG("Brightness, contrast, hue, colour, whiteness are "
2189 "%u,%u,%u,%u,%u", cam->picture.brightness,cam->picture.contrast,
2190 cam->picture.hue, cam->picture.colour, cam->picture.whiteness)
2191
2192 return 0;
2193}
2194
2195
2196/*--------------------------------------------------------------------------
2197 Update picture settings of the image sensor.
2198 Returns: 0 on success, a negative number otherwise.
2199 --------------------------------------------------------------------------*/
2200static int
d56410e0
MCC		 2201w9968cf_sensor_update_picture(struct w9968cf_device* cam,
2202 struct video_picture pict)
1da177e4
LT		 2203{
2204 int err = 0;
2205
2206 if ((!cam->sensor_initialized)
2207 || pict.contrast != cam->picture.contrast) {
2208 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_CONT,
d56410e0 2209 pict.contrast);
1da177e4
LT		 2210 if (err)
2211 goto fail;
2212 DBG(4, "Contrast changed from %u to %u",
2213 cam->picture.contrast, pict.contrast)
2214 cam->picture.contrast = pict.contrast;
2215 }
2216
d56410e0 2217 if (((!cam->sensor_initialized) ||
1da177e4 2218 pict.brightness != cam->picture.brightness) && (!cam->auto_brt)) {
d56410e0
MCC		 2219 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_BRIGHT,
2220 pict.brightness);
1da177e4
LT		 2221 if (err)
2222 goto fail;
2223 DBG(4, "Brightness changed from %u to %u",
2224 cam->picture.brightness, pict.brightness)
2225 cam->picture.brightness = pict.brightness;
2226 }
2227
2228 if ((!cam->sensor_initialized) || pict.colour != cam->picture.colour) {
d56410e0
MCC		 2229 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_SAT,
2230 pict.colour);
1da177e4
LT		 2231 if (err)
2232 goto fail;
2233 DBG(4, "Colour changed from %u to %u",
2234 cam->picture.colour, pict.colour)
2235 cam->picture.colour = pict.colour;
2236 }
2237
2238 if ((!cam->sensor_initialized) || pict.hue != cam->picture.hue) {
d56410e0
MCC		 2239 err = w9968cf_sensor_set_control(cam, OVCAMCHIP_CID_HUE,
2240 pict.hue);
1da177e4
LT		 2241 if (err)
2242 goto fail;
2243 DBG(4, "Hue changed from %u to %u",
2244 cam->picture.hue, pict.hue)
2245 cam->picture.hue = pict.hue;
2246 }
2247
2248 return 0;
2249
2250fail:
2251 DBG(4, "Failed to change sensor picture setting")
2252 return err;
2253}
2254
2255
2256
2257/****************************************************************************
2258 * Camera configuration *
2259 ****************************************************************************/
2260
2261/*--------------------------------------------------------------------------
2262 This function is called when a supported image sensor is detected.
2263 Return 0 if the initialization succeeds, a negative number otherwise.
2264 --------------------------------------------------------------------------*/
2265static int w9968cf_sensor_init(struct w9968cf_device* cam)
2266{
2267 int err = 0;
2268
d56410e0
MCC		 2269 if ((err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_INITIALIZE,
2270 &cam->monochrome)))
1da177e4
LT		 2271 goto error;
2272
d56410e0
MCC		 2273 if ((err = w9968cf_sensor_cmd(cam, OVCAMCHIP_CMD_Q_SUBTYPE,
2274 &cam->sensor)))
1da177e4
LT		 2275 goto error;
2276
2277 /* NOTE: Make sure width and height are a multiple of 16 */
3160fbc5 2278 switch (v4l2_i2c_subdev_addr(cam->sensor_sd)) {
1da177e4
LT		 2279 case OV6xx0_SID:
2280 cam->maxwidth = 352;
2281 cam->maxheight = 288;
2282 cam->minwidth = 64;
2283 cam->minheight = 48;
2284 break;
2285 case OV7xx0_SID:
2286 cam->maxwidth = 640;
2287 cam->maxheight = 480;
2288 cam->minwidth = 64;
2289 cam->minheight = 48;
2290 break;
2291 default:
2292 DBG(1, "Not supported image sensor detected for %s",
2293 symbolic(camlist, cam->id))
2294 return -EINVAL;
2295 }
2296
2297 /* These values depend on the ones in the ovxxx0.c sources */
2298 switch (cam->sensor) {
2299 case CC_OV7620:
2300 cam->start_cropx = 287;
2301 cam->start_cropy = 35;
2302 /* Seems to work around a bug in the image sensor */
2303 cam->vs_polarity = 1;
2304 cam->hs_polarity = 1;
2305 break;
2306 default:
2307 cam->start_cropx = 320;
2308 cam->start_cropy = 35;
2309 cam->vs_polarity = 1;
2310 cam->hs_polarity = 0;
2311 }
2312
2313 if ((err = w9968cf_sensor_update_settings(cam)))
2314 goto error;
2315
2316 if ((err = w9968cf_sensor_update_picture(cam, cam->picture)))
2317 goto error;
2318
2319 cam->sensor_initialized = 1;
2320
2321 DBG(2, "%s image sensor initialized", symbolic(senlist, cam->sensor))
2322 return 0;
2323
2324error:
2325 cam->sensor_initialized = 0;
2326 cam->sensor = CC_UNKNOWN;
2327 DBG(1, "Image sensor initialization failed for %s (/dev/video%d). "
2328 "Try to detach and attach this device again",
c6330fb8 2329 symbolic(camlist, cam->id), cam->v4ldev->num)
1da177e4
LT		 2330 return err;
2331}
2332
2333
2334/*--------------------------------------------------------------------------
2335 Fill some basic fields in the main device data structure.
d56410e0 2336 This function is called once on w9968cf_usb_probe() for each recognized
1da177e4
LT		 2337 camera.
2338 --------------------------------------------------------------------------*/
2339static void
2340w9968cf_configure_camera(struct w9968cf_device* cam,
d56410e0
MCC		 2341 struct usb_device* udev,
2342 enum w9968cf_model_id mod_id,
2343 const unsigned short dev_nr)
1da177e4 2344{
4186ecf8 2345 mutex_init(&cam->fileop_mutex);
1da177e4
LT		 2346 init_waitqueue_head(&cam->open);
2347 spin_lock_init(&cam->urb_lock);
2348 spin_lock_init(&cam->flist_lock);
2349
2350 cam->users = 0;
2351 cam->disconnected = 0;
2352 cam->id = mod_id;
2353 cam->sensor = CC_UNKNOWN;
2354 cam->sensor_initialized = 0;
2355
2356 /* Calculate the alternate setting number (from 1 to 16)
2357 according to the 'packet_size' module parameter */
2358 if (packet_size[dev_nr] < W9968CF_MIN_PACKET_SIZE)
2359 packet_size[dev_nr] = W9968CF_MIN_PACKET_SIZE;
2360 for (cam->altsetting = 1;
2361 packet_size[dev_nr] < wMaxPacketSize[cam->altsetting-1];
2362 cam->altsetting++);
2363
d56410e0
MCC		 2364 cam->max_buffers = (max_buffers[dev_nr] < 2 ||
2365 max_buffers[dev_nr] > W9968CF_MAX_BUFFERS)
2366 ? W9968CF_BUFFERS : (u8)max_buffers[dev_nr];
1da177e4 2367
d56410e0
MCC		 2368 cam->double_buffer = (double_buffer[dev_nr] == 0 ||
2369 double_buffer[dev_nr] == 1)
2370 ? (u8)double_buffer[dev_nr]:W9968CF_DOUBLE_BUFFER;
1da177e4
LT		 2371
2372 cam->clamping = (clamping[dev_nr] == 0 || clamping[dev_nr] == 1)
d56410e0
MCC		 2373 ? (u8)clamping[dev_nr] : W9968CF_CLAMPING;
2374
1da177e4 2375 cam->filter_type = (filter_type[dev_nr] == 0 ||
d56410e0
MCC		 2376 filter_type[dev_nr] == 1 ||
2377 filter_type[dev_nr] == 2)
2378 ? (u8)filter_type[dev_nr] : W9968CF_FILTER_TYPE;
1da177e4
LT		 2379
2380 cam->capture = 1;
2381
2382 cam->largeview = (largeview[dev_nr] == 0 || largeview[dev_nr] == 1)
d56410e0 2383 ? (u8)largeview[dev_nr] : W9968CF_LARGEVIEW;
1da177e4 2384
d56410e0
MCC		 2385 cam->decompression = (decompression[dev_nr] == 0 ||
2386 decompression[dev_nr] == 1 ||
2387 decompression[dev_nr] == 2)
2388 ? (u8)decompression[dev_nr]:W9968CF_DECOMPRESSION;
1da177e4 2389
d56410e0
MCC		 2390 cam->upscaling = (upscaling[dev_nr] == 0 ||
2391 upscaling[dev_nr] == 1)
2392 ? (u8)upscaling[dev_nr] : W9968CF_UPSCALING;
1da177e4
LT		 2393
2394 cam->auto_brt = (autobright[dev_nr] == 0 || autobright[dev_nr] == 1)
d56410e0 2395 ? (u8)autobright[dev_nr] : W9968CF_AUTOBRIGHT;
1da177e4
LT		 2396
2397 cam->auto_exp = (autoexp[dev_nr] == 0 || autoexp[dev_nr] == 1)
d56410e0 2398 ? (u8)autoexp[dev_nr] : W9968CF_AUTOEXP;
1da177e4
LT		 2399
2400 cam->lightfreq = (lightfreq[dev_nr] == 50 || lightfreq[dev_nr] == 60)
d56410e0 2401 ? (u8)lightfreq[dev_nr] : W9968CF_LIGHTFREQ;
1da177e4 2402
d56410e0
MCC		 2403 cam->bandfilt = (bandingfilter[dev_nr] == 0 ||
2404 bandingfilter[dev_nr] == 1)
2405 ? (u8)bandingfilter[dev_nr] : W9968CF_BANDINGFILTER;
1da177e4
LT		 2406
2407 cam->backlight = (backlight[dev_nr] == 0 || backlight[dev_nr] == 1)
d56410e0 2408 ? (u8)backlight[dev_nr] : W9968CF_BACKLIGHT;
1da177e4
LT		 2409
2410 cam->clockdiv = (clockdiv[dev_nr] == -1 || clockdiv[dev_nr] >= 0)
d56410e0 2411 ? (s8)clockdiv[dev_nr] : W9968CF_CLOCKDIV;
1da177e4
LT		 2412
2413 cam->mirror = (mirror[dev_nr] == 0 || mirror[dev_nr] == 1)
d56410e0 2414 ? (u8)mirror[dev_nr] : W9968CF_MIRROR;
1da177e4
LT		 2415
2416 cam->monochrome = (monochrome[dev_nr] == 0 || monochrome[dev_nr] == 1)
d56410e0 2417 ? monochrome[dev_nr] : W9968CF_MONOCHROME;
1da177e4
LT		 2418
2419 cam->picture.brightness = (u16)brightness[dev_nr];
2420 cam->picture.hue = (u16)hue[dev_nr];
2421 cam->picture.colour = (u16)colour[dev_nr];
2422 cam->picture.contrast = (u16)contrast[dev_nr];
2423 cam->picture.whiteness = (u16)whiteness[dev_nr];
2424 if (w9968cf_valid_palette((u16)force_palette[dev_nr])) {
2425 cam->picture.palette = (u16)force_palette[dev_nr];
2426 cam->force_palette = 1;
2427 } else {
2428 cam->force_palette = 0;
2429 if (cam->decompression == 0)
2430 cam->picture.palette = W9968CF_PALETTE_DECOMP_OFF;
2431 else if (cam->decompression == 1)
2432 cam->picture.palette = W9968CF_PALETTE_DECOMP_FORCE;
2433 else
2434 cam->picture.palette = W9968CF_PALETTE_DECOMP_ON;
2435 }
2436 cam->picture.depth = w9968cf_valid_depth(cam->picture.palette);
2437
2438 cam->force_rgb = (force_rgb[dev_nr] == 0 || force_rgb[dev_nr] == 1)
d56410e0 2439 ? (u8)force_rgb[dev_nr] : W9968CF_FORCE_RGB;
1da177e4
LT		 2440
2441 cam->window.x = 0;
2442 cam->window.y = 0;
2443 cam->window.width = W9968CF_WIDTH;
2444 cam->window.height = W9968CF_HEIGHT;
2445 cam->window.chromakey = 0;
2446 cam->window.clipcount = 0;
2447 cam->window.flags = 0;
2448
2449 DBG(3, "%s configured with settings #%u:",
2450 symbolic(camlist, cam->id), dev_nr)
d56410e0 2451
1da177e4
LT		 2452 DBG(3, "- Data packet size for USB isochrnous transfer: %u bytes",
2453 wMaxPacketSize[cam->altsetting-1])
d56410e0 2454
1da177e4
LT		 2455 DBG(3, "- Number of requested video frame buffers: %u",
2456 cam->max_buffers)
2457
2458 if (cam->double_buffer)
2459 DBG(3, "- Hardware double buffering enabled")
d56410e0 2460 else
1da177e4
LT		 2461 DBG(3, "- Hardware double buffering disabled")
2462
2463 if (cam->filter_type == 0)
2464 DBG(3, "- Video filtering disabled")
2465 else if (cam->filter_type == 1)
2466 DBG(3, "- Video filtering enabled: type 1-2-1")
2467 else if (cam->filter_type == 2)
2468 DBG(3, "- Video filtering enabled: type 2-3-6-3-2")
2469
2470 if (cam->clamping)
2471 DBG(3, "- Video data clamping (CCIR-601 format) enabled")
2472 else
2473 DBG(3, "- Video data clamping (CCIR-601 format) disabled")
2474
2475 if (cam->largeview)
2476 DBG(3, "- Large view enabled")
2477 else
2478 DBG(3, "- Large view disabled")
2479
2480 if ((cam->decompression) == 0 && (!cam->force_palette))
2481 DBG(3, "- Decompression disabled")
2482 else if ((cam->decompression) == 1 && (!cam->force_palette))
2483 DBG(3, "- Decompression forced")
2484 else if ((cam->decompression) == 2 && (!cam->force_palette))
2485 DBG(3, "- Decompression allowed")
2486
2487 if (cam->upscaling)
2488 DBG(3, "- Software image scaling enabled")
2489 else
2490 DBG(3, "- Software image scaling disabled")
2491
2492 if (cam->force_palette)
2493 DBG(3, "- Image palette forced to %s",
2494 symbolic(v4l1_plist, cam->picture.palette))
2495
2496 if (cam->force_rgb)
2497 DBG(3, "- RGB component ordering will be used instead of BGR")
2498
2499 if (cam->auto_brt)
2500 DBG(3, "- Auto brightness enabled")
2501 else
2502 DBG(3, "- Auto brightness disabled")
2503
2504 if (cam->auto_exp)
2505 DBG(3, "- Auto exposure enabled")
2506 else
2507 DBG(3, "- Auto exposure disabled")
2508
2509 if (cam->backlight)
2510 DBG(3, "- Backlight exposure algorithm enabled")
2511 else
2512 DBG(3, "- Backlight exposure algorithm disabled")
2513
2514 if (cam->mirror)
2515 DBG(3, "- Mirror enabled")
2516 else
2517 DBG(3, "- Mirror disabled")
2518
2519 if (cam->bandfilt)
2520 DBG(3, "- Banding filter enabled")
2521 else
2522 DBG(3, "- Banding filter disabled")
2523
2524 DBG(3, "- Power lighting frequency: %u", cam->lightfreq)
2525
2526 if (cam->clockdiv == -1)
2527 DBG(3, "- Automatic clock divisor enabled")
2528 else
2529 DBG(3, "- Clock divisor: %d", cam->clockdiv)
2530
2531 if (cam->monochrome)
2532 DBG(3, "- Image sensor used as monochrome")
2533 else
2534 DBG(3, "- Image sensor not used as monochrome")
2535}
2536
2537
2538/*--------------------------------------------------------------------------
2539 If the video post-processing module is not loaded, some parameters
2540 must be overridden.
2541 --------------------------------------------------------------------------*/
2542static void w9968cf_adjust_configuration(struct w9968cf_device* cam)
2543{
2544 if (!w9968cf_vpp) {
2545 if (cam->decompression == 1) {
2546 cam->decompression = 2;
2547 DBG(2, "Video post-processing module not found: "
2548 "'decompression' parameter forced to 2")
2549 }
2550 if (cam->upscaling) {
2551 cam->upscaling = 0;
2552 DBG(2, "Video post-processing module not found: "
2553 "'upscaling' parameter forced to 0")
2554 }
2555 if (cam->picture.palette != VIDEO_PALETTE_UYVY) {
2556 cam->force_palette = 0;
2557 DBG(2, "Video post-processing module not found: "
2558 "'force_palette' parameter forced to 0")
2559 }
2560 cam->picture.palette = VIDEO_PALETTE_UYVY;
2561 cam->picture.depth = w9968cf_valid_depth(cam->picture.palette);
2562 }
2563}
2564
2565
2566/*--------------------------------------------------------------------------
2567 Release the resources used by the driver.
d56410e0 2568 This function is called on disconnect
1da177e4
LT		 2569 (or on close if deallocation has been deferred)
2570 --------------------------------------------------------------------------*/
2571static void w9968cf_release_resources(struct w9968cf_device* cam)
2572{
4186ecf8 2573 mutex_lock(&w9968cf_devlist_mutex);
1da177e4 2574
c6330fb8 2575 DBG(2, "V4L device deregistered: /dev/video%d", cam->v4ldev->num)
1da177e4
LT		 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);
3160fbc5 2583 v4l2_device_unregister(&cam->v4l2_dev);
1da177e4 2584
4186ecf8 2585 mutex_unlock(&w9968cf_devlist_mutex);
1da177e4
LT		 2586}
2587
2588
2589
2590/****************************************************************************
2591 * Video4Linux interface *
2592 ****************************************************************************/
2593
bec43661 2594static int w9968cf_open(struct file *filp)
1da177e4
LT		 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))
3abff557 2601 return -EAGAIN;
1da177e4
LT		 2602
2603 cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2604
4186ecf8 2605 mutex_lock(&cam->dev_mutex);
1da177e4
LT		 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 (/dev/video%d). Make "
2610 "sure it is loaded *before* (re)connecting the camera.",
c6330fb8 2611 symbolic(camlist, cam->id), cam->v4ldev->num)
4186ecf8 2612 mutex_unlock(&cam->dev_mutex);
1da177e4
LT		 2613 up_read(&w9968cf_disconnect);
2614 return -ENODEV;
2615 }
2616
2617 if (cam->users) {
2618 DBG(2, "%s (/dev/video%d) has been already occupied by '%s'",
c6330fb8 2619 symbolic(camlist, cam->id), cam->v4ldev->num, cam->command)
1da177e4 2620 if ((filp->f_flags & O_NONBLOCK)||(filp->f_flags & O_NDELAY)) {
4186ecf8 2621 mutex_unlock(&cam->dev_mutex);
1da177e4
LT		 2622 up_read(&w9968cf_disconnect);
2623 return -EWOULDBLOCK;
2624 }
4186ecf8 2625 mutex_unlock(&cam->dev_mutex);
1da177e4 2626 err = wait_event_interruptible_exclusive(cam->open,
d56410e0
MCC		 2627 cam->disconnected ||
2628 !cam->users);
1da177e4
LT		 2629 if (err) {
2630 up_read(&w9968cf_disconnect);
2631 return err;
2632 }
2633 if (cam->disconnected) {
2634 up_read(&w9968cf_disconnect);
2635 return -ENODEV;
2636 }
4186ecf8 2637 mutex_lock(&cam->dev_mutex);
1da177e4
LT		 2638 }
2639
2640 DBG(5, "Opening '%s', /dev/video%d ...",
c6330fb8 2641 symbolic(camlist, cam->id), cam->v4ldev->num)
1da177e4
LT		 2642
2643 cam->streaming = 0;
2644 cam->misconfigured = 0;
2645
7f2c01ab 2646 w9968cf_adjust_configuration(cam);
1da177e4
LT		 2647
2648 if ((err = w9968cf_allocate_memory(cam)))
2649 goto deallocate_memory;
2650
2651 if ((err = w9968cf_init_chip(cam)))
2652 goto deallocate_memory;
2653
2654 if ((err = w9968cf_start_transfer(cam)))
2655 goto deallocate_memory;
2656
2657 filp->private_data = cam;
2658
2659 cam->users++;
2660 strcpy(cam->command, current->comm);
2661
2662 init_waitqueue_head(&cam->wait_queue);
2663
2664 DBG(5, "Video device is open")
2665
4186ecf8 2666 mutex_unlock(&cam->dev_mutex);
1da177e4
LT		 2667 up_read(&w9968cf_disconnect);
2668
2669 return 0;
2670
2671deallocate_memory:
2672 w9968cf_deallocate_memory(cam);
1da177e4 2673 DBG(2, "Failed to open the video device")
4186ecf8 2674 mutex_unlock(&cam->dev_mutex);
1da177e4
LT		 2675 up_read(&w9968cf_disconnect);
2676 return err;
2677}
2678
2679
bec43661 2680static int w9968cf_release(struct file *filp)
1da177e4
LT		 2681{
2682 struct w9968cf_device* cam;
2683
2684 cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2685
4186ecf8 2686 mutex_lock(&cam->dev_mutex); /* prevent disconnect() to be called */
1da177e4
LT		 2687
2688 w9968cf_stop_transfer(cam);
2689
1da177e4
LT		 2690 if (cam->disconnected) {
2691 w9968cf_release_resources(cam);
4186ecf8 2692 mutex_unlock(&cam->dev_mutex);
1da177e4
LT		 2693 kfree(cam);
2694 return 0;
2695 }
2696
2697 cam->users--;
2698 w9968cf_deallocate_memory(cam);
2699 wake_up_interruptible_nr(&cam->open, 1);
2700
2701 DBG(5, "Video device closed")
4186ecf8 2702 mutex_unlock(&cam->dev_mutex);
1da177e4
LT		 2703 return 0;
2704}
2705
2706
2707static ssize_t
2708w9968cf_read(struct file* filp, char __user * buf, size_t count, loff_t* f_pos)
2709{
2710 struct w9968cf_device* cam;
2711 struct w9968cf_frame_t* fr;
2712 int err = 0;
2713
2714 cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2715
2716 if (filp->f_flags & O_NONBLOCK)
2717 return -EWOULDBLOCK;
2718
4186ecf8 2719 if (mutex_lock_interruptible(&cam->fileop_mutex))
1da177e4
LT		 2720 return -ERESTARTSYS;
2721
2722 if (cam->disconnected) {
2723 DBG(2, "Device not present")
4186ecf8 2724 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2725 return -ENODEV;
2726 }
2727
2728 if (cam->misconfigured) {
2729 DBG(2, "The camera is misconfigured. Close and open it again.")
4186ecf8 2730 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2731 return -EIO;
2732 }
2733
2734 if (!cam->frame[0].queued)
2735 w9968cf_push_frame(cam, 0);
2736
2737 if (!cam->frame[1].queued)
2738 w9968cf_push_frame(cam, 1);
2739
2740 err = wait_event_interruptible(cam->wait_queue,
d56410e0
MCC		 2741 cam->frame[0].status == F_READY ||
2742 cam->frame[1].status == F_READY ||
2743 cam->disconnected);
1da177e4 2744 if (err) {
4186ecf8 2745 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2746 return err;
2747 }
2748 if (cam->disconnected) {
4186ecf8 2749 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2750 return -ENODEV;
2751 }
2752
2753 fr = (cam->frame[0].status == F_READY) ? &cam->frame[0]:&cam->frame[1];
2754
2755 if (w9968cf_vpp)
2756 w9968cf_postprocess_frame(cam, fr);
2757
2758 if (count > fr->length)
2759 count = fr->length;
2760
2761 if (copy_to_user(buf, fr->buffer, count)) {
2762 fr->status = F_UNUSED;
4186ecf8 2763 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2764 return -EFAULT;
2765 }
2766 *f_pos += count;
2767
2768 fr->status = F_UNUSED;
2769
2770 DBG(5, "%zu bytes read", count)
2771
4186ecf8 2772 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2773 return count;
2774}
2775
2776
2777static int w9968cf_mmap(struct file* filp, struct vm_area_struct *vma)
2778{
2779 struct w9968cf_device* cam = (struct w9968cf_device*)
d56410e0 2780 video_get_drvdata(video_devdata(filp));
1da177e4 2781 unsigned long vsize = vma->vm_end - vma->vm_start,
d56410e0
MCC		 2782 psize = cam->nbuffers * cam->frame[0].size,
2783 start = vma->vm_start,
2784 pos = (unsigned long)cam->frame[0].buffer,
2785 page;
1da177e4
LT		 2786
2787 if (cam->disconnected) {
2788 DBG(2, "Device not present")
2789 return -ENODEV;
2790 }
2791
2792 if (cam->misconfigured) {
2793 DBG(2, "The camera is misconfigured. Close and open it again")
2794 return -EIO;
2795 }
2796
2797 PDBGG("mmapping %lu bytes...", vsize)
2798
2799 if (vsize > psize - (vma->vm_pgoff << PAGE_SHIFT))
2800 return -EINVAL;
2801
2802 while (vsize > 0) {
2803 page = vmalloc_to_pfn((void *)pos);
2804 if (remap_pfn_range(vma, start, page + vma->vm_pgoff,
2805 PAGE_SIZE, vma->vm_page_prot))
2806 return -EAGAIN;
2807 start += PAGE_SIZE;
2808 pos += PAGE_SIZE;
2809 vsize -= PAGE_SIZE;
2810 }
2811
2812 DBG(5, "mmap method successfully called")
2813 return 0;
2814}
2815
2816
069b7479 2817static long
bec43661 2818w9968cf_ioctl(struct file *filp,
d56410e0 2819 unsigned int cmd, unsigned long arg)
1da177e4
LT		 2820{
2821 struct w9968cf_device* cam;
069b7479 2822 long err;
1da177e4
LT		 2823
2824 cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2825
4186ecf8 2826 if (mutex_lock_interruptible(&cam->fileop_mutex))
1da177e4
LT		 2827 return -ERESTARTSYS;
2828
2829 if (cam->disconnected) {
2830 DBG(2, "Device not present")
4186ecf8 2831 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2832 return -ENODEV;
2833 }
2834
2835 if (cam->misconfigured) {
2836 DBG(2, "The camera is misconfigured. Close and open it again.")
4186ecf8 2837 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2838 return -EIO;
2839 }
2840
bec43661 2841 err = w9968cf_v4l_ioctl(filp, cmd, (void __user *)arg);
1da177e4 2842
4186ecf8 2843 mutex_unlock(&cam->fileop_mutex);
1da177e4
LT		 2844 return err;
2845}
2846
2847
069b7479 2848static long w9968cf_v4l_ioctl(struct file *filp,
bec43661 2849 unsigned int cmd, void __user *arg)
1da177e4
LT		 2850{
2851 struct w9968cf_device* cam;
2852 const char* v4l1_ioctls[] = {
d56410e0 2853 "?", "CGAP", "GCHAN", "SCHAN", "GTUNER", "STUNER",
1da177e4
LT		 2854 "GPICT", "SPICT", "CCAPTURE", "GWIN", "SWIN", "GFBUF",
2855 "SFBUF", "KEY", "GFREQ", "SFREQ", "GAUDIO", "SAUDIO",
2856 "SYNC", "MCAPTURE", "GMBUF", "GUNIT", "GCAPTURE", "SCAPTURE",
d56410e0
MCC		 2857 "SPLAYMODE", "SWRITEMODE", "GPLAYINFO", "SMICROCODE",
2858 "GVBIFMT", "SVBIFMT"
1da177e4
LT		 2859 };
2860
2861 #define V4L1_IOCTL(cmd) \
d56410e0
MCC		 2862 ((_IOC_NR((cmd)) < ARRAY_SIZE(v4l1_ioctls)) ? \
2863 v4l1_ioctls[_IOC_NR((cmd))] : "?")
1da177e4
LT		 2864
2865 cam = (struct w9968cf_device*)video_get_drvdata(video_devdata(filp));
2866
2867 switch (cmd) {
2868
2869 case VIDIOCGCAP: /* get video capability */
2870 {
2871 struct video_capability cap = {
2872 .type = VID_TYPE_CAPTURE | VID_TYPE_SCALES,
2873 .channels = 1,
2874 .audios = 0,
2875 .minwidth = cam->minwidth,
2876 .minheight = cam->minheight,
2877 };
d56410e0 2878 sprintf(cap.name, "W996[87]CF USB Camera #%d",
c6330fb8 2879 cam->v4ldev->num);
1da177e4 2880 cap.maxwidth = (cam->upscaling && w9968cf_vpp)
d56410e0
MCC		 2881 ? max((u16)W9968CF_MAX_WIDTH, cam->maxwidth)
2882 : cam->maxwidth;
1da177e4 2883 cap.maxheight = (cam->upscaling && w9968cf_vpp)
d56410e0
MCC		 2884 ? max((u16)W9968CF_MAX_HEIGHT, cam->maxheight)
2885 : cam->maxheight;
1da177e4
LT		 2886
2887 if (copy_to_user(arg, &cap, sizeof(cap)))
2888 return -EFAULT;
2889
2890 DBG(5, "VIDIOCGCAP successfully called")
2891 return 0;
2892 }
2893
2894 case VIDIOCGCHAN: /* get video channel informations */
2895 {
2896 struct video_channel chan;
2897 if (copy_from_user(&chan, arg, sizeof(chan)))
2898 return -EFAULT;
2899
2900 if (chan.channel != 0)
2901 return -EINVAL;
2902
2903 strcpy(chan.name, "Camera");
2904 chan.tuners = 0;
2905 chan.flags = 0;
2906 chan.type = VIDEO_TYPE_CAMERA;
2907 chan.norm = VIDEO_MODE_AUTO;
2908
2909 if (copy_to_user(arg, &chan, sizeof(chan)))
2910 return -EFAULT;
2911
2912 DBG(5, "VIDIOCGCHAN successfully called")
2913 return 0;
2914 }
2915
2916 case VIDIOCSCHAN: /* set active channel */
2917 {
2918 struct video_channel chan;
2919
2920 if (copy_from_user(&chan, arg, sizeof(chan)))
2921 return -EFAULT;
2922
2923 if (chan.channel != 0)
2924 return -EINVAL;
2925
2926 DBG(5, "VIDIOCSCHAN successfully called")
2927 return 0;
2928 }
2929
2930 case VIDIOCGPICT: /* get image properties of the picture */
2931 {
2932 if (w9968cf_sensor_get_picture(cam))
2933 return -EIO;
2934
2935 if (copy_to_user(arg, &cam->picture, sizeof(cam->picture)))
2936 return -EFAULT;
2937
2938 DBG(5, "VIDIOCGPICT successfully called")
2939 return 0;
2940 }
2941
2942 case VIDIOCSPICT: /* change picture settings */
2943 {
2944 struct video_picture pict;
2945 int err = 0;
2946
2947 if (copy_from_user(&pict, arg, sizeof(pict)))
2948 return -EFAULT;
2949
d56410e0 2950 if ( (cam->force_palette || !w9968cf_vpp)
1da177e4
LT		 2951 && pict.palette != cam->picture.palette ) {
2952 DBG(4, "Palette %s rejected: only %s is allowed",
2953 symbolic(v4l1_plist, pict.palette),
2954 symbolic(v4l1_plist, cam->picture.palette))
2955 return -EINVAL;
2956 }
2957
2958 if (!w9968cf_valid_palette(pict.palette)) {
2959 DBG(4, "Palette %s not supported. VIDIOCSPICT failed",
2960 symbolic(v4l1_plist, pict.palette))
2961 return -EINVAL;
2962 }
2963
2964 if (!cam->force_palette) {
2965 if (cam->decompression == 0) {
2966 if (w9968cf_need_decompression(pict.palette)) {
d56410e0
MCC		 2967 DBG(4, "Decompression disabled: palette %s is not "
2968 "allowed. VIDIOCSPICT failed",
2969 symbolic(v4l1_plist, pict.palette))
2970 return -EINVAL;
1da177e4
LT		 2971 }
2972 } else if (cam->decompression == 1) {
2973 if (!w9968cf_need_decompression(pict.palette)) {
d56410e0
MCC		 2974 DBG(4, "Decompression forced: palette %s is not "
2975 "allowed. VIDIOCSPICT failed",
2976 symbolic(v4l1_plist, pict.palette))
2977 return -EINVAL;
1da177e4
LT		 2978 }
2979 }
2980 }
2981
2982 if (pict.depth != w9968cf_valid_depth(pict.palette)) {
2983 DBG(4, "Requested depth %u bpp is not valid for %s "
d56410e0 2984 "palette: ignored and changed to %u bpp",
1da177e4
LT		 2985 pict.depth, symbolic(v4l1_plist, pict.palette),
2986 w9968cf_valid_depth(pict.palette))
2987 pict.depth = w9968cf_valid_depth(pict.palette);
2988 }
2989
2990 if (pict.palette != cam->picture.palette) {
2991 if(*cam->requested_frame
2992 || cam->frame_current->queued) {
2993 err = wait_event_interruptible
2994 ( cam->wait_queue,
d56410e0
MCC		 2995 cam->disconnected ||
2996 (!*cam->requested_frame &&
2997 !cam->frame_current->queued) );
1da177e4
LT		 2998 if (err)
2999 return err;
3000 if (cam->disconnected)
3001 return -ENODEV;
3002 }
3003
3004 if (w9968cf_stop_transfer(cam))
3005 goto ioctl_fail;
3006
3007 if (w9968cf_set_picture(cam, pict))
3008 goto ioctl_fail;
3009
3010 if (w9968cf_start_transfer(cam))
3011 goto ioctl_fail;
3012
3013 } else if (w9968cf_sensor_update_picture(cam, pict))
3014 return -EIO;
3015
3016
3017 DBG(5, "VIDIOCSPICT successfully called")
3018 return 0;
3019 }
3020
3021 case VIDIOCSWIN: /* set capture area */
3022 {
3023 struct video_window win;
3024 int err = 0;
3025
3026 if (copy_from_user(&win, arg, sizeof(win)))
3027 return -EFAULT;
3028
3029 DBG(6, "VIDIOCSWIN called: clipcount=%d, flags=%u, "
3030 "x=%u, y=%u, %ux%u", win.clipcount, win.flags,
3031 win.x, win.y, win.width, win.height)
3032
3033 if (win.clipcount != 0 || win.flags != 0)
3034 return -EINVAL;
3035
1c657a99
TP		 3036 if ((err = w9968cf_adjust_window_size(cam, &win.width,
3037 &win.height))) {
1da177e4
LT		 3038 DBG(4, "Resolution not supported (%ux%u). "
3039 "VIDIOCSWIN failed", win.width, win.height)
3040 return err;
3041 }
3042
3043 if (win.x != cam->window.x ||
3044 win.y != cam->window.y ||
3045 win.width != cam->window.width ||
3046 win.height != cam->window.height) {
3047 if(*cam->requested_frame
3048 || cam->frame_current->queued) {
3049 err = wait_event_interruptible
3050 ( cam->wait_queue,
d56410e0
MCC		 3051 cam->disconnected ||
3052 (!*cam->requested_frame &&
3053 !cam->frame_current->queued) );
1da177e4
LT		 3054 if (err)
3055 return err;
3056 if (cam->disconnected)
3057 return -ENODEV;
3058 }
3059
3060 if (w9968cf_stop_transfer(cam))
3061 goto ioctl_fail;
3062
3063 /* This _must_ be called before set_window() */
3064 if (w9968cf_set_picture(cam, cam->picture))
3065 goto ioctl_fail;
3066
3067 if (w9968cf_set_window(cam, win))
3068 goto ioctl_fail;
3069
3070 if (w9968cf_start_transfer(cam))
3071 goto ioctl_fail;
3072 }
3073
3074 DBG(5, "VIDIOCSWIN successfully called. ")
3075 return 0;
3076 }
3077
3078 case VIDIOCGWIN: /* get current window properties */
3079 {
3080 if (copy_to_user(arg,&cam->window,sizeof(struct video_window)))
3081 return -EFAULT;
3082
3083 DBG(5, "VIDIOCGWIN successfully called")
3084 return 0;
3085 }
3086
3087 case VIDIOCGMBUF: /* request for memory (mapped) buffer */
3088 {
3089 struct video_mbuf mbuf;
3090 u8 i;
3091
3092 mbuf.size = cam->nbuffers * cam->frame[0].size;
3093 mbuf.frames = cam->nbuffers;
3094 for (i = 0; i < cam->nbuffers; i++)
3095 mbuf.offsets[i] = (unsigned long)cam->frame[i].buffer -
d56410e0 3096 (unsigned long)cam->frame[0].buffer;
1da177e4
LT		 3097
3098 if (copy_to_user(arg, &mbuf, sizeof(mbuf)))
3099 return -EFAULT;
3100
3101 DBG(5, "VIDIOCGMBUF successfully called")
3102 return 0;
3103 }
3104
3105 case VIDIOCMCAPTURE: /* start the capture to a frame */
3106 {
3107 struct video_mmap mmap;
3108 struct w9968cf_frame_t* fr;
1c657a99 3109 u32 w, h;
1da177e4
LT		 3110 int err = 0;
3111
3112 if (copy_from_user(&mmap, arg, sizeof(mmap)))
3113 return -EFAULT;
3114
3115 DBG(6, "VIDIOCMCAPTURE called: frame #%u, format=%s, %dx%d",
d56410e0 3116 mmap.frame, symbolic(v4l1_plist, mmap.format),
1da177e4
LT		 3117 mmap.width, mmap.height)
3118
3119 if (mmap.frame >= cam->nbuffers) {
3120 DBG(4, "Invalid frame number (%u). "
3121 "VIDIOCMCAPTURE failed", mmap.frame)
3122 return -EINVAL;
3123 }
3124
d56410e0 3125 if (mmap.format!=cam->picture.palette &&
1da177e4
LT		 3126 (cam->force_palette || !w9968cf_vpp)) {
3127 DBG(4, "Palette %s rejected: only %s is allowed",
3128 symbolic(v4l1_plist, mmap.format),
3129 symbolic(v4l1_plist, cam->picture.palette))
3130 return -EINVAL;
3131 }
3132
3133 if (!w9968cf_valid_palette(mmap.format)) {
3134 DBG(4, "Palette %s not supported. "
d56410e0 3135 "VIDIOCMCAPTURE failed",
1da177e4
LT		 3136 symbolic(v4l1_plist, mmap.format))
3137 return -EINVAL;
3138 }
3139
3140 if (!cam->force_palette) {
3141 if (cam->decompression == 0) {
3142 if (w9968cf_need_decompression(mmap.format)) {
d56410e0
MCC		 3143 DBG(4, "Decompression disabled: palette %s is not "
3144 "allowed. VIDIOCSPICT failed",
3145 symbolic(v4l1_plist, mmap.format))
3146 return -EINVAL;
1da177e4
LT		 3147 }
3148 } else if (cam->decompression == 1) {
3149 if (!w9968cf_need_decompression(mmap.format)) {
d56410e0
MCC		 3150 DBG(4, "Decompression forced: palette %s is not "
3151 "allowed. VIDIOCSPICT failed",
3152 symbolic(v4l1_plist, mmap.format))
3153 return -EINVAL;
1da177e4
LT		 3154 }
3155 }
3156 }
3157
1c657a99
TP		 3158 w = mmap.width; h = mmap.height;
3159 err = w9968cf_adjust_window_size(cam, &w, &h);
3160 mmap.width = w; mmap.height = h;
3161 if (err) {
1da177e4
LT		 3162 DBG(4, "Resolution not supported (%dx%d). "
3163 "VIDIOCMCAPTURE failed",
3164 mmap.width, mmap.height)
3165 return err;
3166 }
3167
3168 fr = &cam->frame[mmap.frame];
3169
3170 if (mmap.width != cam->window.width ||
3171 mmap.height != cam->window.height ||
3172 mmap.format != cam->picture.palette) {
3173
3174 struct video_window win;
3175 struct video_picture pict;
3176
3177 if(*cam->requested_frame
3178 || cam->frame_current->queued) {
3179 DBG(6, "VIDIOCMCAPTURE. Change settings for "
3180 "frame #%u: %dx%d, format %s. Wait...",
3181 mmap.frame, mmap.width, mmap.height,
d56410e0 3182 symbolic(v4l1_plist, mmap.format))
1da177e4
LT		 3183 err = wait_event_interruptible
3184 ( cam->wait_queue,
d56410e0
MCC		 3185 cam->disconnected ||
3186 (!*cam->requested_frame &&
3187 !cam->frame_current->queued) );
1da177e4
LT		 3188 if (err)
3189 return err;
3190 if (cam->disconnected)
3191 return -ENODEV;
3192 }
3193
3194 memcpy(&win, &cam->window, sizeof(win));
3195 memcpy(&pict, &cam->picture, sizeof(pict));
3196 win.width = mmap.width;
3197 win.height = mmap.height;
3198 pict.palette = mmap.format;
3199
3200 if (w9968cf_stop_transfer(cam))
3201 goto ioctl_fail;
3202
3203 /* This before set_window */
d56410e0 3204 if (w9968cf_set_picture(cam, pict))
1da177e4
LT		 3205 goto ioctl_fail;
3206
3207 if (w9968cf_set_window(cam, win))
3208 goto ioctl_fail;
3209
3210 if (w9968cf_start_transfer(cam))
3211 goto ioctl_fail;
3212
3213 } else if (fr->queued) {
3214
3215 DBG(6, "Wait until frame #%u is free", mmap.frame)
d56410e0
MCC		 3216
3217 err = wait_event_interruptible(cam->wait_queue,
3218 cam->disconnected ||
3219 (!fr->queued));
1da177e4
LT		 3220 if (err)
3221 return err;
3222 if (cam->disconnected)
3223 return -ENODEV;
3224 }
3225
3226 w9968cf_push_frame(cam, mmap.frame);
3227 DBG(5, "VIDIOCMCAPTURE(%u): successfully called", mmap.frame)
3228 return 0;
3229 }
3230
3231 case VIDIOCSYNC: /* wait until the capture of a frame is finished */
3232 {
3233 unsigned int f_num;
3234 struct w9968cf_frame_t* fr;
3235 int err = 0;
3236
3237 if (copy_from_user(&f_num, arg, sizeof(f_num)))
3238 return -EFAULT;
3239
3240 if (f_num >= cam->nbuffers) {
3241 DBG(4, "Invalid frame number (%u). "
3242 "VIDIOCMCAPTURE failed", f_num)
3243 return -EINVAL;
3244 }
3245
3246 DBG(6, "VIDIOCSYNC called for frame #%u", f_num)
3247
3248 fr = &cam->frame[f_num];
3249
3250 switch (fr->status) {
3251 case F_UNUSED:
3252 if (!fr->queued) {
3253 DBG(4, "VIDIOSYNC: Frame #%u not requested!",
3254 f_num)
3255 return -EFAULT;
3256 }
3257 case F_ERROR:
3258 case F_GRABBING:
d56410e0
MCC		 3259 err = wait_event_interruptible(cam->wait_queue,
3260 (fr->status == F_READY)
3261 || cam->disconnected);
1da177e4
LT		 3262 if (err)
3263 return err;
3264 if (cam->disconnected)
3265 return -ENODEV;
3266 break;
3267 case F_READY:
3268 break;
3269 }
3270
3271 if (w9968cf_vpp)
3272 w9968cf_postprocess_frame(cam, fr);
3273
3274 fr->status = F_UNUSED;
3275
3276 DBG(5, "VIDIOCSYNC(%u) successfully called", f_num)
3277 return 0;
3278 }
3279
3280 case VIDIOCGUNIT:/* report the unit numbers of the associated devices*/
3281 {
3282 struct video_unit unit = {
3283 .video = cam->v4ldev->minor,
3284 .vbi = VIDEO_NO_UNIT,
3285 .radio = VIDEO_NO_UNIT,
3286 .audio = VIDEO_NO_UNIT,
3287 .teletext = VIDEO_NO_UNIT,
3288 };
3289
3290 if (copy_to_user(arg, &unit, sizeof(unit)))
3291 return -EFAULT;
3292
3293 DBG(5, "VIDIOCGUNIT successfully called")
3294 return 0;
3295 }
3296
3297 case VIDIOCKEY:
3298 return 0;
3299
3300 case VIDIOCGFBUF:
3301 {
3302 if (clear_user(arg, sizeof(struct video_buffer)))
3303 return -EFAULT;
3304
3305 DBG(5, "VIDIOCGFBUF successfully called")
3306 return 0;
3307 }
3308
3309 case VIDIOCGTUNER:
3310 {
3311 struct video_tuner tuner;
3312 if (copy_from_user(&tuner, arg, sizeof(tuner)))
3313 return -EFAULT;
3314
3315 if (tuner.tuner != 0)
3316 return -EINVAL;
3317
3318 strcpy(tuner.name, "no_tuner");
3319 tuner.rangelow = 0;
3320 tuner.rangehigh = 0;
3321 tuner.flags = VIDEO_TUNER_NORM;
3322 tuner.mode = VIDEO_MODE_AUTO;
3323 tuner.signal = 0xffff;
3324
3325 if (copy_to_user(arg, &tuner, sizeof(tuner)))
3326 return -EFAULT;
3327
3328 DBG(5, "VIDIOCGTUNER successfully called")
3329 return 0;
3330 }
3331
3332 case VIDIOCSTUNER:
3333 {
3334 struct video_tuner tuner;
3335 if (copy_from_user(&tuner, arg, sizeof(tuner)))
3336 return -EFAULT;
3337
3338 if (tuner.tuner != 0)
3339 return -EINVAL;
3340
3341 if (tuner.mode != VIDEO_MODE_AUTO)
3342 return -EINVAL;
3343
3344 DBG(5, "VIDIOCSTUNER successfully called")
3345 return 0;
3346 }
3347
3348 case VIDIOCSFBUF:
3349 case VIDIOCCAPTURE:
3350 case VIDIOCGFREQ:
3351 case VIDIOCSFREQ:
3352 case VIDIOCGAUDIO:
3353 case VIDIOCSAUDIO:
3354 case VIDIOCSPLAYMODE:
3355 case VIDIOCSWRITEMODE:
3356 case VIDIOCGPLAYINFO:
3357 case VIDIOCSMICROCODE:
3358 case VIDIOCGVBIFMT:
3359 case VIDIOCSVBIFMT:
3360 DBG(4, "Unsupported V4L1 IOCtl: VIDIOC%s "
3361 "(type 0x%01X, "
3362 "n. 0x%01X, "
d56410e0 3363 "dir. 0x%01X, "
1da177e4
LT		 3364 "size 0x%02X)",
3365 V4L1_IOCTL(cmd),
3366 _IOC_TYPE(cmd),_IOC_NR(cmd),_IOC_DIR(cmd),_IOC_SIZE(cmd))
3367
3368 return -EINVAL;
3369
3370 default:
3371 DBG(4, "Invalid V4L1 IOCtl: VIDIOC%s "
3372 "type 0x%01X, "
3373 "n. 0x%01X, "
3374 "dir. 0x%01X, "
3375 "size 0x%02X",
3376 V4L1_IOCTL(cmd),
3377 _IOC_TYPE(cmd),_IOC_NR(cmd),_IOC_DIR(cmd),_IOC_SIZE(cmd))
3378
3379 return -ENOIOCTLCMD;
3380
3381 } /* end of switch */
3382
3383ioctl_fail:
3384 cam->misconfigured = 1;
3385 DBG(1, "VIDIOC%s failed because of hardware problems. "
3386 "To use the camera, close and open it again.", V4L1_IOCTL(cmd))
3387 return -EFAULT;
3388}
3389
3390
bec43661 3391static const struct v4l2_file_operations w9968cf_fops = {
1da177e4
LT		 3392 .owner = THIS_MODULE,
3393 .open = w9968cf_open,
3394 .release = w9968cf_release,
3395 .read = w9968cf_read,
3396 .ioctl = w9968cf_ioctl,
3397 .mmap = w9968cf_mmap,
1da177e4
LT		 3398};
3399
3400
3401
3402/****************************************************************************
3403 * USB probe and V4L registration, disconnect and id_table[] definition *
3404 ****************************************************************************/
3405
3406static int
3407w9968cf_usb_probe(struct usb_interface* intf, const struct usb_device_id* id)
3408{
3409 struct usb_device *udev = interface_to_usbdev(intf);
3410 struct w9968cf_device* cam;
3411 int err = 0;
3412 enum w9968cf_model_id mod_id;
3413 struct list_head* ptr;
3414 u8 sc = 0; /* number of simultaneous cameras */
ff699e6b 3415 static unsigned short dev_nr; /* 0 - we are handling device number n */
3160fbc5
HV		 3416 static unsigned short addrs[] = {
3417 OV7xx0_SID,
3418 OV6xx0_SID,
3419 I2C_CLIENT_END
3420 };
1da177e4
LT		 3421
3422 if (le16_to_cpu(udev->descriptor.idVendor) == winbond_id_table[0].idVendor &&
3423 le16_to_cpu(udev->descriptor.idProduct) == winbond_id_table[0].idProduct)
3424 mod_id = W9968CF_MOD_CLVBWGP; /* see camlist[] table */
3425 else if (le16_to_cpu(udev->descriptor.idVendor) == winbond_id_table[1].idVendor &&
d56410e0 3426 le16_to_cpu(udev->descriptor.idProduct) == winbond_id_table[1].idProduct)
1da177e4
LT		 3427 mod_id = W9968CF_MOD_GENERIC; /* see camlist[] table */
3428 else
3429 return -ENODEV;
3430
3431 cam = (struct w9968cf_device*)
d56410e0 3432 kzalloc(sizeof(struct w9968cf_device), GFP_KERNEL);
1da177e4
LT		 3433 if (!cam)
3434 return -ENOMEM;
3435
119753a4 3436 err = v4l2_device_register(&intf->dev, &cam->v4l2_dev);
4e06839f
HV		 3437 if (err)
3438 goto fail0;
3439
4186ecf8
AV		 3440 mutex_init(&cam->dev_mutex);
3441 mutex_lock(&cam->dev_mutex);
1da177e4
LT		 3442
3443 cam->usbdev = udev;
1da177e4
LT		 3444
3445 DBG(2, "%s detected", symbolic(camlist, mod_id))
3446
3447 if (simcams > W9968CF_MAX_DEVICES)
3448 simcams = W9968CF_SIMCAMS;
3449
3450 /* How many cameras are connected ? */
4186ecf8 3451 mutex_lock(&w9968cf_devlist_mutex);
1da177e4
LT		 3452 list_for_each(ptr, &w9968cf_dev_list)
3453 sc++;
4186ecf8 3454 mutex_unlock(&w9968cf_devlist_mutex);
1da177e4
LT		 3455
3456 if (sc >= simcams) {
3457 DBG(2, "Device rejected: too many connected cameras "
3458 "(max. %u)", simcams)
3459 err = -EPERM;
3460 goto fail;
3461 }
3462
3463
3464 /* Allocate 2 bytes of memory for camera control USB transfers */
b10b4177 3465 if (!(cam->control_buffer = kzalloc(2, GFP_KERNEL))) {
1da177e4
LT		 3466 DBG(1,"Couldn't allocate memory for camera control transfers")
3467 err = -ENOMEM;
3468 goto fail;
3469 }
1da177e4
LT		 3470
3471 /* Allocate 8 bytes of memory for USB data transfers to the FSB */
b10b4177 3472 if (!(cam->data_buffer = kzalloc(8, GFP_KERNEL))) {
1da177e4
LT		 3473 DBG(1, "Couldn't allocate memory for data "
3474 "transfers to the FSB")
3475 err = -ENOMEM;
3476 goto fail;
3477 }
1da177e4
LT		 3478
3479 /* Register the V4L device */
3480 cam->v4ldev = video_device_alloc();
3481 if (!cam->v4ldev) {
3482 DBG(1, "Could not allocate memory for a V4L structure")
3483 err = -ENOMEM;
3484 goto fail;
3485 }
3486
3487 strcpy(cam->v4ldev->name, symbolic(camlist, mod_id));
1da177e4
LT		 3488 cam->v4ldev->fops = &w9968cf_fops;
3489 cam->v4ldev->minor = video_nr[dev_nr];
3490 cam->v4ldev->release = video_device_release;
3491 video_set_drvdata(cam->v4ldev, cam);
4e06839f 3492 cam->v4ldev->v4l2_dev = &cam->v4l2_dev;
1da177e4
LT		 3493
3494 err = video_register_device(cam->v4ldev, VFL_TYPE_GRABBER,
d56410e0 3495 video_nr[dev_nr]);
1da177e4
LT		 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
c6330fb8 3505 DBG(2, "V4L device registered as /dev/video%d", cam->v4ldev->num)
1da177e4
LT		 3506
3507 /* Set some basic constants */
3508 w9968cf_configure_camera(cam, udev, mod_id, dev_nr);
3509
3510 /* Add a new entry into the list of V4L registered devices */
4186ecf8 3511 mutex_lock(&w9968cf_devlist_mutex);
1da177e4 3512 list_add(&cam->v4llist, &w9968cf_dev_list);
4186ecf8 3513 mutex_unlock(&w9968cf_devlist_mutex);
1da177e4
LT		 3514 dev_nr = (dev_nr < W9968CF_MAX_DEVICES-1) ? dev_nr+1 : 0;
3515
3516 w9968cf_turn_on_led(cam);
3517
3518 w9968cf_i2c_init(cam);
e6574f2f
HV		 3519 cam->sensor_sd = v4l2_i2c_new_probed_subdev(&cam->v4l2_dev,
3520 &cam->i2c_adapter,
3160fbc5 3521 "ovcamchip", "ovcamchip", addrs);
1da177e4
LT		 3522
3523 usb_set_intfdata(intf, cam);
4186ecf8 3524 mutex_unlock(&cam->dev_mutex);
4e06839f 3525
3160fbc5 3526 err = w9968cf_sensor_init(cam);
1da177e4
LT		 3527 return 0;
3528
3529fail: /* Free unused memory */
1bc3c9e1
JJ		 3530 kfree(cam->control_buffer);
3531 kfree(cam->data_buffer);
1da177e4
LT		 3532 if (cam->v4ldev)
3533 video_device_release(cam->v4ldev);
4186ecf8 3534 mutex_unlock(&cam->dev_mutex);
4e06839f
HV		 3535 v4l2_device_unregister(&cam->v4l2_dev);
3536fail0:
1da177e4
LT		 3537 kfree(cam);
3538 return err;
3539}
3540
3541
3542static void w9968cf_usb_disconnect(struct usb_interface* intf)
3543{
d56410e0 3544 struct w9968cf_device* cam =
1da177e4
LT		 3545 (struct w9968cf_device*)usb_get_intfdata(intf);
3546
1da177e4 3547 if (cam) {
3160fbc5 3548 down_write(&w9968cf_disconnect);
1da177e4 3549 /* Prevent concurrent accesses to data */
4186ecf8 3550 mutex_lock(&cam->dev_mutex);
1da177e4
LT		 3551
3552 cam->disconnected = 1;
3553
f1ba28c3
HV		 3554 DBG(2, "Disconnecting %s...", symbolic(camlist, cam->id));
3555
3556 v4l2_device_disconnect(&cam->v4l2_dev);
1da177e4
LT		 3557
3558 wake_up_interruptible_all(&cam->open);
3559
3560 if (cam->users) {
3561 DBG(2, "The device is open (/dev/video%d)! "
3562 "Process name: %s. Deregistration and memory "
3563 "deallocation are deferred on close.",
c6330fb8 3564 cam->v4ldev->num, cam->command)
1da177e4
LT		 3565 cam->misconfigured = 1;
3566 w9968cf_stop_transfer(cam);
3567 wake_up_interruptible(&cam->wait_queue);
3568 } else
3569 w9968cf_release_resources(cam);
3570
4186ecf8 3571 mutex_unlock(&cam->dev_mutex);
3160fbc5 3572 up_write(&w9968cf_disconnect);
1da177e4 3573
4e06839f 3574 if (!cam->users) {
1da177e4 3575 kfree(cam);
4e06839f 3576 }
1da177e4 3577 }
1da177e4
LT		 3578}
3579
3580
3581static struct usb_driver w9968cf_usb_driver = {
1da177e4
LT		 3582 .name = "w9968cf",
3583 .id_table = winbond_id_table,
3584 .probe = w9968cf_usb_probe,
3585 .disconnect = w9968cf_usb_disconnect,
3586};
3587
3588
3589
3590/****************************************************************************
3591 * Module init, exit and intermodule communication *
3592 ****************************************************************************/
3593
1da177e4
LT		 3594static int __init w9968cf_module_init(void)
3595{
3596 int err;
3597
3598 KDBG(2, W9968CF_MODULE_NAME" "W9968CF_MODULE_VERSION)
3599 KDBG(3, W9968CF_MODULE_AUTHOR)
3600
1da177e4
LT		 3601 if ((err = usb_register(&w9968cf_usb_driver)))
3602 return err;
3603
3604 return 0;
3605}
3606
3607
3608static void __exit w9968cf_module_exit(void)
3609{
3610 /* w9968cf_usb_disconnect() will be called */
3611 usb_deregister(&w9968cf_usb_driver);
3612
3613 KDBG(2, W9968CF_MODULE_NAME" deregistered")
3614}
3615
3616
3617module_init(w9968cf_module_init);
3618module_exit(w9968cf_module_exit);
3619
Linux kernel - Deliverables
This page took 0.799991 seconds and 5 git commands to generate.