blob: 97319efc99482862dc0da0e4923c8cee1e3be018 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* Linux driver for Philips webcam
2 USB and Video4Linux interface part.
3 (C) 1999-2004 Nemosoft Unv.
Luc Saillard2b455db2006-04-24 10:29:46 -03004 (C) 2004-2006 Luc Saillard (luc@saillard.org)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005
6 NOTE: this version of pwc is an unofficial (modified) release of pwc & pcwx
7 driver and thus may have bugs that are not present in the original version.
8 Please send bug reports and support requests to <luc@saillard.org>.
9 The decompression routines have been implemented by reverse-engineering the
10 Nemosoft binary pwcx module. Caveat emptor.
11
12 This program is free software; you can redistribute it and/or modify
13 it under the terms of the GNU General Public License as published by
14 the Free Software Foundation; either version 2 of the License, or
15 (at your option) any later version.
16
17 This program is distributed in the hope that it will be useful,
18 but WITHOUT ANY WARRANTY; without even the implied warranty of
19 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 GNU General Public License for more details.
21
22 You should have received a copy of the GNU General Public License
23 along with this program; if not, write to the Free Software
24 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
25
26*/
27
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030028/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070029 This code forms the interface between the USB layers and the Philips
30 specific stuff. Some adanved stuff of the driver falls under an
31 NDA, signed between me and Philips B.V., Eindhoven, the Netherlands, and
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030032 is thus not distributed in source form. The binary pwcx.o module
Linus Torvalds1da177e2005-04-16 15:20:36 -070033 contains the code that falls under the NDA.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030034
35 In case you're wondering: 'pwc' stands for "Philips WebCam", but
Linus Torvalds1da177e2005-04-16 15:20:36 -070036 I really didn't want to type 'philips_web_cam' every time (I'm lazy as
37 any Linux kernel hacker, but I don't like uncomprehensible abbreviations
38 without explanation).
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030039
Linus Torvalds1da177e2005-04-16 15:20:36 -070040 Oh yes, convention: to disctinguish between all the various pointers to
41 device-structures, I use these names for the pointer variables:
42 udev: struct usb_device *
43 vdev: struct video_device *
44 pdev: struct pwc_devive *
45*/
46
47/* Contributors:
48 - Alvarado: adding whitebalance code
49 - Alistar Moire: QuickCam 3000 Pro device/product ID
50 - Tony Hoyle: Creative Labs Webcam 5 device/product ID
51 - Mark Burazin: solving hang in VIDIOCSYNC when camera gets unplugged
52 - Jk Fang: Sotec Afina Eye ID
53 - Xavier Roche: QuickCam Pro 4000 ID
54 - Jens Knudsen: QuickCam Zoom ID
55 - J. Debert: QuickCam for Notebooks ID
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -030056 - Pham Thanh Nam: webcam snapshot button as an event input device
Linus Torvalds1da177e2005-04-16 15:20:36 -070057*/
58
59#include <linux/errno.h>
60#include <linux/init.h>
61#include <linux/mm.h>
62#include <linux/module.h>
63#include <linux/poll.h>
64#include <linux/slab.h>
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -030065#ifdef CONFIG_USB_PWC_INPUT_EVDEV
66#include <linux/usb/input.h>
67#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -070068#include <linux/vmalloc.h>
69#include <asm/io.h>
Andy Shevchenko2d8d7762009-09-24 07:58:09 -030070#include <linux/kernel.h> /* simple_strtol() */
Linus Torvalds1da177e2005-04-16 15:20:36 -070071
72#include "pwc.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070073#include "pwc-kiara.h"
74#include "pwc-timon.h"
Luc Saillard2b455db2006-04-24 10:29:46 -030075#include "pwc-dec23.h"
76#include "pwc-dec1.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070077#include "pwc-uncompress.h"
78
79/* Function prototypes and driver templates */
80
81/* hotplug device table support */
Luc Saillard2b455db2006-04-24 10:29:46 -030082static const struct usb_device_id pwc_device_table [] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -070083 { USB_DEVICE(0x0471, 0x0302) }, /* Philips models */
84 { USB_DEVICE(0x0471, 0x0303) },
85 { USB_DEVICE(0x0471, 0x0304) },
86 { USB_DEVICE(0x0471, 0x0307) },
87 { USB_DEVICE(0x0471, 0x0308) },
88 { USB_DEVICE(0x0471, 0x030C) },
89 { USB_DEVICE(0x0471, 0x0310) },
Luc Saillard2b455db2006-04-24 10:29:46 -030090 { USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
Linus Torvalds1da177e2005-04-16 15:20:36 -070091 { USB_DEVICE(0x0471, 0x0312) },
92 { USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
Luc Saillard2b455db2006-04-24 10:29:46 -030093 { USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 { USB_DEVICE(0x069A, 0x0001) }, /* Askey */
95 { USB_DEVICE(0x046D, 0x08B0) }, /* Logitech QuickCam Pro 3000 */
96 { USB_DEVICE(0x046D, 0x08B1) }, /* Logitech QuickCam Notebook Pro */
97 { USB_DEVICE(0x046D, 0x08B2) }, /* Logitech QuickCam Pro 4000 */
98 { USB_DEVICE(0x046D, 0x08B3) }, /* Logitech QuickCam Zoom (old model) */
99 { USB_DEVICE(0x046D, 0x08B4) }, /* Logitech QuickCam Zoom (new model) */
100 { USB_DEVICE(0x046D, 0x08B5) }, /* Logitech QuickCam Orbit/Sphere */
Mauro Carvalho Chehab6b1ce3c2007-03-21 16:35:28 -0300101 { USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
102 { USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 { USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
Luc Saillard2b455db2006-04-24 10:29:46 -0300104 { USB_DEVICE(0x055D, 0x9000) }, /* Samsung MPC-C10 */
105 { USB_DEVICE(0x055D, 0x9001) }, /* Samsung MPC-C30 */
106 { USB_DEVICE(0x055D, 0x9002) }, /* Samsung SNC-35E (Ver3.0) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 { USB_DEVICE(0x041E, 0x400C) }, /* Creative Webcam 5 */
108 { USB_DEVICE(0x041E, 0x4011) }, /* Creative Webcam Pro Ex */
109 { USB_DEVICE(0x04CC, 0x8116) }, /* Afina Eye */
110 { USB_DEVICE(0x06BE, 0x8116) }, /* new Afina Eye */
111 { USB_DEVICE(0x0d81, 0x1910) }, /* Visionite */
112 { USB_DEVICE(0x0d81, 0x1900) },
113 { }
114};
115MODULE_DEVICE_TABLE(usb, pwc_device_table);
116
117static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
118static void usb_pwc_disconnect(struct usb_interface *intf);
119
120static struct usb_driver pwc_driver = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121 .name = "Philips webcam", /* name */
122 .id_table = pwc_device_table,
123 .probe = usb_pwc_probe, /* probe() */
124 .disconnect = usb_pwc_disconnect, /* disconnect() */
125};
126
127#define MAX_DEV_HINTS 20
128#define MAX_ISOC_ERRORS 20
129
130static int default_size = PSZ_QCIF;
131static int default_fps = 10;
132static int default_fbufs = 3; /* Default number of frame buffers */
Michael Krufkyb930e1d2007-08-27 18:16:54 -0300133 int pwc_mbufs = 2; /* Default number of mmap() buffers */
Trent Piepho05ad3902007-01-30 23:26:01 -0300134#ifdef CONFIG_USB_PWC_DEBUG
Michael Krufkyb930e1d2007-08-27 18:16:54 -0300135 int pwc_trace = PWC_DEBUG_LEVEL;
Luc Saillard2b455db2006-04-24 10:29:46 -0300136#endif
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -0300137static int power_save;
138static int led_on = 100, led_off; /* defaults to LED that is on while in use */
Adrian Bunkb20c3cf2006-06-23 06:49:34 -0300139static int pwc_preferred_compression = 1; /* 0..3 = uncompressed..high */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140static struct {
141 int type;
142 char serial_number[30];
143 int device_node;
144 struct pwc_device *pdev;
145} device_hint[MAX_DEV_HINTS];
146
147/***/
148
Hans Verkuilbec43662008-12-30 06:58:20 -0300149static int pwc_video_open(struct file *file);
150static int pwc_video_close(struct file *file);
Luc Saillard2b455db2006-04-24 10:29:46 -0300151static ssize_t pwc_video_read(struct file *file, char __user *buf,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 size_t count, loff_t *ppos);
153static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
Hans Verkuil069b7472008-12-30 07:04:34 -0300154static long pwc_video_ioctl(struct file *file,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 unsigned int ioctlnr, unsigned long arg);
156static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma);
157
Hans Verkuilbec43662008-12-30 06:58:20 -0300158static const struct v4l2_file_operations pwc_fops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 .owner = THIS_MODULE,
160 .open = pwc_video_open,
161 .release = pwc_video_close,
162 .read = pwc_video_read,
163 .poll = pwc_video_poll,
164 .mmap = pwc_video_mmap,
Hans Verkuil7074f402010-09-15 14:49:07 -0300165 .unlocked_ioctl = pwc_video_ioctl,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166};
167static struct video_device pwc_template = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168 .name = "Philips Webcam", /* Filled in later */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169 .release = video_device_release,
170 .fops = &pwc_fops,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171};
172
173/***************************************************************************/
174
175/* Okay, this is some magic that I worked out and the reasoning behind it...
176
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300177 The biggest problem with any USB device is of course: "what to do
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178 when the user unplugs the device while it is in use by an application?"
179 We have several options:
180 1) Curse them with the 7 plagues when they do (requires divine intervention)
181 2) Tell them not to (won't work: they'll do it anyway)
182 3) Oops the kernel (this will have a negative effect on a user's uptime)
183 4) Do something sensible.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300184
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 Of course, we go for option 4.
186
187 It happens that this device will be linked to two times, once from
188 usb_device and once from the video_device in their respective 'private'
189 pointers. This is done when the device is probed() and all initialization
190 succeeded. The pwc_device struct links back to both structures.
191
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300192 When a device is unplugged while in use it will be removed from the
193 list of known USB devices; I also de-register it as a V4L device, but
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 unfortunately I can't free the memory since the struct is still in use
195 by the file descriptor. This free-ing is then deferend until the first
196 opportunity. Crude, but it works.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300197
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 A small 'advantage' is that if a user unplugs the cam and plugs it back
199 in, it should get assigned the same video device minor, but unfortunately
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300200 it's non-trivial to re-link the cam back to the video device... (that
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 would surely be magic! :))
202*/
203
204/***************************************************************************/
205/* Private functions */
206
207/* Here we want the physical address of the memory.
208 * This is used when initializing the contents of the area.
209 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211
Luc Saillard2b455db2006-04-24 10:29:46 -0300212
213static void *pwc_rvmalloc(unsigned long size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214{
215 void * mem;
216 unsigned long adr;
217
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300218 mem=vmalloc_32(size);
Luc Saillard2b455db2006-04-24 10:29:46 -0300219 if (!mem)
220 return NULL;
221
222 memset(mem, 0, size); /* Clear the ram out, no junk to the user */
223 adr=(unsigned long) mem;
224 while (size > 0)
225 {
226 SetPageReserved(vmalloc_to_page((void *)adr));
227 adr += PAGE_SIZE;
228 size -= PAGE_SIZE;
229 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230 return mem;
231}
232
Luc Saillard2b455db2006-04-24 10:29:46 -0300233static void pwc_rvfree(void * mem, unsigned long size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234{
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300235 unsigned long adr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236
Luc Saillard2b455db2006-04-24 10:29:46 -0300237 if (!mem)
238 return;
239
240 adr=(unsigned long) mem;
241 while ((long) size > 0)
242 {
243 ClearPageReserved(vmalloc_to_page((void *)adr));
244 adr += PAGE_SIZE;
245 size -= PAGE_SIZE;
246 }
247 vfree(mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248}
249
250
251
252
253static int pwc_allocate_buffers(struct pwc_device *pdev)
254{
Luc Saillard2b455db2006-04-24 10:29:46 -0300255 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 void *kbuf;
257
Luc Saillard2b455db2006-04-24 10:29:46 -0300258 PWC_DEBUG_MEMORY(">> pwc_allocate_buffers(pdev = 0x%p)\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259
260 if (pdev == NULL)
261 return -ENXIO;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300262
Luc Saillard2b455db2006-04-24 10:29:46 -0300263 /* Allocate Isochronuous pipe buffers */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 for (i = 0; i < MAX_ISO_BUFS; i++) {
265 if (pdev->sbuf[i].data == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300266 kbuf = kzalloc(ISO_BUFFER_SIZE, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300268 PWC_ERROR("Failed to allocate iso buffer %d.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 return -ENOMEM;
270 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300271 PWC_DEBUG_MEMORY("Allocated iso buffer at %p.\n", kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 pdev->sbuf[i].data = kbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273 }
274 }
275
276 /* Allocate frame buffer structure */
277 if (pdev->fbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300278 kbuf = kzalloc(default_fbufs * sizeof(struct pwc_frame_buf), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300280 PWC_ERROR("Failed to allocate frame buffer structure.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281 return -ENOMEM;
282 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300283 PWC_DEBUG_MEMORY("Allocated frame buffer structure at %p.\n", kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284 pdev->fbuf = kbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300286
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 /* create frame buffers, and make circular ring */
288 for (i = 0; i < default_fbufs; i++) {
289 if (pdev->fbuf[i].data == NULL) {
Joe Perches101b25b2010-11-05 00:07:39 -0300290 kbuf = vzalloc(PWC_FRAME_SIZE); /* need vmalloc since frame buffer > 128K */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300292 PWC_ERROR("Failed to allocate frame buffer %d.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 return -ENOMEM;
294 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300295 PWC_DEBUG_MEMORY("Allocated frame buffer %d at %p.\n", i, kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 pdev->fbuf[i].data = kbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297 }
298 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300299
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 /* Allocate decompressor table space */
Luc Saillard2b455db2006-04-24 10:29:46 -0300301 if (DEVICE_USE_CODEC1(pdev->type))
302 err = pwc_dec1_alloc(pdev);
303 else
304 err = pwc_dec23_alloc(pdev);
305
306 if (err) {
307 PWC_ERROR("Failed to allocate decompress table.\n");
308 return err;
309 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300310
Linus Torvalds1da177e2005-04-16 15:20:36 -0700311 /* Allocate image buffer; double buffer for mmap() */
Luc Saillard2b455db2006-04-24 10:29:46 -0300312 kbuf = pwc_rvmalloc(pwc_mbufs * pdev->len_per_image);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300314 PWC_ERROR("Failed to allocate image buffer(s). needed (%d)\n",
315 pwc_mbufs * pdev->len_per_image);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 return -ENOMEM;
317 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300318 PWC_DEBUG_MEMORY("Allocated image buffer at %p.\n", kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319 pdev->image_data = kbuf;
Luc Saillard2b455db2006-04-24 10:29:46 -0300320 for (i = 0; i < pwc_mbufs; i++) {
321 pdev->images[i].offset = i * pdev->len_per_image;
322 pdev->images[i].vma_use_count = 0;
323 }
324 for (; i < MAX_IMAGES; i++) {
325 pdev->images[i].offset = 0;
326 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327
328 kbuf = NULL;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300329
Luc Saillard2b455db2006-04-24 10:29:46 -0300330 PWC_DEBUG_MEMORY("<< pwc_allocate_buffers()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 return 0;
332}
333
334static void pwc_free_buffers(struct pwc_device *pdev)
335{
336 int i;
337
Luc Saillard2b455db2006-04-24 10:29:46 -0300338 PWC_DEBUG_MEMORY("Entering free_buffers(%p).\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339
340 if (pdev == NULL)
341 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 /* Release Iso-pipe buffers */
343 for (i = 0; i < MAX_ISO_BUFS; i++)
344 if (pdev->sbuf[i].data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300345 PWC_DEBUG_MEMORY("Freeing ISO buffer at %p.\n", pdev->sbuf[i].data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346 kfree(pdev->sbuf[i].data);
347 pdev->sbuf[i].data = NULL;
348 }
349
350 /* The same for frame buffers */
351 if (pdev->fbuf != NULL) {
352 for (i = 0; i < default_fbufs; i++) {
353 if (pdev->fbuf[i].data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300354 PWC_DEBUG_MEMORY("Freeing frame buffer %d at %p.\n", i, pdev->fbuf[i].data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355 vfree(pdev->fbuf[i].data);
356 pdev->fbuf[i].data = NULL;
357 }
358 }
359 kfree(pdev->fbuf);
360 pdev->fbuf = NULL;
361 }
362
363 /* Intermediate decompression buffer & tables */
364 if (pdev->decompress_data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300365 PWC_DEBUG_MEMORY("Freeing decompression buffer at %p.\n", pdev->decompress_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366 kfree(pdev->decompress_data);
367 pdev->decompress_data = NULL;
368 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369
370 /* Release image buffers */
371 if (pdev->image_data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300372 PWC_DEBUG_MEMORY("Freeing image buffer at %p.\n", pdev->image_data);
373 pwc_rvfree(pdev->image_data, pwc_mbufs * pdev->len_per_image);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374 }
375 pdev->image_data = NULL;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300376
Luc Saillard2b455db2006-04-24 10:29:46 -0300377 PWC_DEBUG_MEMORY("Leaving free_buffers().\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378}
379
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300380/* The frame & image buffer mess.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381
382 Yes, this is a mess. Well, it used to be simple, but alas... In this
383 module, 3 buffers schemes are used to get the data from the USB bus to
384 the user program. The first scheme involves the ISO buffers (called thus
385 since they transport ISO data from the USB controller), and not really
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300386 interesting. Suffices to say the data from this buffer is quickly
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 gathered in an interrupt handler (pwc_isoc_handler) and placed into the
388 frame buffer.
389
390 The frame buffer is the second scheme, and is the central element here.
391 It collects the data from a single frame from the camera (hence, the
392 name). Frames are delimited by the USB camera with a short USB packet,
393 so that's easy to detect. The frame buffers form a list that is filled
394 by the camera+USB controller and drained by the user process through
395 either read() or mmap().
396
397 The image buffer is the third scheme, in which frames are decompressed
398 and converted into planar format. For mmap() there is more than
399 one image buffer available.
400
401 The frame buffers provide the image buffering. In case the user process
402 is a bit slow, this introduces lag and some undesired side-effects.
403 The problem arises when the frame buffer is full. I used to drop the last
404 frame, which makes the data in the queue stale very quickly. But dropping
405 the frame at the head of the queue proved to be a litte bit more difficult.
406 I tried a circular linked scheme, but this introduced more problems than
407 it solved.
408
409 Because filling and draining are completely asynchronous processes, this
410 requires some fiddling with pointers and mutexes.
411
412 Eventually, I came up with a system with 2 lists: an 'empty' frame list
413 and a 'full' frame list:
414 * Initially, all frame buffers but one are on the 'empty' list; the one
415 remaining buffer is our initial fill frame.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300416 * If a frame is needed for filling, we try to take it from the 'empty'
417 list, unless that list is empty, in which case we take the buffer at
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 the head of the 'full' list.
419 * When our fill buffer has been filled, it is appended to the 'full'
420 list.
421 * If a frame is needed by read() or mmap(), it is taken from the head of
422 the 'full' list, handled, and then appended to the 'empty' list. If no
423 buffer is present on the 'full' list, we wait.
424 The advantage is that the buffer that is currently being decompressed/
425 converted, is on neither list, and thus not in our way (any other scheme
426 I tried had the problem of old data lingering in the queue).
427
428 Whatever strategy you choose, it always remains a tradeoff: with more
429 frame buffers the chances of a missed frame are reduced. On the other
430 hand, on slower machines it introduces lag because the queue will
431 always be full.
432 */
433
434/**
435 \brief Find next frame buffer to fill. Take from empty or full list, whichever comes first.
436 */
Luc Saillard2b455db2006-04-24 10:29:46 -0300437static int pwc_next_fill_frame(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438{
439 int ret;
440 unsigned long flags;
441
442 ret = 0;
443 spin_lock_irqsave(&pdev->ptrlock, flags);
444 if (pdev->fill_frame != NULL) {
445 /* append to 'full' list */
446 if (pdev->full_frames == NULL) {
447 pdev->full_frames = pdev->fill_frame;
448 pdev->full_frames_tail = pdev->full_frames;
449 }
450 else {
451 pdev->full_frames_tail->next = pdev->fill_frame;
452 pdev->full_frames_tail = pdev->fill_frame;
453 }
454 }
455 if (pdev->empty_frames != NULL) {
456 /* We have empty frames available. That's easy */
457 pdev->fill_frame = pdev->empty_frames;
458 pdev->empty_frames = pdev->empty_frames->next;
459 }
460 else {
461 /* Hmm. Take it from the full list */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700462 /* sanity check */
463 if (pdev->full_frames == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300464 PWC_ERROR("Neither empty or full frames available!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465 spin_unlock_irqrestore(&pdev->ptrlock, flags);
466 return -EINVAL;
467 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 pdev->fill_frame = pdev->full_frames;
469 pdev->full_frames = pdev->full_frames->next;
470 ret = 1;
471 }
472 pdev->fill_frame->next = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473 spin_unlock_irqrestore(&pdev->ptrlock, flags);
474 return ret;
475}
476
477
478/**
479 \brief Reset all buffers, pointers and lists, except for the image_used[] buffer.
480
481 If the image_used[] buffer is cleared too, mmap()/VIDIOCSYNC will run into trouble.
482 */
483static void pwc_reset_buffers(struct pwc_device *pdev)
484{
485 int i;
486 unsigned long flags;
487
Harvey Harrison645635b2008-04-08 23:20:00 -0300488 PWC_DEBUG_MEMORY(">> %s __enter__\n", __func__);
Luc Saillard2b455db2006-04-24 10:29:46 -0300489
Linus Torvalds1da177e2005-04-16 15:20:36 -0700490 spin_lock_irqsave(&pdev->ptrlock, flags);
491 pdev->full_frames = NULL;
492 pdev->full_frames_tail = NULL;
493 for (i = 0; i < default_fbufs; i++) {
494 pdev->fbuf[i].filled = 0;
495 if (i > 0)
496 pdev->fbuf[i].next = &pdev->fbuf[i - 1];
497 else
498 pdev->fbuf->next = NULL;
499 }
500 pdev->empty_frames = &pdev->fbuf[default_fbufs - 1];
501 pdev->empty_frames_tail = pdev->fbuf;
502 pdev->read_frame = NULL;
503 pdev->fill_frame = pdev->empty_frames;
504 pdev->empty_frames = pdev->empty_frames->next;
505
506 pdev->image_read_pos = 0;
507 pdev->fill_image = 0;
508 spin_unlock_irqrestore(&pdev->ptrlock, flags);
Luc Saillard2b455db2006-04-24 10:29:46 -0300509
Harvey Harrison645635b2008-04-08 23:20:00 -0300510 PWC_DEBUG_MEMORY("<< %s __leaving__\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511}
512
513
514/**
515 \brief Do all the handling for getting one frame: get pointer, decompress, advance pointers.
516 */
Luc Saillard2b455db2006-04-24 10:29:46 -0300517int pwc_handle_frame(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518{
519 int ret = 0;
520 unsigned long flags;
521
522 spin_lock_irqsave(&pdev->ptrlock, flags);
523 /* First grab our read_frame; this is removed from all lists, so
524 we can release the lock after this without problems */
525 if (pdev->read_frame != NULL) {
526 /* This can't theoretically happen */
Luc Saillard2b455db2006-04-24 10:29:46 -0300527 PWC_ERROR("Huh? Read frame still in use?\n");
528 spin_unlock_irqrestore(&pdev->ptrlock, flags);
529 return ret;
530 }
531
532
533 if (pdev->full_frames == NULL) {
534 PWC_ERROR("Woops. No frames ready.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 }
536 else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300537 pdev->read_frame = pdev->full_frames;
538 pdev->full_frames = pdev->full_frames->next;
539 pdev->read_frame->next = NULL;
540 }
541
542 if (pdev->read_frame != NULL) {
Paulius Zaleckasefad798b2008-02-03 15:42:53 +0200543 /* Decompression is a lengthy process, so it's outside of the lock.
Luc Saillard2b455db2006-04-24 10:29:46 -0300544 This gives the isoc_handler the opportunity to fill more frames
545 in the mean time.
546 */
547 spin_unlock_irqrestore(&pdev->ptrlock, flags);
548 ret = pwc_decompress(pdev);
549 spin_lock_irqsave(&pdev->ptrlock, flags);
550
551 /* We're done with read_buffer, tack it to the end of the empty buffer list */
552 if (pdev->empty_frames == NULL) {
553 pdev->empty_frames = pdev->read_frame;
554 pdev->empty_frames_tail = pdev->empty_frames;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555 }
556 else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300557 pdev->empty_frames_tail->next = pdev->read_frame;
558 pdev->empty_frames_tail = pdev->read_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300560 pdev->read_frame = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 }
562 spin_unlock_irqrestore(&pdev->ptrlock, flags);
563 return ret;
564}
565
566/**
567 \brief Advance pointers of image buffer (after each user request)
568*/
Luc Saillard2b455db2006-04-24 10:29:46 -0300569void pwc_next_image(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570{
571 pdev->image_used[pdev->fill_image] = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300572 pdev->fill_image = (pdev->fill_image + 1) % pwc_mbufs;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573}
574
Luc Saillard2b455db2006-04-24 10:29:46 -0300575/**
576 * Print debug information when a frame is discarded because all of our buffer
577 * is full
578 */
579static void pwc_frame_dumped(struct pwc_device *pdev)
580{
581 pdev->vframes_dumped++;
582 if (pdev->vframe_count < FRAME_LOWMARK)
583 return;
584
585 if (pdev->vframes_dumped < 20)
586 PWC_DEBUG_FLOW("Dumping frame %d\n", pdev->vframe_count);
587 else if (pdev->vframes_dumped == 20)
588 PWC_DEBUG_FLOW("Dumping frame %d (last message)\n",
589 pdev->vframe_count);
590}
591
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300592static void pwc_snapshot_button(struct pwc_device *pdev, int down)
593{
594 if (down) {
595 PWC_TRACE("Snapshot button pressed.\n");
596 pdev->snapshot_button_status = 1;
597 } else {
598 PWC_TRACE("Snapshot button released.\n");
599 }
600
601#ifdef CONFIG_USB_PWC_INPUT_EVDEV
602 if (pdev->button_dev) {
Lennart Poetteringbcd3e4b2009-06-11 11:19:33 -0300603 input_report_key(pdev->button_dev, KEY_CAMERA, down);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300604 input_sync(pdev->button_dev);
605 }
606#endif
607}
608
Luc Saillard2b455db2006-04-24 10:29:46 -0300609static int pwc_rcv_short_packet(struct pwc_device *pdev, const struct pwc_frame_buf *fbuf)
610{
611 int awake = 0;
612
613 /* The ToUCam Fun CMOS sensor causes the firmware to send 2 or 3 bogus
614 frames on the USB wire after an exposure change. This conditition is
615 however detected in the cam and a bit is set in the header.
616 */
617 if (pdev->type == 730) {
618 unsigned char *ptr = (unsigned char *)fbuf->data;
619
620 if (ptr[1] == 1 && ptr[0] & 0x10) {
621 PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
622 pdev->drop_frames += 2;
623 pdev->vframes_error++;
624 }
625 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300626 pwc_snapshot_button(pdev, ptr[0] & 0x01);
Luc Saillard2b455db2006-04-24 10:29:46 -0300627 }
628 if ((ptr[0] ^ pdev->vmirror) & 0x02) {
629 if (ptr[0] & 0x02)
630 PWC_TRACE("Image is mirrored.\n");
631 else
632 PWC_TRACE("Image is normal.\n");
633 }
634 pdev->vmirror = ptr[0] & 0x03;
635 /* Sometimes the trailer of the 730 is still sent as a 4 byte packet
636 after a short frame; this condition is filtered out specifically. A 4 byte
637 frame doesn't make sense anyway.
638 So we get either this sequence:
639 drop_bit set -> 4 byte frame -> short frame -> good frame
640 Or this one:
641 drop_bit set -> short frame -> good frame
642 So we drop either 3 or 2 frames in all!
643 */
644 if (fbuf->filled == 4)
645 pdev->drop_frames++;
646 }
647 else if (pdev->type == 740 || pdev->type == 720) {
648 unsigned char *ptr = (unsigned char *)fbuf->data;
649 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300650 pwc_snapshot_button(pdev, ptr[0] & 0x01);
Luc Saillard2b455db2006-04-24 10:29:46 -0300651 }
652 pdev->vmirror = ptr[0] & 0x03;
653 }
654
655 /* In case we were instructed to drop the frame, do so silently.
656 The buffer pointers are not updated either (but the counters are reset below).
657 */
658 if (pdev->drop_frames > 0)
659 pdev->drop_frames--;
660 else {
661 /* Check for underflow first */
662 if (fbuf->filled < pdev->frame_total_size) {
663 PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
664 " discarded.\n", fbuf->filled);
665 pdev->vframes_error++;
666 }
667 else {
668 /* Send only once per EOF */
669 awake = 1; /* delay wake_ups */
670
671 /* Find our next frame to fill. This will always succeed, since we
672 * nick a frame from either empty or full list, but if we had to
673 * take it from the full list, it means a frame got dropped.
674 */
675 if (pwc_next_fill_frame(pdev))
676 pwc_frame_dumped(pdev);
677
678 }
679 } /* !drop_frames */
680 pdev->vframe_count++;
681 return awake;
682}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683
684/* This gets called for the Isochronous pipe (video). This is done in
685 * interrupt time, so it has to be fast, not crash, and not stall. Neat.
686 */
David Howells7d12e782006-10-05 14:55:46 +0100687static void pwc_isoc_handler(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688{
689 struct pwc_device *pdev;
690 int i, fst, flen;
691 int awake;
692 struct pwc_frame_buf *fbuf;
693 unsigned char *fillptr = NULL, *iso_buf = NULL;
694
695 awake = 0;
696 pdev = (struct pwc_device *)urb->context;
697 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300698 PWC_ERROR("isoc_handler() called with NULL device?!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699 return;
700 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300701
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 if (urb->status == -ENOENT || urb->status == -ECONNRESET) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300703 PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700704 return;
705 }
706 if (urb->status != -EINPROGRESS && urb->status != 0) {
707 const char *errmsg;
708
709 errmsg = "Unknown";
710 switch(urb->status) {
711 case -ENOSR: errmsg = "Buffer error (overrun)"; break;
712 case -EPIPE: errmsg = "Stalled (device not responding)"; break;
713 case -EOVERFLOW: errmsg = "Babble (bad cable?)"; break;
714 case -EPROTO: errmsg = "Bit-stuff error (bad cable?)"; break;
715 case -EILSEQ: errmsg = "CRC/Timeout (could be anything)"; break;
Pete Zaitcev38e2bfc2006-09-18 22:49:02 -0700716 case -ETIME: errmsg = "Device does not respond"; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300718 PWC_DEBUG_FLOW("pwc_isoc_handler() called with status %d [%s].\n", urb->status, errmsg);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300719 /* Give up after a number of contiguous errors on the USB bus.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720 Appearantly something is wrong so we simulate an unplug event.
721 */
722 if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
723 {
Luc Saillard2b455db2006-04-24 10:29:46 -0300724 PWC_INFO("Too many ISOC errors, bailing out.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700725 pdev->error_status = EIO;
726 awake = 1;
727 wake_up_interruptible(&pdev->frameq);
728 }
729 goto handler_end; // ugly, but practical
730 }
731
732 fbuf = pdev->fill_frame;
733 if (fbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300734 PWC_ERROR("pwc_isoc_handler without valid fill frame.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 awake = 1;
736 goto handler_end;
737 }
738 else {
739 fillptr = fbuf->data + fbuf->filled;
740 }
741
742 /* Reset ISOC error counter. We did get here, after all. */
743 pdev->visoc_errors = 0;
744
745 /* vsync: 0 = don't copy data
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300746 1 = sync-hunt
747 2 = synched
Linus Torvalds1da177e2005-04-16 15:20:36 -0700748 */
749 /* Compact data */
750 for (i = 0; i < urb->number_of_packets; i++) {
751 fst = urb->iso_frame_desc[i].status;
752 flen = urb->iso_frame_desc[i].actual_length;
753 iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
754 if (fst == 0) {
755 if (flen > 0) { /* if valid data... */
756 if (pdev->vsync > 0) { /* ...and we are not sync-hunting... */
757 pdev->vsync = 2;
758
759 /* ...copy data to frame buffer, if possible */
760 if (flen + fbuf->filled > pdev->frame_total_size) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300761 PWC_DEBUG_FLOW("Frame buffer overflow (flen = %d, frame_total_size = %d).\n", flen, pdev->frame_total_size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 pdev->vsync = 0; /* Hmm, let's wait for an EOF (end-of-frame) */
763 pdev->vframes_error++;
764 }
765 else {
766 memmove(fillptr, iso_buf, flen);
767 fillptr += flen;
768 }
769 }
770 fbuf->filled += flen;
771 } /* ..flen > 0 */
772
773 if (flen < pdev->vlast_packet_size) {
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300774 /* Shorter packet... We probably have the end of an image-frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700775 wake up read() process and let select()/poll() do something.
776 Decompression is done in user time over there.
Luc Saillard2b455db2006-04-24 10:29:46 -0300777 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700778 if (pdev->vsync == 2) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300779 if (pwc_rcv_short_packet(pdev, fbuf)) {
780 awake = 1;
781 fbuf = pdev->fill_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 }
784 fbuf->filled = 0;
785 fillptr = fbuf->data;
786 pdev->vsync = 1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300787 }
788
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 pdev->vlast_packet_size = flen;
790 } /* ..status == 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791 else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300792 /* This is normally not interesting to the user, unless
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -0300793 * you are really debugging something, default = 0 */
794 static int iso_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 iso_error++;
796 if (iso_error < 20)
Luc Saillard2b455db2006-04-24 10:29:46 -0300797 PWC_DEBUG_FLOW("Iso frame %d of USB has error %d\n", i, fst);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799 }
800
801handler_end:
802 if (awake)
803 wake_up_interruptible(&pdev->frameq);
804
805 urb->dev = pdev->udev;
806 i = usb_submit_urb(urb, GFP_ATOMIC);
807 if (i != 0)
Luc Saillard2b455db2006-04-24 10:29:46 -0300808 PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809}
810
811
Luc Saillard2b455db2006-04-24 10:29:46 -0300812int pwc_isoc_init(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813{
814 struct usb_device *udev;
815 struct urb *urb;
816 int i, j, ret;
817
818 struct usb_interface *intf;
819 struct usb_host_interface *idesc = NULL;
820
821 if (pdev == NULL)
822 return -EFAULT;
823 if (pdev->iso_init)
824 return 0;
825 pdev->vsync = 0;
826 udev = pdev->udev;
827
828 /* Get the current alternate interface, adjust packet size */
829 if (!udev->actconfig)
830 return -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831 intf = usb_ifnum_to_if(udev, 0);
832 if (intf)
833 idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300834
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 if (!idesc)
836 return -EFAULT;
837
838 /* Search video endpoint */
839 pdev->vmax_packet_size = -1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300840 for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841 if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
842 pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
843 break;
844 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300845 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300846
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847 if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300848 PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
Steven Cole093cf722005-05-03 19:07:24 -0600849 return -ENFILE; /* Odd error, that should be noticeable */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700850 }
851
852 /* Set alternate interface */
853 ret = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300854 PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700855 ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
856 if (ret < 0)
857 return ret;
858
859 for (i = 0; i < MAX_ISO_BUFS; i++) {
860 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
861 if (urb == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300862 PWC_ERROR("Failed to allocate urb %d\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863 ret = -ENOMEM;
864 break;
865 }
866 pdev->sbuf[i].urb = urb;
Luc Saillard2b455db2006-04-24 10:29:46 -0300867 PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868 }
869 if (ret) {
870 /* De-allocate in reverse order */
Mariusz Kozlowski444f4f92006-11-16 16:38:57 +0100871 while (i--) {
Mariusz Kozlowski90b26252006-11-08 15:34:55 +0100872 usb_free_urb(pdev->sbuf[i].urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700873 pdev->sbuf[i].urb = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874 }
875 return ret;
876 }
877
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300878 /* init URB structure */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879 for (i = 0; i < MAX_ISO_BUFS; i++) {
880 urb = pdev->sbuf[i].urb;
881
882 urb->interval = 1; // devik
883 urb->dev = udev;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300884 urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 urb->transfer_flags = URB_ISO_ASAP;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300886 urb->transfer_buffer = pdev->sbuf[i].data;
887 urb->transfer_buffer_length = ISO_BUFFER_SIZE;
888 urb->complete = pwc_isoc_handler;
889 urb->context = pdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700890 urb->start_frame = 0;
891 urb->number_of_packets = ISO_FRAMES_PER_DESC;
892 for (j = 0; j < ISO_FRAMES_PER_DESC; j++) {
893 urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE;
894 urb->iso_frame_desc[j].length = pdev->vmax_packet_size;
895 }
896 }
897
898 /* link */
899 for (i = 0; i < MAX_ISO_BUFS; i++) {
900 ret = usb_submit_urb(pdev->sbuf[i].urb, GFP_KERNEL);
901 if (ret)
Luc Saillard2b455db2006-04-24 10:29:46 -0300902 PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700903 else
Luc Saillard2b455db2006-04-24 10:29:46 -0300904 PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->sbuf[i].urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905 }
906
907 /* All is done... */
908 pdev->iso_init = 1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300909 PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910 return 0;
911}
912
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300913static void pwc_iso_stop(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914{
915 int i;
916
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917 /* Unlinking ISOC buffers one by one */
918 for (i = 0; i < MAX_ISO_BUFS; i++) {
919 struct urb *urb;
920
921 urb = pdev->sbuf[i].urb;
Al Viro5fa12472008-03-29 03:07:38 +0000922 if (urb) {
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300923 PWC_DEBUG_MEMORY("Unlinking URB %p\n", urb);
924 usb_kill_urb(urb);
925 }
926 }
927}
928
929static void pwc_iso_free(struct pwc_device *pdev)
930{
931 int i;
932
933 /* Freeing ISOC buffers one by one */
934 for (i = 0; i < MAX_ISO_BUFS; i++) {
935 struct urb *urb;
936
937 urb = pdev->sbuf[i].urb;
Al Viro5fa12472008-03-29 03:07:38 +0000938 if (urb) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300939 PWC_DEBUG_MEMORY("Freeing URB\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940 usb_free_urb(urb);
941 pdev->sbuf[i].urb = NULL;
942 }
943 }
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300944}
945
946void pwc_isoc_cleanup(struct pwc_device *pdev)
947{
948 PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
949 if (pdev == NULL)
950 return;
951 if (pdev->iso_init == 0)
952 return;
953
954 pwc_iso_stop(pdev);
955 pwc_iso_free(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956
957 /* Stop camera, but only if we are sure the camera is still there (unplug
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300958 is signalled by EPIPE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 */
Hans de Goedec7d188672010-11-16 12:26:00 -0300960 if (pdev->error_status != EPIPE) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300961 PWC_DEBUG_OPEN("Setting alternate interface 0.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700962 usb_set_interface(pdev->udev, 0, 0);
963 }
964
965 pdev->iso_init = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300966 PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700967}
968
Luc Saillard2b455db2006-04-24 10:29:46 -0300969/*********
970 * sysfs
971 *********/
Kay Sievers54bd5b62007-10-08 16:26:13 -0300972static struct pwc_device *cd_to_pwc(struct device *cd)
Luc Saillard2b455db2006-04-24 10:29:46 -0300973{
974 struct video_device *vdev = to_video_device(cd);
975 return video_get_drvdata(vdev);
976}
977
Kay Sievers54bd5b62007-10-08 16:26:13 -0300978static ssize_t show_pan_tilt(struct device *class_dev,
979 struct device_attribute *attr, char *buf)
Luc Saillard2b455db2006-04-24 10:29:46 -0300980{
981 struct pwc_device *pdev = cd_to_pwc(class_dev);
982 return sprintf(buf, "%d %d\n", pdev->pan_angle, pdev->tilt_angle);
983}
984
Kay Sievers54bd5b62007-10-08 16:26:13 -0300985static ssize_t store_pan_tilt(struct device *class_dev,
986 struct device_attribute *attr,
987 const char *buf, size_t count)
Luc Saillard2b455db2006-04-24 10:29:46 -0300988{
989 struct pwc_device *pdev = cd_to_pwc(class_dev);
990 int pan, tilt;
991 int ret = -EINVAL;
992
993 if (strncmp(buf, "reset", 5) == 0)
994 ret = pwc_mpt_reset(pdev, 0x3);
995
996 else if (sscanf(buf, "%d %d", &pan, &tilt) > 0)
997 ret = pwc_mpt_set_angle(pdev, pan, tilt);
998
999 if (ret < 0)
1000 return ret;
1001 return strlen(buf);
1002}
Kay Sievers54bd5b62007-10-08 16:26:13 -03001003static DEVICE_ATTR(pan_tilt, S_IRUGO | S_IWUSR, show_pan_tilt,
1004 store_pan_tilt);
Luc Saillard2b455db2006-04-24 10:29:46 -03001005
Kay Sievers54bd5b62007-10-08 16:26:13 -03001006static ssize_t show_snapshot_button_status(struct device *class_dev,
1007 struct device_attribute *attr, char *buf)
Luc Saillard2b455db2006-04-24 10:29:46 -03001008{
1009 struct pwc_device *pdev = cd_to_pwc(class_dev);
1010 int status = pdev->snapshot_button_status;
1011 pdev->snapshot_button_status = 0;
1012 return sprintf(buf, "%d\n", status);
1013}
1014
Kay Sievers54bd5b62007-10-08 16:26:13 -03001015static DEVICE_ATTR(button, S_IRUGO | S_IWUSR, show_snapshot_button_status,
1016 NULL);
Luc Saillard2b455db2006-04-24 10:29:46 -03001017
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001018static int pwc_create_sysfs_files(struct video_device *vdev)
Luc Saillard2b455db2006-04-24 10:29:46 -03001019{
1020 struct pwc_device *pdev = video_get_drvdata(vdev);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001021 int rc;
1022
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001023 rc = device_create_file(&vdev->dev, &dev_attr_button);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001024 if (rc)
1025 goto err;
1026 if (pdev->features & FEATURE_MOTOR_PANTILT) {
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001027 rc = device_create_file(&vdev->dev, &dev_attr_pan_tilt);
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001028 if (rc)
1029 goto err_button;
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001030 }
1031
1032 return 0;
1033
1034err_button:
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001035 device_remove_file(&vdev->dev, &dev_attr_button);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001036err:
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001037 PWC_ERROR("Could not create sysfs files.\n");
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001038 return rc;
Luc Saillard2b455db2006-04-24 10:29:46 -03001039}
1040
1041static void pwc_remove_sysfs_files(struct video_device *vdev)
1042{
1043 struct pwc_device *pdev = video_get_drvdata(vdev);
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001044
Luc Saillard2b455db2006-04-24 10:29:46 -03001045 if (pdev->features & FEATURE_MOTOR_PANTILT)
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001046 device_remove_file(&vdev->dev, &dev_attr_pan_tilt);
1047 device_remove_file(&vdev->dev, &dev_attr_button);
Luc Saillard2b455db2006-04-24 10:29:46 -03001048}
1049
Trent Piepho05ad3902007-01-30 23:26:01 -03001050#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001051static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
1052{
1053 switch(sensor_type) {
1054 case 0x00:
1055 return "Hyundai CMOS sensor";
1056 case 0x20:
1057 return "Sony CCD sensor + TDA8787";
1058 case 0x2E:
1059 return "Sony CCD sensor + Exas 98L59";
1060 case 0x2F:
1061 return "Sony CCD sensor + ADI 9804";
1062 case 0x30:
1063 return "Sharp CCD sensor + TDA8787";
1064 case 0x3E:
1065 return "Sharp CCD sensor + Exas 98L59";
1066 case 0x3F:
1067 return "Sharp CCD sensor + ADI 9804";
1068 case 0x40:
1069 return "UPA 1021 sensor";
1070 case 0x100:
1071 return "VGA sensor";
1072 case 0x101:
1073 return "PAL MR sensor";
1074 default:
Trent Piepho657de3c2006-06-20 00:30:57 -03001075 return "unknown type of sensor";
Luc Saillard2b455db2006-04-24 10:29:46 -03001076 }
1077}
1078#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001079
1080/***************************************************************************/
1081/* Video4Linux functions */
1082
Hans Verkuilbec43662008-12-30 06:58:20 -03001083static int pwc_video_open(struct file *file)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001084{
Luc Saillard2b455db2006-04-24 10:29:46 -03001085 int i, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001086 struct video_device *vdev = video_devdata(file);
1087 struct pwc_device *pdev;
1088
Luc Saillard2b455db2006-04-24 10:29:46 -03001089 PWC_DEBUG_OPEN(">> video_open called(vdev = 0x%p).\n", vdev);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001090
Hans Verkuil601e9442008-08-23 07:24:07 -03001091 pdev = video_get_drvdata(vdev);
Eric Sesterhenn5d9a2762006-11-30 05:26:46 +01001092 BUG_ON(!pdev);
Luc Saillard2b455db2006-04-24 10:29:46 -03001093 if (pdev->vopen) {
1094 PWC_DEBUG_OPEN("I'm busy, someone is using the device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001095 return -EBUSY;
Luc Saillard2b455db2006-04-24 10:29:46 -03001096 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001097
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001098 mutex_lock(&pdev->modlock);
Martin Fuzzey5c8e2402009-03-09 20:16:00 -03001099 pwc_construct(pdev); /* set min/max sizes correct */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001100 if (!pdev->usb_init) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001101 PWC_DEBUG_OPEN("Doing first time initialization.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102 pdev->usb_init = 1;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001103
Luc Saillard2b455db2006-04-24 10:29:46 -03001104 /* Query sensor type */
1105 ret = pwc_get_cmos_sensor(pdev, &i);
1106 if (ret >= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001107 {
Luc Saillard2b455db2006-04-24 10:29:46 -03001108 PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
1109 pdev->vdev->name,
1110 pwc_sensor_type_to_string(i), i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111 }
1112 }
1113
1114 /* Turn on camera */
1115 if (power_save) {
1116 i = pwc_camera_power(pdev, 1);
1117 if (i < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001118 PWC_DEBUG_OPEN("Failed to restore power to the camera! (%d)\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119 }
1120 /* Set LED on/off time */
1121 if (pwc_set_leds(pdev, led_on, led_off) < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001122 PWC_DEBUG_OPEN("Failed to set LED on/off time.\n");
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001123
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124
1125 /* So far, so good. Allocate memory. */
1126 i = pwc_allocate_buffers(pdev);
1127 if (i < 0) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001128 PWC_DEBUG_OPEN("Failed to allocate buffers memory.\n");
1129 pwc_free_buffers(pdev);
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001130 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131 return i;
1132 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001133
Linus Torvalds1da177e2005-04-16 15:20:36 -07001134 /* Reset buffers & parameters */
1135 pwc_reset_buffers(pdev);
Luc Saillard2b455db2006-04-24 10:29:46 -03001136 for (i = 0; i < pwc_mbufs; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001137 pdev->image_used[i] = 0;
1138 pdev->vframe_count = 0;
1139 pdev->vframes_dumped = 0;
1140 pdev->vframes_error = 0;
1141 pdev->visoc_errors = 0;
1142 pdev->error_status = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001143 pwc_construct(pdev); /* set min/max sizes correct */
1144
1145 /* Set some defaults */
1146 pdev->vsnapshot = 0;
1147
Hans de Goede3751e282010-11-16 11:39:25 -03001148 /* Set video size, first try the last used video size
Linus Torvalds1da177e2005-04-16 15:20:36 -07001149 (or the default one); if that fails try QCIF/10 or QSIF/10;
1150 it that fails too, give up.
1151 */
1152 i = pwc_set_video_mode(pdev, pwc_image_sizes[pdev->vsize].x, pwc_image_sizes[pdev->vsize].y, pdev->vframes, pdev->vcompression, 0);
1153 if (i) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001154 unsigned int default_resolution;
1155 PWC_DEBUG_OPEN("First attempt at set_video_mode failed.\n");
1156 if (pdev->type>= 730)
1157 default_resolution = PSZ_QSIF;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001158 else
Luc Saillard2b455db2006-04-24 10:29:46 -03001159 default_resolution = PSZ_QCIF;
1160
1161 i = pwc_set_video_mode(pdev,
1162 pwc_image_sizes[default_resolution].x,
1163 pwc_image_sizes[default_resolution].y,
1164 10,
1165 pdev->vcompression,
1166 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001167 }
1168 if (i) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001169 PWC_DEBUG_OPEN("Second attempt at set_video_mode failed.\n");
1170 pwc_free_buffers(pdev);
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001171 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001172 return i;
1173 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001174
Luc Saillard2b455db2006-04-24 10:29:46 -03001175 /* Initialize the webcam to sane value */
1176 pwc_set_brightness(pdev, 0x7fff);
1177 pwc_set_agc(pdev, 1, 0);
1178
Linus Torvalds1da177e2005-04-16 15:20:36 -07001179 pdev->vopen++;
1180 file->private_data = vdev;
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001181 mutex_unlock(&pdev->modlock);
Luc Saillard2b455db2006-04-24 10:29:46 -03001182 PWC_DEBUG_OPEN("<< video_open() returns 0.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001183 return 0;
1184}
1185
Oliver Neukum85237f22007-08-21 07:10:42 +02001186
1187static void pwc_cleanup(struct pwc_device *pdev)
1188{
1189 pwc_remove_sysfs_files(pdev->vdev);
1190 video_unregister_device(pdev->vdev);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001191
1192#ifdef CONFIG_USB_PWC_INPUT_EVDEV
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001193 if (pdev->button_dev)
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001194 input_unregister_device(pdev->button_dev);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001195#endif
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001196
1197 kfree(pdev);
Oliver Neukum85237f22007-08-21 07:10:42 +02001198}
1199
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200/* Note that all cleanup is done in the reverse order as in _open */
Hans Verkuilbec43662008-12-30 06:58:20 -03001201static int pwc_video_close(struct file *file)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001202{
1203 struct video_device *vdev = file->private_data;
1204 struct pwc_device *pdev;
Oliver Neukum85237f22007-08-21 07:10:42 +02001205 int i, hint;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001206
Luc Saillard2b455db2006-04-24 10:29:46 -03001207 PWC_DEBUG_OPEN(">> video_close called(vdev = 0x%p).\n", vdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208
Hans Verkuil601e9442008-08-23 07:24:07 -03001209 pdev = video_get_drvdata(vdev);
Hans Verkuil7074f402010-09-15 14:49:07 -03001210 mutex_lock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001211 if (pdev->vopen == 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001212 PWC_DEBUG_MODULE("video_close() called on closed device?\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001213
1214 /* Dump statistics, but only if a reasonable amount of frames were
1215 processed (to prevent endless log-entries in case of snap-shot
1216 programs)
1217 */
1218 if (pdev->vframe_count > 20)
Luc Saillard2b455db2006-04-24 10:29:46 -03001219 PWC_DEBUG_MODULE("Closing video device: %d frames received, dumped %d frames, %d frames with errors.\n", pdev->vframe_count, pdev->vframes_dumped, pdev->vframes_error);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001220
Luc Saillard2b455db2006-04-24 10:29:46 -03001221 if (DEVICE_USE_CODEC1(pdev->type))
1222 pwc_dec1_exit();
1223 else
1224 pwc_dec23_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225
1226 pwc_isoc_cleanup(pdev);
1227 pwc_free_buffers(pdev);
1228
1229 /* Turn off LEDS and power down camera, but only when not unplugged */
Oliver Neukum85237f22007-08-21 07:10:42 +02001230 if (!pdev->unplugged) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001231 /* Turn LEDs off */
1232 if (pwc_set_leds(pdev, 0, 0) < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001233 PWC_DEBUG_MODULE("Failed to set LED on/off time.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001234 if (power_save) {
1235 i = pwc_camera_power(pdev, 0);
1236 if (i < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001237 PWC_ERROR("Failed to power down camera (%d)\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001238 }
Oliver Neukum85237f22007-08-21 07:10:42 +02001239 pdev->vopen--;
Jean Delvare7b9fbc32007-09-03 11:51:51 -03001240 PWC_DEBUG_OPEN("<< video_close() vopen=%d\n", pdev->vopen);
Oliver Neukum85237f22007-08-21 07:10:42 +02001241 } else {
1242 pwc_cleanup(pdev);
Oliver Neukum85237f22007-08-21 07:10:42 +02001243 /* search device_hint[] table if we occupy a slot, by any chance */
1244 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1245 if (device_hint[hint].pdev == pdev)
1246 device_hint[hint].pdev = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001247 }
Hans Verkuil7074f402010-09-15 14:49:07 -03001248 mutex_unlock(&pdev->modlock);
Oliver Neukum85237f22007-08-21 07:10:42 +02001249
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250 return 0;
1251}
1252
1253/*
1254 * FIXME: what about two parallel reads ????
1255 * ANSWER: Not supported. You can't open the device more than once,
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001256 despite what the V4L1 interface says. First, I don't see
1257 the need, second there's no mechanism of alerting the
1258 2nd/3rd/... process of events like changing image size.
1259 And I don't see the point of blocking that for the
1260 2nd/3rd/... process.
1261 In multi-threaded environments reading parallel from any
1262 device is tricky anyhow.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001263 */
1264
Luc Saillard2b455db2006-04-24 10:29:46 -03001265static ssize_t pwc_video_read(struct file *file, char __user *buf,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001266 size_t count, loff_t *ppos)
1267{
1268 struct video_device *vdev = file->private_data;
1269 struct pwc_device *pdev;
1270 int noblock = file->f_flags & O_NONBLOCK;
1271 DECLARE_WAITQUEUE(wait, current);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001272 int bytes_to_read, rv = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -03001273 void *image_buffer_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001274
Luc Saillard2b455db2006-04-24 10:29:46 -03001275 PWC_DEBUG_READ("pwc_video_read(vdev=0x%p, buf=%p, count=%zd) called.\n",
1276 vdev, buf, count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001277 if (vdev == NULL)
1278 return -EFAULT;
Hans Verkuil601e9442008-08-23 07:24:07 -03001279 pdev = video_get_drvdata(vdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001280 if (pdev == NULL)
1281 return -EFAULT;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001282
1283 mutex_lock(&pdev->modlock);
1284 if (pdev->error_status) {
1285 rv = -pdev->error_status; /* Something happened, report what. */
1286 goto err_out;
1287 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001288
Hans de Goede3751e282010-11-16 11:39:25 -03001289 /* Start the stream (if not already started) */
1290 rv = pwc_isoc_init(pdev);
1291 if (rv)
1292 goto err_out;
1293
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294 /* In case we're doing partial reads, we don't have to wait for a frame */
1295 if (pdev->image_read_pos == 0) {
1296 /* Do wait queueing according to the (doc)book */
1297 add_wait_queue(&pdev->frameq, &wait);
1298 while (pdev->full_frames == NULL) {
1299 /* Check for unplugged/etc. here */
1300 if (pdev->error_status) {
1301 remove_wait_queue(&pdev->frameq, &wait);
1302 set_current_state(TASK_RUNNING);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001303 rv = -pdev->error_status ;
1304 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001305 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001306 if (noblock) {
1307 remove_wait_queue(&pdev->frameq, &wait);
1308 set_current_state(TASK_RUNNING);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001309 rv = -EWOULDBLOCK;
1310 goto err_out;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001311 }
1312 if (signal_pending(current)) {
1313 remove_wait_queue(&pdev->frameq, &wait);
1314 set_current_state(TASK_RUNNING);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001315 rv = -ERESTARTSYS;
1316 goto err_out;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001317 }
1318 schedule();
1319 set_current_state(TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001320 }
1321 remove_wait_queue(&pdev->frameq, &wait);
1322 set_current_state(TASK_RUNNING);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001323
Linus Torvalds1da177e2005-04-16 15:20:36 -07001324 /* Decompress and release frame */
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001325 if (pwc_handle_frame(pdev)) {
1326 rv = -EFAULT;
1327 goto err_out;
1328 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 }
1330
Luc Saillard2b455db2006-04-24 10:29:46 -03001331 PWC_DEBUG_READ("Copying data to user space.\n");
Hans Verkuil479567c2010-09-12 17:05:11 -03001332 if (pdev->pixfmt != V4L2_PIX_FMT_YUV420)
Luc Saillard2b455db2006-04-24 10:29:46 -03001333 bytes_to_read = pdev->frame_size + sizeof(struct pwc_raw_frame);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001334 else
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001335 bytes_to_read = pdev->view.size;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001336
1337 /* copy bytes to user space; we allow for partial reads */
1338 if (count + pdev->image_read_pos > bytes_to_read)
1339 count = bytes_to_read - pdev->image_read_pos;
Luc Saillard2b455db2006-04-24 10:29:46 -03001340 image_buffer_addr = pdev->image_data;
1341 image_buffer_addr += pdev->images[pdev->fill_image].offset;
1342 image_buffer_addr += pdev->image_read_pos;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001343 if (copy_to_user(buf, image_buffer_addr, count)) {
1344 rv = -EFAULT;
1345 goto err_out;
1346 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001347 pdev->image_read_pos += count;
1348 if (pdev->image_read_pos >= bytes_to_read) { /* All data has been read */
1349 pdev->image_read_pos = 0;
1350 pwc_next_image(pdev);
1351 }
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001352 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353 return count;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001354err_out:
1355 mutex_unlock(&pdev->modlock);
1356 return rv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357}
1358
1359static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
1360{
1361 struct video_device *vdev = file->private_data;
1362 struct pwc_device *pdev;
Hans de Goede3751e282010-11-16 11:39:25 -03001363 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364
1365 if (vdev == NULL)
1366 return -EFAULT;
Hans Verkuil601e9442008-08-23 07:24:07 -03001367 pdev = video_get_drvdata(vdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368 if (pdev == NULL)
1369 return -EFAULT;
1370
Hans de Goede3751e282010-11-16 11:39:25 -03001371 /* Start the stream (if not already started) */
1372 mutex_lock(&pdev->modlock);
1373 ret = pwc_isoc_init(pdev);
1374 mutex_unlock(&pdev->modlock);
1375 if (ret)
1376 return ret;
1377
Linus Torvalds1da177e2005-04-16 15:20:36 -07001378 poll_wait(file, &pdev->frameq, wait);
1379 if (pdev->error_status)
1380 return POLLERR;
1381 if (pdev->full_frames != NULL) /* we have frames waiting */
1382 return (POLLIN | POLLRDNORM);
1383
1384 return 0;
1385}
1386
Hans Verkuil069b7472008-12-30 07:04:34 -03001387static long pwc_video_ioctl(struct file *file,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388 unsigned int cmd, unsigned long arg)
1389{
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001390 struct video_device *vdev = file->private_data;
1391 struct pwc_device *pdev;
Hans Verkuil069b7472008-12-30 07:04:34 -03001392 long r = -ENODEV;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001393
1394 if (!vdev)
1395 goto out;
Hans Verkuil601e9442008-08-23 07:24:07 -03001396 pdev = video_get_drvdata(vdev);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001397
1398 mutex_lock(&pdev->modlock);
1399 if (!pdev->unplugged)
Hans Verkuilf473bf72008-11-01 08:25:11 -03001400 r = video_usercopy(file, cmd, arg, pwc_video_do_ioctl);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001401 mutex_unlock(&pdev->modlock);
1402out:
1403 return r;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001404}
1405
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
1407{
1408 struct video_device *vdev = file->private_data;
1409 struct pwc_device *pdev;
Luc Saillard2b455db2006-04-24 10:29:46 -03001410 unsigned long start;
1411 unsigned long size;
1412 unsigned long page, pos = 0;
1413 int index;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001414
Harvey Harrison645635b2008-04-08 23:20:00 -03001415 PWC_DEBUG_MEMORY(">> %s\n", __func__);
Hans Verkuil601e9442008-08-23 07:24:07 -03001416 pdev = video_get_drvdata(vdev);
Luc Saillard2b455db2006-04-24 10:29:46 -03001417 size = vma->vm_end - vma->vm_start;
1418 start = vma->vm_start;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001419
Luc Saillard2b455db2006-04-24 10:29:46 -03001420 /* Find the idx buffer for this mapping */
1421 for (index = 0; index < pwc_mbufs; index++) {
1422 pos = pdev->images[index].offset;
1423 if ((pos>>PAGE_SHIFT) == vma->vm_pgoff)
1424 break;
1425 }
1426 if (index == MAX_IMAGES)
1427 return -EINVAL;
1428 if (index == 0) {
1429 /*
1430 * Special case for v4l1. In v4l1, we map only one big buffer,
1431 * but in v4l2 each buffer is mapped
1432 */
1433 unsigned long total_size;
1434 total_size = pwc_mbufs * pdev->len_per_image;
1435 if (size != pdev->len_per_image && size != total_size) {
1436 PWC_ERROR("Wrong size (%lu) needed to be len_per_image=%d or total_size=%lu\n",
1437 size, pdev->len_per_image, total_size);
1438 return -EINVAL;
1439 }
1440 } else if (size > pdev->len_per_image)
1441 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442
Luc Saillard2b455db2006-04-24 10:29:46 -03001443 vma->vm_flags |= VM_IO; /* from 2.6.9-acX */
1444
1445 pos += (unsigned long)pdev->image_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446 while (size > 0) {
1447 page = vmalloc_to_pfn((void *)pos);
1448 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
1449 return -EAGAIN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450 start += PAGE_SIZE;
1451 pos += PAGE_SIZE;
1452 if (size > PAGE_SIZE)
1453 size -= PAGE_SIZE;
1454 else
1455 size = 0;
1456 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001457 return 0;
1458}
1459
1460/***************************************************************************/
1461/* USB functions */
1462
1463/* This function gets called when a new device is plugged in or the usb core
1464 * is loaded.
1465 */
1466
1467static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
1468{
1469 struct usb_device *udev = interface_to_usbdev(intf);
1470 struct pwc_device *pdev = NULL;
1471 int vendor_id, product_id, type_id;
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001472 int hint, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473 int features = 0;
1474 int video_nr = -1; /* default: use next available device */
1475 char serial_number[30], *name;
1476
Luc Saillard2b455db2006-04-24 10:29:46 -03001477 vendor_id = le16_to_cpu(udev->descriptor.idVendor);
1478 product_id = le16_to_cpu(udev->descriptor.idProduct);
1479
Linus Torvalds1da177e2005-04-16 15:20:36 -07001480 /* Check if we can handle this device */
Luc Saillard2b455db2006-04-24 10:29:46 -03001481 PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
1482 vendor_id, product_id,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001483 intf->altsetting->desc.bInterfaceNumber);
1484
1485 /* the interfaces are probed one by one. We are only interested in the
1486 video interface (0) now.
1487 Interface 1 is the Audio Control, and interface 2 Audio itself.
1488 */
1489 if (intf->altsetting->desc.bInterfaceNumber > 0)
1490 return -ENODEV;
1491
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492 if (vendor_id == 0x0471) {
1493 switch (product_id) {
1494 case 0x0302:
Luc Saillard2b455db2006-04-24 10:29:46 -03001495 PWC_INFO("Philips PCA645VC USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001496 name = "Philips 645 webcam";
1497 type_id = 645;
1498 break;
1499 case 0x0303:
Luc Saillard2b455db2006-04-24 10:29:46 -03001500 PWC_INFO("Philips PCA646VC USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501 name = "Philips 646 webcam";
1502 type_id = 646;
1503 break;
1504 case 0x0304:
Luc Saillard2b455db2006-04-24 10:29:46 -03001505 PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506 name = "Askey VC010 webcam";
1507 type_id = 646;
1508 break;
1509 case 0x0307:
Luc Saillard2b455db2006-04-24 10:29:46 -03001510 PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 name = "Philips 675 webcam";
1512 type_id = 675;
1513 break;
1514 case 0x0308:
Luc Saillard2b455db2006-04-24 10:29:46 -03001515 PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001516 name = "Philips 680 webcam";
1517 type_id = 680;
1518 break;
1519 case 0x030C:
Luc Saillard2b455db2006-04-24 10:29:46 -03001520 PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001521 name = "Philips 690 webcam";
1522 type_id = 690;
1523 break;
1524 case 0x0310:
Luc Saillard2b455db2006-04-24 10:29:46 -03001525 PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001526 name = "Philips 730 webcam";
1527 type_id = 730;
1528 break;
1529 case 0x0311:
Luc Saillard2b455db2006-04-24 10:29:46 -03001530 PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001531 name = "Philips 740 webcam";
1532 type_id = 740;
1533 break;
1534 case 0x0312:
Luc Saillard2b455db2006-04-24 10:29:46 -03001535 PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536 name = "Philips 750 webcam";
1537 type_id = 750;
1538 break;
1539 case 0x0313:
Luc Saillard2b455db2006-04-24 10:29:46 -03001540 PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001541 name = "Philips 720K/40 webcam";
1542 type_id = 720;
1543 break;
Luc Saillard2b455db2006-04-24 10:29:46 -03001544 case 0x0329:
1545 PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
1546 name = "Philips SPC 900NC webcam";
Luc Saillard9ee6d782007-04-22 23:54:36 -03001547 type_id = 740;
Luc Saillard2b455db2006-04-24 10:29:46 -03001548 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001549 default:
1550 return -ENODEV;
1551 break;
1552 }
1553 }
1554 else if (vendor_id == 0x069A) {
1555 switch(product_id) {
1556 case 0x0001:
Luc Saillard2b455db2006-04-24 10:29:46 -03001557 PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001558 name = "Askey VC010 webcam";
1559 type_id = 645;
1560 break;
1561 default:
1562 return -ENODEV;
1563 break;
1564 }
1565 }
1566 else if (vendor_id == 0x046d) {
1567 switch(product_id) {
1568 case 0x08b0:
Luc Saillard2b455db2006-04-24 10:29:46 -03001569 PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001570 name = "Logitech QuickCam Pro 3000";
1571 type_id = 740; /* CCD sensor */
1572 break;
1573 case 0x08b1:
Luc Saillard2b455db2006-04-24 10:29:46 -03001574 PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001575 name = "Logitech QuickCam Notebook Pro";
1576 type_id = 740; /* CCD sensor */
1577 break;
1578 case 0x08b2:
Luc Saillard2b455db2006-04-24 10:29:46 -03001579 PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580 name = "Logitech QuickCam Pro 4000";
1581 type_id = 740; /* CCD sensor */
1582 break;
1583 case 0x08b3:
Luc Saillard2b455db2006-04-24 10:29:46 -03001584 PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001585 name = "Logitech QuickCam Zoom";
1586 type_id = 740; /* CCD sensor */
1587 break;
1588 case 0x08B4:
Luc Saillard2b455db2006-04-24 10:29:46 -03001589 PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 name = "Logitech QuickCam Zoom";
1591 type_id = 740; /* CCD sensor */
Luc Saillard2b455db2006-04-24 10:29:46 -03001592 power_save = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001593 break;
1594 case 0x08b5:
Luc Saillard2b455db2006-04-24 10:29:46 -03001595 PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 name = "Logitech QuickCam Orbit";
1597 type_id = 740; /* CCD sensor */
1598 features |= FEATURE_MOTOR_PANTILT;
1599 break;
1600 case 0x08b6:
Jean Tourrilhesa63e1572007-03-21 16:29:16 -03001601 PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
1602 name = "Cisco VT Camera";
1603 type_id = 740; /* CCD sensor */
1604 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001605 case 0x08b7:
Mauro Carvalho Chehab6b1ce3c2007-03-21 16:35:28 -03001606 PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
1607 name = "Logitech ViewPort AV 100";
1608 type_id = 740; /* CCD sensor */
1609 break;
1610 case 0x08b8: /* Where this released? */
Luc Saillard2b455db2006-04-24 10:29:46 -03001611 PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001612 name = "Logitech QuickCam (res.)";
1613 type_id = 730; /* Assuming CMOS */
1614 break;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001615 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001616 return -ENODEV;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001617 break;
1618 }
1619 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001620 else if (vendor_id == 0x055d) {
1621 /* I don't know the difference between the C10 and the C30;
1622 I suppose the difference is the sensor, but both cameras
1623 work equally well with a type_id of 675
1624 */
1625 switch(product_id) {
1626 case 0x9000:
Luc Saillard2b455db2006-04-24 10:29:46 -03001627 PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628 name = "Samsung MPC-C10";
1629 type_id = 675;
1630 break;
1631 case 0x9001:
Luc Saillard2b455db2006-04-24 10:29:46 -03001632 PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001633 name = "Samsung MPC-C30";
1634 type_id = 675;
1635 break;
Luc Saillard2b455db2006-04-24 10:29:46 -03001636 case 0x9002:
1637 PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
1638 name = "Samsung MPC-C30";
1639 type_id = 740;
1640 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641 default:
1642 return -ENODEV;
1643 break;
1644 }
1645 }
1646 else if (vendor_id == 0x041e) {
1647 switch(product_id) {
1648 case 0x400c:
Luc Saillard2b455db2006-04-24 10:29:46 -03001649 PWC_INFO("Creative Labs Webcam 5 detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001650 name = "Creative Labs Webcam 5";
1651 type_id = 730;
1652 break;
1653 case 0x4011:
Luc Saillard2b455db2006-04-24 10:29:46 -03001654 PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001655 name = "Creative Labs Webcam Pro Ex";
1656 type_id = 740;
1657 break;
1658 default:
1659 return -ENODEV;
1660 break;
1661 }
1662 }
1663 else if (vendor_id == 0x04cc) {
1664 switch(product_id) {
1665 case 0x8116:
Luc Saillard2b455db2006-04-24 10:29:46 -03001666 PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001667 name = "Sotec Afina Eye";
1668 type_id = 730;
1669 break;
1670 default:
1671 return -ENODEV;
1672 break;
1673 }
1674 }
1675 else if (vendor_id == 0x06be) {
1676 switch(product_id) {
1677 case 0x8116:
1678 /* This is essentially the same cam as the Sotec Afina Eye */
Luc Saillard2b455db2006-04-24 10:29:46 -03001679 PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001680 name = "AME Co. Afina Eye";
1681 type_id = 750;
1682 break;
1683 default:
1684 return -ENODEV;
1685 break;
1686 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001687
Linus Torvalds1da177e2005-04-16 15:20:36 -07001688 }
1689 else if (vendor_id == 0x0d81) {
1690 switch(product_id) {
1691 case 0x1900:
Luc Saillard2b455db2006-04-24 10:29:46 -03001692 PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001693 name = "Visionite VCS-UC300";
1694 type_id = 740; /* CCD sensor */
1695 break;
1696 case 0x1910:
Luc Saillard2b455db2006-04-24 10:29:46 -03001697 PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001698 name = "Visionite VCS-UM100";
1699 type_id = 730; /* CMOS sensor */
1700 break;
1701 default:
1702 return -ENODEV;
1703 break;
1704 }
1705 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001706 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001707 return -ENODEV; /* Not any of the know types; but the list keeps growing. */
1708
1709 memset(serial_number, 0, 30);
1710 usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
Luc Saillard2b455db2006-04-24 10:29:46 -03001711 PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001712
1713 if (udev->descriptor.bNumConfigurations > 1)
Luc Saillard2b455db2006-04-24 10:29:46 -03001714 PWC_WARNING("Warning: more than 1 configuration available.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001715
1716 /* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
Eric Sesterhenn80b6ca42006-02-27 21:29:43 +01001717 pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001718 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001719 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001720 return -ENOMEM;
1721 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001722 pdev->type = type_id;
1723 pdev->vsize = default_size;
1724 pdev->vframes = default_fps;
1725 strcpy(pdev->serial, serial_number);
1726 pdev->features = features;
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001727 if (vendor_id == 0x046D && product_id == 0x08B5) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001728 /* Logitech QuickCam Orbit
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001729 The ranges have been determined experimentally; they may differ from cam to cam.
1730 Also, the exact ranges left-right and up-down are different for my cam
1731 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732 pdev->angle_range.pan_min = -7000;
1733 pdev->angle_range.pan_max = 7000;
1734 pdev->angle_range.tilt_min = -3000;
1735 pdev->angle_range.tilt_max = 2500;
1736 }
1737
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001738 mutex_init(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001739 spin_lock_init(&pdev->ptrlock);
1740
1741 pdev->udev = udev;
1742 init_waitqueue_head(&pdev->frameq);
1743 pdev->vcompression = pwc_preferred_compression;
1744
1745 /* Allocate video_device structure */
1746 pdev->vdev = video_device_alloc();
Al Viro5fa12472008-03-29 03:07:38 +00001747 if (!pdev->vdev) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001748 PWC_ERROR("Err, cannot allocate video_device struture. Failing probe.");
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001749 rc = -ENOMEM;
1750 goto err_free_mem;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001751 }
1752 memcpy(pdev->vdev, &pwc_template, sizeof(pwc_template));
Lennart Poettering52a85e12009-06-04 16:18:13 -03001753 pdev->vdev->parent = &intf->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001754 strcpy(pdev->vdev->name, name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001755 video_set_drvdata(pdev->vdev, pdev);
1756
1757 pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
Luc Saillard2b455db2006-04-24 10:29:46 -03001758 PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001759
1760 /* Now search device_hint[] table for a match, so we can hint a node number. */
1761 for (hint = 0; hint < MAX_DEV_HINTS; hint++) {
1762 if (((device_hint[hint].type == -1) || (device_hint[hint].type == pdev->type)) &&
1763 (device_hint[hint].pdev == NULL)) {
1764 /* so far, so good... try serial number */
1765 if ((device_hint[hint].serial_number[0] == '*') || !strcmp(device_hint[hint].serial_number, serial_number)) {
Trent Piepho657de3c2006-06-20 00:30:57 -03001766 /* match! */
1767 video_nr = device_hint[hint].device_node;
1768 PWC_DEBUG_PROBE("Found hint, will try to register as /dev/video%d\n", video_nr);
1769 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001770 }
1771 }
1772 }
1773
1774 pdev->vdev->release = video_device_release;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001775
1776 /* occupy slot */
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001777 if (hint < MAX_DEV_HINTS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778 device_hint[hint].pdev = pdev;
1779
Luc Saillard2b455db2006-04-24 10:29:46 -03001780 PWC_DEBUG_PROBE("probe() function returning struct at 0x%p.\n", pdev);
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001781 usb_set_intfdata(intf, pdev);
Luc Saillard2b455db2006-04-24 10:29:46 -03001782
1783 /* Set the leds off */
1784 pwc_set_leds(pdev, 0, 0);
1785 pwc_camera_power(pdev, 0);
1786
Hans Verkuil479567c2010-09-12 17:05:11 -03001787 rc = video_register_device(pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1788 if (rc < 0) {
1789 PWC_ERROR("Failed to register as video device (%d).\n", rc);
1790 goto err_video_release;
1791 }
1792 rc = pwc_create_sysfs_files(pdev->vdev);
1793 if (rc)
1794 goto err_video_unreg;
1795
1796 PWC_INFO("Registered as %s.\n", video_device_node_name(pdev->vdev));
1797
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001798#ifdef CONFIG_USB_PWC_INPUT_EVDEV
1799 /* register webcam snapshot button input device */
1800 pdev->button_dev = input_allocate_device();
1801 if (!pdev->button_dev) {
1802 PWC_ERROR("Err, insufficient memory for webcam snapshot button device.");
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001803 rc = -ENOMEM;
1804 pwc_remove_sysfs_files(pdev->vdev);
1805 goto err_video_unreg;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001806 }
1807
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001808 usb_make_path(udev, pdev->button_phys, sizeof(pdev->button_phys));
1809 strlcat(pdev->button_phys, "/input0", sizeof(pdev->button_phys));
1810
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001811 pdev->button_dev->name = "PWC snapshot button";
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001812 pdev->button_dev->phys = pdev->button_phys;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001813 usb_to_input_id(pdev->udev, &pdev->button_dev->id);
1814 pdev->button_dev->dev.parent = &pdev->udev->dev;
1815 pdev->button_dev->evbit[0] = BIT_MASK(EV_KEY);
Lennart Poetteringbcd3e4b2009-06-11 11:19:33 -03001816 pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001817
1818 rc = input_register_device(pdev->button_dev);
1819 if (rc) {
1820 input_free_device(pdev->button_dev);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001821 pdev->button_dev = NULL;
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001822 pwc_remove_sysfs_files(pdev->vdev);
1823 goto err_video_unreg;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001824 }
1825#endif
1826
Linus Torvalds1da177e2005-04-16 15:20:36 -07001827 return 0;
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001828
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001829err_video_unreg:
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001830 if (hint < MAX_DEV_HINTS)
1831 device_hint[hint].pdev = NULL;
1832 video_unregister_device(pdev->vdev);
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001833 pdev->vdev = NULL; /* So we don't try to release it below */
1834err_video_release:
1835 video_device_release(pdev->vdev);
1836err_free_mem:
1837 kfree(pdev);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001838 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001839}
1840
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001841/* The user yanked out the cable... */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001842static void usb_pwc_disconnect(struct usb_interface *intf)
1843{
1844 struct pwc_device *pdev;
1845 int hint;
1846
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847 pdev = usb_get_intfdata (intf);
Hans Verkuil7074f402010-09-15 14:49:07 -03001848 mutex_lock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849 usb_set_intfdata (intf, NULL);
1850 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001851 PWC_ERROR("pwc_disconnect() Called without private pointer.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001852 goto disconnect_out;
1853 }
1854 if (pdev->udev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001855 PWC_ERROR("pwc_disconnect() already called for %p\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001856 goto disconnect_out;
1857 }
1858 if (pdev->udev != interface_to_usbdev(intf)) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001859 PWC_ERROR("pwc_disconnect() Woops: pointer mismatch udev/pdev.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001860 goto disconnect_out;
1861 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001862
Linus Torvalds1da177e2005-04-16 15:20:36 -07001863 /* We got unplugged; this is signalled by an EPIPE error code */
1864 if (pdev->vopen) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001865 PWC_INFO("Disconnected while webcam is in use!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001866 pdev->error_status = EPIPE;
1867 }
1868
1869 /* Alert waiting processes */
1870 wake_up_interruptible(&pdev->frameq);
1871 /* Wait until device is closed */
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001872 if (pdev->vopen) {
Oliver Neukum85237f22007-08-21 07:10:42 +02001873 pdev->unplugged = 1;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001874 pwc_iso_stop(pdev);
Oliver Neukum85237f22007-08-21 07:10:42 +02001875 } else {
1876 /* Device is closed, so we can safely unregister it */
1877 PWC_DEBUG_PROBE("Unregistering video device in disconnect().\n");
1878 pwc_cleanup(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001879
1880disconnect_out:
Oliver Neukum85237f22007-08-21 07:10:42 +02001881 /* search device_hint[] table if we occupy a slot, by any chance */
1882 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1883 if (device_hint[hint].pdev == pdev)
1884 device_hint[hint].pdev = NULL;
1885 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001886
Hans Verkuil7074f402010-09-15 14:49:07 -03001887 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001888}
1889
Linus Torvalds1da177e2005-04-16 15:20:36 -07001890
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001891/*
1892 * Initialization code & module stuff
Linus Torvalds1da177e2005-04-16 15:20:36 -07001893 */
1894
Luc Saillard2b455db2006-04-24 10:29:46 -03001895static char *size;
1896static int fps;
1897static int fbufs;
1898static int mbufs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001899static int compression = -1;
1900static int leds[2] = { -1, -1 };
Al Viro64a6f952007-10-14 19:35:30 +01001901static unsigned int leds_nargs;
Luc Saillard2b455db2006-04-24 10:29:46 -03001902static char *dev_hint[MAX_DEV_HINTS];
Al Viro64a6f952007-10-14 19:35:30 +01001903static unsigned int dev_hint_nargs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001904
Luc Saillard2b455db2006-04-24 10:29:46 -03001905module_param(size, charp, 0444);
1906module_param(fps, int, 0444);
1907module_param(fbufs, int, 0444);
1908module_param(mbufs, int, 0444);
Trent Piepho05ad3902007-01-30 23:26:01 -03001909#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001910module_param_named(trace, pwc_trace, int, 0644);
1911#endif
1912module_param(power_save, int, 0444);
1913module_param(compression, int, 0444);
1914module_param_array(leds, int, &leds_nargs, 0444);
1915module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
1916
Linus Torvalds1da177e2005-04-16 15:20:36 -07001917MODULE_PARM_DESC(size, "Initial image size. One of sqcif, qsif, qcif, sif, cif, vga");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001918MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001919MODULE_PARM_DESC(fbufs, "Number of internal frame buffers to reserve");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001920MODULE_PARM_DESC(mbufs, "Number of external (mmap()ed) image buffers");
Andrea Odetti4315c412009-12-10 16:26:10 -03001921#ifdef CONFIG_USB_PWC_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -07001922MODULE_PARM_DESC(trace, "For debugging purposes");
Andrea Odetti4315c412009-12-10 16:26:10 -03001923#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924MODULE_PARM_DESC(power_save, "Turn power save feature in camera on or off");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001925MODULE_PARM_DESC(compression, "Preferred compression quality. Range 0 (uncompressed) to 3 (high compression)");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001926MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927MODULE_PARM_DESC(dev_hint, "Device node hints");
1928
1929MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
1930MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
1931MODULE_LICENSE("GPL");
Luc Saillard2b455db2006-04-24 10:29:46 -03001932MODULE_ALIAS("pwcx");
1933MODULE_VERSION( PWC_VERSION );
Linus Torvalds1da177e2005-04-16 15:20:36 -07001934
1935static int __init usb_pwc_init(void)
1936{
1937 int i, sz;
1938 char *sizenames[PSZ_MAX] = { "sqcif", "qsif", "qcif", "sif", "cif", "vga" };
1939
Luc Saillard2b455db2006-04-24 10:29:46 -03001940 PWC_INFO("Philips webcam module version " PWC_VERSION " loaded.\n");
1941 PWC_INFO("Supports Philips PCA645/646, PCVC675/680/690, PCVC720[40]/730/740/750 & PCVC830/840.\n");
1942 PWC_INFO("Also supports the Askey VC010, various Logitech Quickcams, Samsung MPC-C10 and MPC-C30,\n");
1943 PWC_INFO("the Creative WebCam 5 & Pro Ex, SOTEC Afina Eye and Visionite VCS-UC300 and VCS-UM100.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001944
1945 if (fps) {
1946 if (fps < 4 || fps > 30) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001947 PWC_ERROR("Framerate out of bounds (4-30).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948 return -EINVAL;
1949 }
1950 default_fps = fps;
Luc Saillard2b455db2006-04-24 10:29:46 -03001951 PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001952 }
1953
Luc Saillard2b455db2006-04-24 10:29:46 -03001954 if (size) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001955 /* string; try matching with array */
1956 for (sz = 0; sz < PSZ_MAX; sz++) {
1957 if (!strcmp(sizenames[sz], size)) { /* Found! */
1958 default_size = sz;
1959 break;
1960 }
1961 }
1962 if (sz == PSZ_MAX) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001963 PWC_ERROR("Size not recognized; try size=[sqcif | qsif | qcif | sif | cif | vga].\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001964 return -EINVAL;
1965 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001966 PWC_DEBUG_MODULE("Default image size set to %s [%dx%d].\n", sizenames[default_size], pwc_image_sizes[default_size].x, pwc_image_sizes[default_size].y);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967 }
1968 if (mbufs) {
1969 if (mbufs < 1 || mbufs > MAX_IMAGES) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001970 PWC_ERROR("Illegal number of mmap() buffers; use a number between 1 and %d.\n", MAX_IMAGES);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001971 return -EINVAL;
1972 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001973 pwc_mbufs = mbufs;
1974 PWC_DEBUG_MODULE("Number of image buffers set to %d.\n", pwc_mbufs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001975 }
1976 if (fbufs) {
1977 if (fbufs < 2 || fbufs > MAX_FRAMES) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001978 PWC_ERROR("Illegal number of frame buffers; use a number between 2 and %d.\n", MAX_FRAMES);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001979 return -EINVAL;
1980 }
1981 default_fbufs = fbufs;
Luc Saillard2b455db2006-04-24 10:29:46 -03001982 PWC_DEBUG_MODULE("Number of frame buffers set to %d.\n", default_fbufs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001983 }
Trent Piepho05ad3902007-01-30 23:26:01 -03001984#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001985 if (pwc_trace >= 0) {
1986 PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001987 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001988#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001989 if (compression >= 0) {
1990 if (compression > 3) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001991 PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001992 return -EINVAL;
1993 }
1994 pwc_preferred_compression = compression;
Luc Saillard2b455db2006-04-24 10:29:46 -03001995 PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001996 }
1997 if (power_save)
Luc Saillard2b455db2006-04-24 10:29:46 -03001998 PWC_DEBUG_MODULE("Enabling power save on open/close.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001999 if (leds[0] >= 0)
2000 led_on = leds[0];
2001 if (leds[1] >= 0)
2002 led_off = leds[1];
2003
Steven Cole093cf722005-05-03 19:07:24 -06002004 /* Big device node whoopla. Basically, it allows you to assign a
Linus Torvalds1da177e2005-04-16 15:20:36 -07002005 device node (/dev/videoX) to a camera, based on its type
2006 & serial number. The format is [type[.serialnumber]:]node.
2007
2008 Any camera that isn't matched by these rules gets the next
2009 available free device node.
2010 */
2011 for (i = 0; i < MAX_DEV_HINTS; i++) {
2012 char *s, *colon, *dot;
2013
2014 /* This loop also initializes the array */
2015 device_hint[i].pdev = NULL;
2016 s = dev_hint[i];
2017 if (s != NULL && *s != '\0') {
2018 device_hint[i].type = -1; /* wildcard */
2019 strcpy(device_hint[i].serial_number, "*");
2020
2021 /* parse string: chop at ':' & '/' */
2022 colon = dot = s;
2023 while (*colon != '\0' && *colon != ':')
2024 colon++;
2025 while (*dot != '\0' && *dot != '.')
2026 dot++;
2027 /* Few sanity checks */
2028 if (*dot != '\0' && dot > colon) {
Luc Saillard2b455db2006-04-24 10:29:46 -03002029 PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002030 return -EINVAL;
2031 }
2032
2033 if (*colon == '\0') {
2034 /* No colon */
2035 if (*dot != '\0') {
Luc Saillard2b455db2006-04-24 10:29:46 -03002036 PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002037 return -EINVAL;
2038 }
2039 else {
2040 /* No type or serial number specified, just a number. */
Andy Shevchenko2d8d7762009-09-24 07:58:09 -03002041 device_hint[i].device_node =
2042 simple_strtol(s, NULL, 10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043 }
2044 }
2045 else {
2046 /* There's a colon, so we have at least a type and a device node */
Andy Shevchenko2d8d7762009-09-24 07:58:09 -03002047 device_hint[i].type =
2048 simple_strtol(s, NULL, 10);
2049 device_hint[i].device_node =
2050 simple_strtol(colon + 1, NULL, 10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002051 if (*dot != '\0') {
2052 /* There's a serial number as well */
2053 int k;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03002054
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055 dot++;
2056 k = 0;
2057 while (*dot != ':' && k < 29) {
2058 device_hint[i].serial_number[k++] = *dot;
2059 dot++;
2060 }
2061 device_hint[i].serial_number[k] = '\0';
2062 }
2063 }
Luc Saillard2b455db2006-04-24 10:29:46 -03002064 PWC_TRACE("device_hint[%d]:\n", i);
2065 PWC_TRACE(" type : %d\n", device_hint[i].type);
2066 PWC_TRACE(" serial# : %s\n", device_hint[i].serial_number);
2067 PWC_TRACE(" node : %d\n", device_hint[i].device_node);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002068 }
2069 else
2070 device_hint[i].type = 0; /* not filled */
2071 } /* ..for MAX_DEV_HINTS */
2072
Luc Saillard2b455db2006-04-24 10:29:46 -03002073 PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002074 return usb_register(&pwc_driver);
2075}
2076
2077static void __exit usb_pwc_exit(void)
2078{
Luc Saillard2b455db2006-04-24 10:29:46 -03002079 PWC_DEBUG_MODULE("Deregistering driver.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002080 usb_deregister(&pwc_driver);
Luc Saillard2b455db2006-04-24 10:29:46 -03002081 PWC_INFO("Philips webcam module removed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002082}
2083
2084module_init(usb_pwc_init);
2085module_exit(usb_pwc_exit);
2086
Luc Saillard2b455db2006-04-24 10:29:46 -03002087/* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */