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