blob: 436a47caf52dfa8555c76f840169c72b56712c30 [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
56*/
57
58#include <linux/errno.h>
59#include <linux/init.h>
60#include <linux/mm.h>
61#include <linux/module.h>
62#include <linux/poll.h>
63#include <linux/slab.h>
64#include <linux/vmalloc.h>
Luc Saillard2b455db2006-04-24 10:29:46 -030065#include <linux/version.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070066#include <asm/io.h>
67
68#include "pwc.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070069#include "pwc-kiara.h"
70#include "pwc-timon.h"
Luc Saillard2b455db2006-04-24 10:29:46 -030071#include "pwc-dec23.h"
72#include "pwc-dec1.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070073#include "pwc-uncompress.h"
74
75/* Function prototypes and driver templates */
76
77/* hotplug device table support */
Luc Saillard2b455db2006-04-24 10:29:46 -030078static const struct usb_device_id pwc_device_table [] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 { USB_DEVICE(0x0471, 0x0302) }, /* Philips models */
80 { USB_DEVICE(0x0471, 0x0303) },
81 { USB_DEVICE(0x0471, 0x0304) },
82 { USB_DEVICE(0x0471, 0x0307) },
83 { USB_DEVICE(0x0471, 0x0308) },
84 { USB_DEVICE(0x0471, 0x030C) },
85 { USB_DEVICE(0x0471, 0x0310) },
Luc Saillard2b455db2006-04-24 10:29:46 -030086 { USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
Linus Torvalds1da177e2005-04-16 15:20:36 -070087 { USB_DEVICE(0x0471, 0x0312) },
88 { USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
Luc Saillard2b455db2006-04-24 10:29:46 -030089 { USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
Linus Torvalds1da177e2005-04-16 15:20:36 -070090 { USB_DEVICE(0x069A, 0x0001) }, /* Askey */
91 { USB_DEVICE(0x046D, 0x08B0) }, /* Logitech QuickCam Pro 3000 */
92 { USB_DEVICE(0x046D, 0x08B1) }, /* Logitech QuickCam Notebook Pro */
93 { USB_DEVICE(0x046D, 0x08B2) }, /* Logitech QuickCam Pro 4000 */
94 { USB_DEVICE(0x046D, 0x08B3) }, /* Logitech QuickCam Zoom (old model) */
95 { USB_DEVICE(0x046D, 0x08B4) }, /* Logitech QuickCam Zoom (new model) */
96 { USB_DEVICE(0x046D, 0x08B5) }, /* Logitech QuickCam Orbit/Sphere */
Mauro Carvalho Chehab6b1ce3c2007-03-21 16:35:28 -030097 { USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
98 { USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070099 { USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
Luc Saillard2b455db2006-04-24 10:29:46 -0300100 { USB_DEVICE(0x055D, 0x9000) }, /* Samsung MPC-C10 */
101 { USB_DEVICE(0x055D, 0x9001) }, /* Samsung MPC-C30 */
102 { USB_DEVICE(0x055D, 0x9002) }, /* Samsung SNC-35E (Ver3.0) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 { USB_DEVICE(0x041E, 0x400C) }, /* Creative Webcam 5 */
104 { USB_DEVICE(0x041E, 0x4011) }, /* Creative Webcam Pro Ex */
105 { USB_DEVICE(0x04CC, 0x8116) }, /* Afina Eye */
106 { USB_DEVICE(0x06BE, 0x8116) }, /* new Afina Eye */
107 { USB_DEVICE(0x0d81, 0x1910) }, /* Visionite */
108 { USB_DEVICE(0x0d81, 0x1900) },
109 { }
110};
111MODULE_DEVICE_TABLE(usb, pwc_device_table);
112
113static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
114static void usb_pwc_disconnect(struct usb_interface *intf);
115
116static struct usb_driver pwc_driver = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117 .name = "Philips webcam", /* name */
118 .id_table = pwc_device_table,
119 .probe = usb_pwc_probe, /* probe() */
120 .disconnect = usb_pwc_disconnect, /* disconnect() */
121};
122
123#define MAX_DEV_HINTS 20
124#define MAX_ISOC_ERRORS 20
125
126static int default_size = PSZ_QCIF;
127static int default_fps = 10;
128static int default_fbufs = 3; /* Default number of frame buffers */
Michael Krufkyb930e1d2007-08-27 18:16:54 -0300129 int pwc_mbufs = 2; /* Default number of mmap() buffers */
Trent Piepho05ad3902007-01-30 23:26:01 -0300130#ifdef CONFIG_USB_PWC_DEBUG
Michael Krufkyb930e1d2007-08-27 18:16:54 -0300131 int pwc_trace = PWC_DEBUG_LEVEL;
Luc Saillard2b455db2006-04-24 10:29:46 -0300132#endif
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -0300133static int power_save;
134static int led_on = 100, led_off; /* defaults to LED that is on while in use */
Adrian Bunkb20c3cf2006-06-23 06:49:34 -0300135static int pwc_preferred_compression = 1; /* 0..3 = uncompressed..high */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136static struct {
137 int type;
138 char serial_number[30];
139 int device_node;
140 struct pwc_device *pdev;
141} device_hint[MAX_DEV_HINTS];
142
143/***/
144
145static int pwc_video_open(struct inode *inode, struct file *file);
146static int pwc_video_close(struct inode *inode, struct file *file);
Luc Saillard2b455db2006-04-24 10:29:46 -0300147static ssize_t pwc_video_read(struct file *file, char __user *buf,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 size_t count, loff_t *ppos);
149static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
150static int pwc_video_ioctl(struct inode *inode, struct file *file,
151 unsigned int ioctlnr, unsigned long arg);
152static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma);
153
Arjan van de Venfa027c22007-02-12 00:55:33 -0800154static const struct file_operations pwc_fops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 .owner = THIS_MODULE,
156 .open = pwc_video_open,
157 .release = pwc_video_close,
158 .read = pwc_video_read,
159 .poll = pwc_video_poll,
160 .mmap = pwc_video_mmap,
161 .ioctl = pwc_video_ioctl,
Douglas Schilling Landgraf078ff792008-04-22 14:46:11 -0300162#ifdef CONFIG_COMPAT
Luc Van Oostenryck3cdc0f22006-08-08 09:10:10 -0300163 .compat_ioctl = v4l_compat_ioctl32,
Douglas Schilling Landgraf078ff792008-04-22 14:46:11 -0300164#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165 .llseek = no_llseek,
166};
167static struct video_device pwc_template = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168 .name = "Philips Webcam", /* Filled in later */
169 .type = VID_TYPE_CAPTURE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 .release = video_device_release,
171 .fops = &pwc_fops,
172 .minor = -1,
173};
174
175/***************************************************************************/
176
177/* Okay, this is some magic that I worked out and the reasoning behind it...
178
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300179 The biggest problem with any USB device is of course: "what to do
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180 when the user unplugs the device while it is in use by an application?"
181 We have several options:
182 1) Curse them with the 7 plagues when they do (requires divine intervention)
183 2) Tell them not to (won't work: they'll do it anyway)
184 3) Oops the kernel (this will have a negative effect on a user's uptime)
185 4) Do something sensible.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300186
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187 Of course, we go for option 4.
188
189 It happens that this device will be linked to two times, once from
190 usb_device and once from the video_device in their respective 'private'
191 pointers. This is done when the device is probed() and all initialization
192 succeeded. The pwc_device struct links back to both structures.
193
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300194 When a device is unplugged while in use it will be removed from the
195 list of known USB devices; I also de-register it as a V4L device, but
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 unfortunately I can't free the memory since the struct is still in use
197 by the file descriptor. This free-ing is then deferend until the first
198 opportunity. Crude, but it works.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300199
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 A small 'advantage' is that if a user unplugs the cam and plugs it back
201 in, it should get assigned the same video device minor, but unfortunately
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300202 it's non-trivial to re-link the cam back to the video device... (that
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 would surely be magic! :))
204*/
205
206/***************************************************************************/
207/* Private functions */
208
209/* Here we want the physical address of the memory.
210 * This is used when initializing the contents of the area.
211 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213
Luc Saillard2b455db2006-04-24 10:29:46 -0300214
215static void *pwc_rvmalloc(unsigned long size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216{
217 void * mem;
218 unsigned long adr;
219
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300220 mem=vmalloc_32(size);
Luc Saillard2b455db2006-04-24 10:29:46 -0300221 if (!mem)
222 return NULL;
223
224 memset(mem, 0, size); /* Clear the ram out, no junk to the user */
225 adr=(unsigned long) mem;
226 while (size > 0)
227 {
228 SetPageReserved(vmalloc_to_page((void *)adr));
229 adr += PAGE_SIZE;
230 size -= PAGE_SIZE;
231 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232 return mem;
233}
234
Luc Saillard2b455db2006-04-24 10:29:46 -0300235static void pwc_rvfree(void * mem, unsigned long size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236{
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300237 unsigned long adr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238
Luc Saillard2b455db2006-04-24 10:29:46 -0300239 if (!mem)
240 return;
241
242 adr=(unsigned long) mem;
243 while ((long) size > 0)
244 {
245 ClearPageReserved(vmalloc_to_page((void *)adr));
246 adr += PAGE_SIZE;
247 size -= PAGE_SIZE;
248 }
249 vfree(mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250}
251
252
253
254
255static int pwc_allocate_buffers(struct pwc_device *pdev)
256{
Luc Saillard2b455db2006-04-24 10:29:46 -0300257 int i, err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258 void *kbuf;
259
Luc Saillard2b455db2006-04-24 10:29:46 -0300260 PWC_DEBUG_MEMORY(">> pwc_allocate_buffers(pdev = 0x%p)\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261
262 if (pdev == NULL)
263 return -ENXIO;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300264
Luc Saillard2b455db2006-04-24 10:29:46 -0300265 /* Allocate Isochronuous pipe buffers */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266 for (i = 0; i < MAX_ISO_BUFS; i++) {
267 if (pdev->sbuf[i].data == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300268 kbuf = kzalloc(ISO_BUFFER_SIZE, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300270 PWC_ERROR("Failed to allocate iso buffer %d.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 return -ENOMEM;
272 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300273 PWC_DEBUG_MEMORY("Allocated iso buffer at %p.\n", kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 pdev->sbuf[i].data = kbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275 }
276 }
277
278 /* Allocate frame buffer structure */
279 if (pdev->fbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300280 kbuf = kzalloc(default_fbufs * sizeof(struct pwc_frame_buf), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300282 PWC_ERROR("Failed to allocate frame buffer structure.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283 return -ENOMEM;
284 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300285 PWC_DEBUG_MEMORY("Allocated frame buffer structure at %p.\n", kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700286 pdev->fbuf = kbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300288
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 /* create frame buffers, and make circular ring */
290 for (i = 0; i < default_fbufs; i++) {
291 if (pdev->fbuf[i].data == NULL) {
292 kbuf = vmalloc(PWC_FRAME_SIZE); /* need vmalloc since frame buffer > 128K */
293 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300294 PWC_ERROR("Failed to allocate frame buffer %d.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 return -ENOMEM;
296 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300297 PWC_DEBUG_MEMORY("Allocated frame buffer %d at %p.\n", i, kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 pdev->fbuf[i].data = kbuf;
Luc Saillard2b455db2006-04-24 10:29:46 -0300299 memset(kbuf, 0, PWC_FRAME_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300 }
301 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300302
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 /* Allocate decompressor table space */
Luc Saillard2b455db2006-04-24 10:29:46 -0300304 if (DEVICE_USE_CODEC1(pdev->type))
305 err = pwc_dec1_alloc(pdev);
306 else
307 err = pwc_dec23_alloc(pdev);
308
309 if (err) {
310 PWC_ERROR("Failed to allocate decompress table.\n");
311 return err;
312 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300313
Linus Torvalds1da177e2005-04-16 15:20:36 -0700314 /* Allocate image buffer; double buffer for mmap() */
Luc Saillard2b455db2006-04-24 10:29:46 -0300315 kbuf = pwc_rvmalloc(pwc_mbufs * pdev->len_per_image);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 if (kbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300317 PWC_ERROR("Failed to allocate image buffer(s). needed (%d)\n",
318 pwc_mbufs * pdev->len_per_image);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319 return -ENOMEM;
320 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300321 PWC_DEBUG_MEMORY("Allocated image buffer at %p.\n", kbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 pdev->image_data = kbuf;
Luc Saillard2b455db2006-04-24 10:29:46 -0300323 for (i = 0; i < pwc_mbufs; i++) {
324 pdev->images[i].offset = i * pdev->len_per_image;
325 pdev->images[i].vma_use_count = 0;
326 }
327 for (; i < MAX_IMAGES; i++) {
328 pdev->images[i].offset = 0;
329 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330
331 kbuf = NULL;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300332
Luc Saillard2b455db2006-04-24 10:29:46 -0300333 PWC_DEBUG_MEMORY("<< pwc_allocate_buffers()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700334 return 0;
335}
336
337static void pwc_free_buffers(struct pwc_device *pdev)
338{
339 int i;
340
Luc Saillard2b455db2006-04-24 10:29:46 -0300341 PWC_DEBUG_MEMORY("Entering free_buffers(%p).\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342
343 if (pdev == NULL)
344 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 /* Release Iso-pipe buffers */
346 for (i = 0; i < MAX_ISO_BUFS; i++)
347 if (pdev->sbuf[i].data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300348 PWC_DEBUG_MEMORY("Freeing ISO buffer at %p.\n", pdev->sbuf[i].data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 kfree(pdev->sbuf[i].data);
350 pdev->sbuf[i].data = NULL;
351 }
352
353 /* The same for frame buffers */
354 if (pdev->fbuf != NULL) {
355 for (i = 0; i < default_fbufs; i++) {
356 if (pdev->fbuf[i].data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300357 PWC_DEBUG_MEMORY("Freeing frame buffer %d at %p.\n", i, pdev->fbuf[i].data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 vfree(pdev->fbuf[i].data);
359 pdev->fbuf[i].data = NULL;
360 }
361 }
362 kfree(pdev->fbuf);
363 pdev->fbuf = NULL;
364 }
365
366 /* Intermediate decompression buffer & tables */
367 if (pdev->decompress_data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300368 PWC_DEBUG_MEMORY("Freeing decompression buffer at %p.\n", pdev->decompress_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 kfree(pdev->decompress_data);
370 pdev->decompress_data = NULL;
371 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372
373 /* Release image buffers */
374 if (pdev->image_data != NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300375 PWC_DEBUG_MEMORY("Freeing image buffer at %p.\n", pdev->image_data);
376 pwc_rvfree(pdev->image_data, pwc_mbufs * pdev->len_per_image);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377 }
378 pdev->image_data = NULL;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300379
Luc Saillard2b455db2006-04-24 10:29:46 -0300380 PWC_DEBUG_MEMORY("Leaving free_buffers().\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381}
382
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300383/* The frame & image buffer mess.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384
385 Yes, this is a mess. Well, it used to be simple, but alas... In this
386 module, 3 buffers schemes are used to get the data from the USB bus to
387 the user program. The first scheme involves the ISO buffers (called thus
388 since they transport ISO data from the USB controller), and not really
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300389 interesting. Suffices to say the data from this buffer is quickly
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 gathered in an interrupt handler (pwc_isoc_handler) and placed into the
391 frame buffer.
392
393 The frame buffer is the second scheme, and is the central element here.
394 It collects the data from a single frame from the camera (hence, the
395 name). Frames are delimited by the USB camera with a short USB packet,
396 so that's easy to detect. The frame buffers form a list that is filled
397 by the camera+USB controller and drained by the user process through
398 either read() or mmap().
399
400 The image buffer is the third scheme, in which frames are decompressed
401 and converted into planar format. For mmap() there is more than
402 one image buffer available.
403
404 The frame buffers provide the image buffering. In case the user process
405 is a bit slow, this introduces lag and some undesired side-effects.
406 The problem arises when the frame buffer is full. I used to drop the last
407 frame, which makes the data in the queue stale very quickly. But dropping
408 the frame at the head of the queue proved to be a litte bit more difficult.
409 I tried a circular linked scheme, but this introduced more problems than
410 it solved.
411
412 Because filling and draining are completely asynchronous processes, this
413 requires some fiddling with pointers and mutexes.
414
415 Eventually, I came up with a system with 2 lists: an 'empty' frame list
416 and a 'full' frame list:
417 * Initially, all frame buffers but one are on the 'empty' list; the one
418 remaining buffer is our initial fill frame.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300419 * If a frame is needed for filling, we try to take it from the 'empty'
420 list, unless that list is empty, in which case we take the buffer at
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421 the head of the 'full' list.
422 * When our fill buffer has been filled, it is appended to the 'full'
423 list.
424 * If a frame is needed by read() or mmap(), it is taken from the head of
425 the 'full' list, handled, and then appended to the 'empty' list. If no
426 buffer is present on the 'full' list, we wait.
427 The advantage is that the buffer that is currently being decompressed/
428 converted, is on neither list, and thus not in our way (any other scheme
429 I tried had the problem of old data lingering in the queue).
430
431 Whatever strategy you choose, it always remains a tradeoff: with more
432 frame buffers the chances of a missed frame are reduced. On the other
433 hand, on slower machines it introduces lag because the queue will
434 always be full.
435 */
436
437/**
438 \brief Find next frame buffer to fill. Take from empty or full list, whichever comes first.
439 */
Luc Saillard2b455db2006-04-24 10:29:46 -0300440static int pwc_next_fill_frame(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441{
442 int ret;
443 unsigned long flags;
444
445 ret = 0;
446 spin_lock_irqsave(&pdev->ptrlock, flags);
447 if (pdev->fill_frame != NULL) {
448 /* append to 'full' list */
449 if (pdev->full_frames == NULL) {
450 pdev->full_frames = pdev->fill_frame;
451 pdev->full_frames_tail = pdev->full_frames;
452 }
453 else {
454 pdev->full_frames_tail->next = pdev->fill_frame;
455 pdev->full_frames_tail = pdev->fill_frame;
456 }
457 }
458 if (pdev->empty_frames != NULL) {
459 /* We have empty frames available. That's easy */
460 pdev->fill_frame = pdev->empty_frames;
461 pdev->empty_frames = pdev->empty_frames->next;
462 }
463 else {
464 /* Hmm. Take it from the full list */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465 /* sanity check */
466 if (pdev->full_frames == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300467 PWC_ERROR("Neither empty or full frames available!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 spin_unlock_irqrestore(&pdev->ptrlock, flags);
469 return -EINVAL;
470 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 pdev->fill_frame = pdev->full_frames;
472 pdev->full_frames = pdev->full_frames->next;
473 ret = 1;
474 }
475 pdev->fill_frame->next = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476 spin_unlock_irqrestore(&pdev->ptrlock, flags);
477 return ret;
478}
479
480
481/**
482 \brief Reset all buffers, pointers and lists, except for the image_used[] buffer.
483
484 If the image_used[] buffer is cleared too, mmap()/VIDIOCSYNC will run into trouble.
485 */
486static void pwc_reset_buffers(struct pwc_device *pdev)
487{
488 int i;
489 unsigned long flags;
490
Harvey Harrison645635b2008-04-08 23:20:00 -0300491 PWC_DEBUG_MEMORY(">> %s __enter__\n", __func__);
Luc Saillard2b455db2006-04-24 10:29:46 -0300492
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 spin_lock_irqsave(&pdev->ptrlock, flags);
494 pdev->full_frames = NULL;
495 pdev->full_frames_tail = NULL;
496 for (i = 0; i < default_fbufs; i++) {
497 pdev->fbuf[i].filled = 0;
498 if (i > 0)
499 pdev->fbuf[i].next = &pdev->fbuf[i - 1];
500 else
501 pdev->fbuf->next = NULL;
502 }
503 pdev->empty_frames = &pdev->fbuf[default_fbufs - 1];
504 pdev->empty_frames_tail = pdev->fbuf;
505 pdev->read_frame = NULL;
506 pdev->fill_frame = pdev->empty_frames;
507 pdev->empty_frames = pdev->empty_frames->next;
508
509 pdev->image_read_pos = 0;
510 pdev->fill_image = 0;
511 spin_unlock_irqrestore(&pdev->ptrlock, flags);
Luc Saillard2b455db2006-04-24 10:29:46 -0300512
Harvey Harrison645635b2008-04-08 23:20:00 -0300513 PWC_DEBUG_MEMORY("<< %s __leaving__\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514}
515
516
517/**
518 \brief Do all the handling for getting one frame: get pointer, decompress, advance pointers.
519 */
Luc Saillard2b455db2006-04-24 10:29:46 -0300520int pwc_handle_frame(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521{
522 int ret = 0;
523 unsigned long flags;
524
525 spin_lock_irqsave(&pdev->ptrlock, flags);
526 /* First grab our read_frame; this is removed from all lists, so
527 we can release the lock after this without problems */
528 if (pdev->read_frame != NULL) {
529 /* This can't theoretically happen */
Luc Saillard2b455db2006-04-24 10:29:46 -0300530 PWC_ERROR("Huh? Read frame still in use?\n");
531 spin_unlock_irqrestore(&pdev->ptrlock, flags);
532 return ret;
533 }
534
535
536 if (pdev->full_frames == NULL) {
537 PWC_ERROR("Woops. No frames ready.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 }
539 else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300540 pdev->read_frame = pdev->full_frames;
541 pdev->full_frames = pdev->full_frames->next;
542 pdev->read_frame->next = NULL;
543 }
544
545 if (pdev->read_frame != NULL) {
Paulius Zaleckasefad798b2008-02-03 15:42:53 +0200546 /* Decompression is a lengthy process, so it's outside of the lock.
Luc Saillard2b455db2006-04-24 10:29:46 -0300547 This gives the isoc_handler the opportunity to fill more frames
548 in the mean time.
549 */
550 spin_unlock_irqrestore(&pdev->ptrlock, flags);
551 ret = pwc_decompress(pdev);
552 spin_lock_irqsave(&pdev->ptrlock, flags);
553
554 /* We're done with read_buffer, tack it to the end of the empty buffer list */
555 if (pdev->empty_frames == NULL) {
556 pdev->empty_frames = pdev->read_frame;
557 pdev->empty_frames_tail = pdev->empty_frames;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 }
559 else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300560 pdev->empty_frames_tail->next = pdev->read_frame;
561 pdev->empty_frames_tail = pdev->read_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300563 pdev->read_frame = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 }
565 spin_unlock_irqrestore(&pdev->ptrlock, flags);
566 return ret;
567}
568
569/**
570 \brief Advance pointers of image buffer (after each user request)
571*/
Luc Saillard2b455db2006-04-24 10:29:46 -0300572void pwc_next_image(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573{
574 pdev->image_used[pdev->fill_image] = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300575 pdev->fill_image = (pdev->fill_image + 1) % pwc_mbufs;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576}
577
Luc Saillard2b455db2006-04-24 10:29:46 -0300578/**
579 * Print debug information when a frame is discarded because all of our buffer
580 * is full
581 */
582static void pwc_frame_dumped(struct pwc_device *pdev)
583{
584 pdev->vframes_dumped++;
585 if (pdev->vframe_count < FRAME_LOWMARK)
586 return;
587
588 if (pdev->vframes_dumped < 20)
589 PWC_DEBUG_FLOW("Dumping frame %d\n", pdev->vframe_count);
590 else if (pdev->vframes_dumped == 20)
591 PWC_DEBUG_FLOW("Dumping frame %d (last message)\n",
592 pdev->vframe_count);
593}
594
595static int pwc_rcv_short_packet(struct pwc_device *pdev, const struct pwc_frame_buf *fbuf)
596{
597 int awake = 0;
598
599 /* The ToUCam Fun CMOS sensor causes the firmware to send 2 or 3 bogus
600 frames on the USB wire after an exposure change. This conditition is
601 however detected in the cam and a bit is set in the header.
602 */
603 if (pdev->type == 730) {
604 unsigned char *ptr = (unsigned char *)fbuf->data;
605
606 if (ptr[1] == 1 && ptr[0] & 0x10) {
607 PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
608 pdev->drop_frames += 2;
609 pdev->vframes_error++;
610 }
611 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
612 if (ptr[0] & 0x01) {
613 pdev->snapshot_button_status = 1;
614 PWC_TRACE("Snapshot button pressed.\n");
615 }
616 else {
617 PWC_TRACE("Snapshot button released.\n");
618 }
619 }
620 if ((ptr[0] ^ pdev->vmirror) & 0x02) {
621 if (ptr[0] & 0x02)
622 PWC_TRACE("Image is mirrored.\n");
623 else
624 PWC_TRACE("Image is normal.\n");
625 }
626 pdev->vmirror = ptr[0] & 0x03;
627 /* Sometimes the trailer of the 730 is still sent as a 4 byte packet
628 after a short frame; this condition is filtered out specifically. A 4 byte
629 frame doesn't make sense anyway.
630 So we get either this sequence:
631 drop_bit set -> 4 byte frame -> short frame -> good frame
632 Or this one:
633 drop_bit set -> short frame -> good frame
634 So we drop either 3 or 2 frames in all!
635 */
636 if (fbuf->filled == 4)
637 pdev->drop_frames++;
638 }
639 else if (pdev->type == 740 || pdev->type == 720) {
640 unsigned char *ptr = (unsigned char *)fbuf->data;
641 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
642 if (ptr[0] & 0x01) {
643 pdev->snapshot_button_status = 1;
644 PWC_TRACE("Snapshot button pressed.\n");
645 }
646 else
647 PWC_TRACE("Snapshot button released.\n");
648 }
649 pdev->vmirror = ptr[0] & 0x03;
650 }
651
652 /* In case we were instructed to drop the frame, do so silently.
653 The buffer pointers are not updated either (but the counters are reset below).
654 */
655 if (pdev->drop_frames > 0)
656 pdev->drop_frames--;
657 else {
658 /* Check for underflow first */
659 if (fbuf->filled < pdev->frame_total_size) {
660 PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
661 " discarded.\n", fbuf->filled);
662 pdev->vframes_error++;
663 }
664 else {
665 /* Send only once per EOF */
666 awake = 1; /* delay wake_ups */
667
668 /* Find our next frame to fill. This will always succeed, since we
669 * nick a frame from either empty or full list, but if we had to
670 * take it from the full list, it means a frame got dropped.
671 */
672 if (pwc_next_fill_frame(pdev))
673 pwc_frame_dumped(pdev);
674
675 }
676 } /* !drop_frames */
677 pdev->vframe_count++;
678 return awake;
679}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680
681/* This gets called for the Isochronous pipe (video). This is done in
682 * interrupt time, so it has to be fast, not crash, and not stall. Neat.
683 */
David Howells7d12e782006-10-05 14:55:46 +0100684static void pwc_isoc_handler(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685{
686 struct pwc_device *pdev;
687 int i, fst, flen;
688 int awake;
689 struct pwc_frame_buf *fbuf;
690 unsigned char *fillptr = NULL, *iso_buf = NULL;
691
692 awake = 0;
693 pdev = (struct pwc_device *)urb->context;
694 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300695 PWC_ERROR("isoc_handler() called with NULL device?!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 return;
697 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300698
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699 if (urb->status == -ENOENT || urb->status == -ECONNRESET) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300700 PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700701 return;
702 }
703 if (urb->status != -EINPROGRESS && urb->status != 0) {
704 const char *errmsg;
705
706 errmsg = "Unknown";
707 switch(urb->status) {
708 case -ENOSR: errmsg = "Buffer error (overrun)"; break;
709 case -EPIPE: errmsg = "Stalled (device not responding)"; break;
710 case -EOVERFLOW: errmsg = "Babble (bad cable?)"; break;
711 case -EPROTO: errmsg = "Bit-stuff error (bad cable?)"; break;
712 case -EILSEQ: errmsg = "CRC/Timeout (could be anything)"; break;
Pete Zaitcev38e2bfc2006-09-18 22:49:02 -0700713 case -ETIME: errmsg = "Device does not respond"; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300715 PWC_DEBUG_FLOW("pwc_isoc_handler() called with status %d [%s].\n", urb->status, errmsg);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300716 /* Give up after a number of contiguous errors on the USB bus.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717 Appearantly something is wrong so we simulate an unplug event.
718 */
719 if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
720 {
Luc Saillard2b455db2006-04-24 10:29:46 -0300721 PWC_INFO("Too many ISOC errors, bailing out.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722 pdev->error_status = EIO;
723 awake = 1;
724 wake_up_interruptible(&pdev->frameq);
725 }
726 goto handler_end; // ugly, but practical
727 }
728
729 fbuf = pdev->fill_frame;
730 if (fbuf == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300731 PWC_ERROR("pwc_isoc_handler without valid fill frame.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732 awake = 1;
733 goto handler_end;
734 }
735 else {
736 fillptr = fbuf->data + fbuf->filled;
737 }
738
739 /* Reset ISOC error counter. We did get here, after all. */
740 pdev->visoc_errors = 0;
741
742 /* vsync: 0 = don't copy data
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300743 1 = sync-hunt
744 2 = synched
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745 */
746 /* Compact data */
747 for (i = 0; i < urb->number_of_packets; i++) {
748 fst = urb->iso_frame_desc[i].status;
749 flen = urb->iso_frame_desc[i].actual_length;
750 iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
751 if (fst == 0) {
752 if (flen > 0) { /* if valid data... */
753 if (pdev->vsync > 0) { /* ...and we are not sync-hunting... */
754 pdev->vsync = 2;
755
756 /* ...copy data to frame buffer, if possible */
757 if (flen + fbuf->filled > pdev->frame_total_size) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300758 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 -0700759 pdev->vsync = 0; /* Hmm, let's wait for an EOF (end-of-frame) */
760 pdev->vframes_error++;
761 }
762 else {
763 memmove(fillptr, iso_buf, flen);
764 fillptr += flen;
765 }
766 }
767 fbuf->filled += flen;
768 } /* ..flen > 0 */
769
770 if (flen < pdev->vlast_packet_size) {
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300771 /* Shorter packet... We probably have the end of an image-frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772 wake up read() process and let select()/poll() do something.
773 Decompression is done in user time over there.
Luc Saillard2b455db2006-04-24 10:29:46 -0300774 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700775 if (pdev->vsync == 2) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300776 if (pwc_rcv_short_packet(pdev, fbuf)) {
777 awake = 1;
778 fbuf = pdev->fill_frame;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700779 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700780 }
781 fbuf->filled = 0;
782 fillptr = fbuf->data;
783 pdev->vsync = 1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300784 }
785
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786 pdev->vlast_packet_size = flen;
787 } /* ..status == 0 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300789 /* This is normally not interesting to the user, unless
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -0300790 * you are really debugging something, default = 0 */
791 static int iso_error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700792 iso_error++;
793 if (iso_error < 20)
Luc Saillard2b455db2006-04-24 10:29:46 -0300794 PWC_DEBUG_FLOW("Iso frame %d of USB has error %d\n", i, fst);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796 }
797
798handler_end:
799 if (awake)
800 wake_up_interruptible(&pdev->frameq);
801
802 urb->dev = pdev->udev;
803 i = usb_submit_urb(urb, GFP_ATOMIC);
804 if (i != 0)
Luc Saillard2b455db2006-04-24 10:29:46 -0300805 PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806}
807
808
Luc Saillard2b455db2006-04-24 10:29:46 -0300809int pwc_isoc_init(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810{
811 struct usb_device *udev;
812 struct urb *urb;
813 int i, j, ret;
814
815 struct usb_interface *intf;
816 struct usb_host_interface *idesc = NULL;
817
818 if (pdev == NULL)
819 return -EFAULT;
820 if (pdev->iso_init)
821 return 0;
822 pdev->vsync = 0;
823 udev = pdev->udev;
824
825 /* Get the current alternate interface, adjust packet size */
826 if (!udev->actconfig)
827 return -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700828 intf = usb_ifnum_to_if(udev, 0);
829 if (intf)
830 idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300831
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 if (!idesc)
833 return -EFAULT;
834
835 /* Search video endpoint */
836 pdev->vmax_packet_size = -1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300837 for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
839 pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
840 break;
841 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300842 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300843
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300845 PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
Steven Cole093cf722005-05-03 19:07:24 -0600846 return -ENFILE; /* Odd error, that should be noticeable */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847 }
848
849 /* Set alternate interface */
850 ret = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300851 PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852 ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
853 if (ret < 0)
854 return ret;
855
856 for (i = 0; i < MAX_ISO_BUFS; i++) {
857 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
858 if (urb == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300859 PWC_ERROR("Failed to allocate urb %d\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 ret = -ENOMEM;
861 break;
862 }
863 pdev->sbuf[i].urb = urb;
Luc Saillard2b455db2006-04-24 10:29:46 -0300864 PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700865 }
866 if (ret) {
867 /* De-allocate in reverse order */
Mariusz Kozlowski444f4f92006-11-16 16:38:57 +0100868 while (i--) {
Mariusz Kozlowski90b26252006-11-08 15:34:55 +0100869 usb_free_urb(pdev->sbuf[i].urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870 pdev->sbuf[i].urb = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871 }
872 return ret;
873 }
874
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300875 /* init URB structure */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700876 for (i = 0; i < MAX_ISO_BUFS; i++) {
877 urb = pdev->sbuf[i].urb;
878
879 urb->interval = 1; // devik
880 urb->dev = udev;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300881 urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882 urb->transfer_flags = URB_ISO_ASAP;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300883 urb->transfer_buffer = pdev->sbuf[i].data;
884 urb->transfer_buffer_length = ISO_BUFFER_SIZE;
885 urb->complete = pwc_isoc_handler;
886 urb->context = pdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700887 urb->start_frame = 0;
888 urb->number_of_packets = ISO_FRAMES_PER_DESC;
889 for (j = 0; j < ISO_FRAMES_PER_DESC; j++) {
890 urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE;
891 urb->iso_frame_desc[j].length = pdev->vmax_packet_size;
892 }
893 }
894
895 /* link */
896 for (i = 0; i < MAX_ISO_BUFS; i++) {
897 ret = usb_submit_urb(pdev->sbuf[i].urb, GFP_KERNEL);
898 if (ret)
Luc Saillard2b455db2006-04-24 10:29:46 -0300899 PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700900 else
Luc Saillard2b455db2006-04-24 10:29:46 -0300901 PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->sbuf[i].urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700902 }
903
904 /* All is done... */
905 pdev->iso_init = 1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300906 PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907 return 0;
908}
909
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300910static void pwc_iso_stop(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911{
912 int i;
913
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914 /* Unlinking ISOC buffers one by one */
915 for (i = 0; i < MAX_ISO_BUFS; i++) {
916 struct urb *urb;
917
918 urb = pdev->sbuf[i].urb;
Al Viro5fa12472008-03-29 03:07:38 +0000919 if (urb) {
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300920 PWC_DEBUG_MEMORY("Unlinking URB %p\n", urb);
921 usb_kill_urb(urb);
922 }
923 }
924}
925
926static void pwc_iso_free(struct pwc_device *pdev)
927{
928 int i;
929
930 /* Freeing ISOC buffers one by one */
931 for (i = 0; i < MAX_ISO_BUFS; i++) {
932 struct urb *urb;
933
934 urb = pdev->sbuf[i].urb;
Al Viro5fa12472008-03-29 03:07:38 +0000935 if (urb) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300936 PWC_DEBUG_MEMORY("Freeing URB\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 usb_free_urb(urb);
938 pdev->sbuf[i].urb = NULL;
939 }
940 }
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300941}
942
943void pwc_isoc_cleanup(struct pwc_device *pdev)
944{
945 PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
946 if (pdev == NULL)
947 return;
948 if (pdev->iso_init == 0)
949 return;
950
951 pwc_iso_stop(pdev);
952 pwc_iso_free(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700953
954 /* Stop camera, but only if we are sure the camera is still there (unplug
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300955 is signalled by EPIPE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956 */
957 if (pdev->error_status && pdev->error_status != EPIPE) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300958 PWC_DEBUG_OPEN("Setting alternate interface 0.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 usb_set_interface(pdev->udev, 0, 0);
960 }
961
962 pdev->iso_init = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300963 PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700964}
965
966int pwc_try_video_mode(struct pwc_device *pdev, int width, int height, int new_fps, int new_compression, int new_snapshot)
967{
968 int ret, start;
969
970 /* Stop isoc stuff */
971 pwc_isoc_cleanup(pdev);
972 /* Reset parameters */
973 pwc_reset_buffers(pdev);
974 /* Try to set video mode... */
975 start = ret = pwc_set_video_mode(pdev, width, height, new_fps, new_compression, new_snapshot);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300976 if (ret) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300977 PWC_DEBUG_FLOW("pwc_set_video_mode attempt 1 failed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978 /* That failed... restore old mode (we know that worked) */
979 start = pwc_set_video_mode(pdev, pdev->view.x, pdev->view.y, pdev->vframes, pdev->vcompression, pdev->vsnapshot);
980 if (start) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300981 PWC_DEBUG_FLOW("pwc_set_video_mode attempt 2 failed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982 }
983 }
984 if (start == 0)
985 {
986 if (pwc_isoc_init(pdev) < 0)
987 {
Luc Saillard2b455db2006-04-24 10:29:46 -0300988 PWC_WARNING("Failed to restart ISOC transfers in pwc_try_video_mode.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700989 ret = -EAGAIN; /* let's try again, who knows if it works a second time */
990 }
991 }
992 pdev->drop_frames++; /* try to avoid garbage during switch */
993 return ret; /* Return original error code */
994}
995
Luc Saillard2b455db2006-04-24 10:29:46 -0300996/*********
997 * sysfs
998 *********/
Kay Sievers54bd5b62007-10-08 16:26:13 -0300999static struct pwc_device *cd_to_pwc(struct device *cd)
Luc Saillard2b455db2006-04-24 10:29:46 -03001000{
1001 struct video_device *vdev = to_video_device(cd);
1002 return video_get_drvdata(vdev);
1003}
1004
Kay Sievers54bd5b62007-10-08 16:26:13 -03001005static ssize_t show_pan_tilt(struct device *class_dev,
1006 struct device_attribute *attr, char *buf)
Luc Saillard2b455db2006-04-24 10:29:46 -03001007{
1008 struct pwc_device *pdev = cd_to_pwc(class_dev);
1009 return sprintf(buf, "%d %d\n", pdev->pan_angle, pdev->tilt_angle);
1010}
1011
Kay Sievers54bd5b62007-10-08 16:26:13 -03001012static ssize_t store_pan_tilt(struct device *class_dev,
1013 struct device_attribute *attr,
1014 const char *buf, size_t count)
Luc Saillard2b455db2006-04-24 10:29:46 -03001015{
1016 struct pwc_device *pdev = cd_to_pwc(class_dev);
1017 int pan, tilt;
1018 int ret = -EINVAL;
1019
1020 if (strncmp(buf, "reset", 5) == 0)
1021 ret = pwc_mpt_reset(pdev, 0x3);
1022
1023 else if (sscanf(buf, "%d %d", &pan, &tilt) > 0)
1024 ret = pwc_mpt_set_angle(pdev, pan, tilt);
1025
1026 if (ret < 0)
1027 return ret;
1028 return strlen(buf);
1029}
Kay Sievers54bd5b62007-10-08 16:26:13 -03001030static DEVICE_ATTR(pan_tilt, S_IRUGO | S_IWUSR, show_pan_tilt,
1031 store_pan_tilt);
Luc Saillard2b455db2006-04-24 10:29:46 -03001032
Kay Sievers54bd5b62007-10-08 16:26:13 -03001033static ssize_t show_snapshot_button_status(struct device *class_dev,
1034 struct device_attribute *attr, char *buf)
Luc Saillard2b455db2006-04-24 10:29:46 -03001035{
1036 struct pwc_device *pdev = cd_to_pwc(class_dev);
1037 int status = pdev->snapshot_button_status;
1038 pdev->snapshot_button_status = 0;
1039 return sprintf(buf, "%d\n", status);
1040}
1041
Kay Sievers54bd5b62007-10-08 16:26:13 -03001042static DEVICE_ATTR(button, S_IRUGO | S_IWUSR, show_snapshot_button_status,
1043 NULL);
Luc Saillard2b455db2006-04-24 10:29:46 -03001044
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001045static int pwc_create_sysfs_files(struct video_device *vdev)
Luc Saillard2b455db2006-04-24 10:29:46 -03001046{
1047 struct pwc_device *pdev = video_get_drvdata(vdev);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001048 int rc;
1049
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001050 rc = device_create_file(&vdev->dev, &dev_attr_button);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001051 if (rc)
1052 goto err;
1053 if (pdev->features & FEATURE_MOTOR_PANTILT) {
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001054 rc = device_create_file(&vdev->dev, &dev_attr_pan_tilt);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001055 if (rc) goto err_button;
1056 }
1057
1058 return 0;
1059
1060err_button:
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001061 device_remove_file(&vdev->dev, &dev_attr_button);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001062err:
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001063 PWC_ERROR("Could not create sysfs files.\n");
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001064 return rc;
Luc Saillard2b455db2006-04-24 10:29:46 -03001065}
1066
1067static void pwc_remove_sysfs_files(struct video_device *vdev)
1068{
1069 struct pwc_device *pdev = video_get_drvdata(vdev);
1070 if (pdev->features & FEATURE_MOTOR_PANTILT)
Hans Verkuilf894dfd2008-07-25 07:39:54 -03001071 device_remove_file(&vdev->dev, &dev_attr_pan_tilt);
1072 device_remove_file(&vdev->dev, &dev_attr_button);
Luc Saillard2b455db2006-04-24 10:29:46 -03001073}
1074
Trent Piepho05ad3902007-01-30 23:26:01 -03001075#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001076static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
1077{
1078 switch(sensor_type) {
1079 case 0x00:
1080 return "Hyundai CMOS sensor";
1081 case 0x20:
1082 return "Sony CCD sensor + TDA8787";
1083 case 0x2E:
1084 return "Sony CCD sensor + Exas 98L59";
1085 case 0x2F:
1086 return "Sony CCD sensor + ADI 9804";
1087 case 0x30:
1088 return "Sharp CCD sensor + TDA8787";
1089 case 0x3E:
1090 return "Sharp CCD sensor + Exas 98L59";
1091 case 0x3F:
1092 return "Sharp CCD sensor + ADI 9804";
1093 case 0x40:
1094 return "UPA 1021 sensor";
1095 case 0x100:
1096 return "VGA sensor";
1097 case 0x101:
1098 return "PAL MR sensor";
1099 default:
Trent Piepho657de3c2006-06-20 00:30:57 -03001100 return "unknown type of sensor";
Luc Saillard2b455db2006-04-24 10:29:46 -03001101 }
1102}
1103#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104
1105/***************************************************************************/
1106/* Video4Linux functions */
1107
1108static int pwc_video_open(struct inode *inode, struct file *file)
1109{
Luc Saillard2b455db2006-04-24 10:29:46 -03001110 int i, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111 struct video_device *vdev = video_devdata(file);
1112 struct pwc_device *pdev;
1113
Luc Saillard2b455db2006-04-24 10:29:46 -03001114 PWC_DEBUG_OPEN(">> video_open called(vdev = 0x%p).\n", vdev);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001115
Linus Torvalds1da177e2005-04-16 15:20:36 -07001116 pdev = (struct pwc_device *)vdev->priv;
Eric Sesterhenn5d9a2762006-11-30 05:26:46 +01001117 BUG_ON(!pdev);
Luc Saillard2b455db2006-04-24 10:29:46 -03001118 if (pdev->vopen) {
1119 PWC_DEBUG_OPEN("I'm busy, someone is using the device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001120 return -EBUSY;
Luc Saillard2b455db2006-04-24 10:29:46 -03001121 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001122
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001123 mutex_lock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124 if (!pdev->usb_init) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001125 PWC_DEBUG_OPEN("Doing first time initialization.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001126 pdev->usb_init = 1;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001127
Luc Saillard2b455db2006-04-24 10:29:46 -03001128 /* Query sensor type */
1129 ret = pwc_get_cmos_sensor(pdev, &i);
1130 if (ret >= 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131 {
Luc Saillard2b455db2006-04-24 10:29:46 -03001132 PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
1133 pdev->vdev->name,
1134 pwc_sensor_type_to_string(i), i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001135 }
1136 }
1137
1138 /* Turn on camera */
1139 if (power_save) {
1140 i = pwc_camera_power(pdev, 1);
1141 if (i < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001142 PWC_DEBUG_OPEN("Failed to restore power to the camera! (%d)\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001143 }
1144 /* Set LED on/off time */
1145 if (pwc_set_leds(pdev, led_on, led_off) < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001146 PWC_DEBUG_OPEN("Failed to set LED on/off time.\n");
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001147
Linus Torvalds1da177e2005-04-16 15:20:36 -07001148 pwc_construct(pdev); /* set min/max sizes correct */
1149
1150 /* So far, so good. Allocate memory. */
1151 i = pwc_allocate_buffers(pdev);
1152 if (i < 0) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001153 PWC_DEBUG_OPEN("Failed to allocate buffers memory.\n");
1154 pwc_free_buffers(pdev);
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001155 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001156 return i;
1157 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001158
Linus Torvalds1da177e2005-04-16 15:20:36 -07001159 /* Reset buffers & parameters */
1160 pwc_reset_buffers(pdev);
Luc Saillard2b455db2006-04-24 10:29:46 -03001161 for (i = 0; i < pwc_mbufs; i++)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162 pdev->image_used[i] = 0;
1163 pdev->vframe_count = 0;
1164 pdev->vframes_dumped = 0;
1165 pdev->vframes_error = 0;
1166 pdev->visoc_errors = 0;
1167 pdev->error_status = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168 pwc_construct(pdev); /* set min/max sizes correct */
1169
1170 /* Set some defaults */
1171 pdev->vsnapshot = 0;
1172
1173 /* Start iso pipe for video; first try the last used video size
1174 (or the default one); if that fails try QCIF/10 or QSIF/10;
1175 it that fails too, give up.
1176 */
1177 i = pwc_set_video_mode(pdev, pwc_image_sizes[pdev->vsize].x, pwc_image_sizes[pdev->vsize].y, pdev->vframes, pdev->vcompression, 0);
1178 if (i) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001179 unsigned int default_resolution;
1180 PWC_DEBUG_OPEN("First attempt at set_video_mode failed.\n");
1181 if (pdev->type>= 730)
1182 default_resolution = PSZ_QSIF;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001183 else
Luc Saillard2b455db2006-04-24 10:29:46 -03001184 default_resolution = PSZ_QCIF;
1185
1186 i = pwc_set_video_mode(pdev,
1187 pwc_image_sizes[default_resolution].x,
1188 pwc_image_sizes[default_resolution].y,
1189 10,
1190 pdev->vcompression,
1191 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001192 }
1193 if (i) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001194 PWC_DEBUG_OPEN("Second attempt at set_video_mode failed.\n");
1195 pwc_free_buffers(pdev);
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001196 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001197 return i;
1198 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001199
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 i = pwc_isoc_init(pdev);
1201 if (i) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001202 PWC_DEBUG_OPEN("Failed to init ISOC stuff = %d.\n", i);
1203 pwc_isoc_cleanup(pdev);
1204 pwc_free_buffers(pdev);
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001205 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001206 return i;
1207 }
1208
Luc Saillard2b455db2006-04-24 10:29:46 -03001209 /* Initialize the webcam to sane value */
1210 pwc_set_brightness(pdev, 0x7fff);
1211 pwc_set_agc(pdev, 1, 0);
1212
Linus Torvalds1da177e2005-04-16 15:20:36 -07001213 pdev->vopen++;
1214 file->private_data = vdev;
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001215 mutex_unlock(&pdev->modlock);
Luc Saillard2b455db2006-04-24 10:29:46 -03001216 PWC_DEBUG_OPEN("<< video_open() returns 0.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217 return 0;
1218}
1219
Oliver Neukum85237f22007-08-21 07:10:42 +02001220
1221static void pwc_cleanup(struct pwc_device *pdev)
1222{
1223 pwc_remove_sysfs_files(pdev->vdev);
1224 video_unregister_device(pdev->vdev);
1225}
1226
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227/* Note that all cleanup is done in the reverse order as in _open */
1228static int pwc_video_close(struct inode *inode, struct file *file)
1229{
1230 struct video_device *vdev = file->private_data;
1231 struct pwc_device *pdev;
Oliver Neukum85237f22007-08-21 07:10:42 +02001232 int i, hint;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001233
Luc Saillard2b455db2006-04-24 10:29:46 -03001234 PWC_DEBUG_OPEN(">> video_close called(vdev = 0x%p).\n", vdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001235
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001236 lock_kernel();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001237 pdev = (struct pwc_device *)vdev->priv;
1238 if (pdev->vopen == 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001239 PWC_DEBUG_MODULE("video_close() called on closed device?\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001240
1241 /* Dump statistics, but only if a reasonable amount of frames were
1242 processed (to prevent endless log-entries in case of snap-shot
1243 programs)
1244 */
1245 if (pdev->vframe_count > 20)
Luc Saillard2b455db2006-04-24 10:29:46 -03001246 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 -07001247
Luc Saillard2b455db2006-04-24 10:29:46 -03001248 if (DEVICE_USE_CODEC1(pdev->type))
1249 pwc_dec1_exit();
1250 else
1251 pwc_dec23_exit();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001252
1253 pwc_isoc_cleanup(pdev);
1254 pwc_free_buffers(pdev);
1255
1256 /* Turn off LEDS and power down camera, but only when not unplugged */
Oliver Neukum85237f22007-08-21 07:10:42 +02001257 if (!pdev->unplugged) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001258 /* Turn LEDs off */
1259 if (pwc_set_leds(pdev, 0, 0) < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001260 PWC_DEBUG_MODULE("Failed to set LED on/off time.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001261 if (power_save) {
1262 i = pwc_camera_power(pdev, 0);
1263 if (i < 0)
Luc Saillard2b455db2006-04-24 10:29:46 -03001264 PWC_ERROR("Failed to power down camera (%d)\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265 }
Oliver Neukum85237f22007-08-21 07:10:42 +02001266 pdev->vopen--;
Jean Delvare7b9fbc32007-09-03 11:51:51 -03001267 PWC_DEBUG_OPEN("<< video_close() vopen=%d\n", pdev->vopen);
Oliver Neukum85237f22007-08-21 07:10:42 +02001268 } else {
1269 pwc_cleanup(pdev);
1270 /* Free memory (don't set pdev to 0 just yet) */
1271 kfree(pdev);
1272 /* search device_hint[] table if we occupy a slot, by any chance */
1273 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1274 if (device_hint[hint].pdev == pdev)
1275 device_hint[hint].pdev = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276 }
Oliver Neukum85237f22007-08-21 07:10:42 +02001277 unlock_kernel();
1278
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279 return 0;
1280}
1281
1282/*
1283 * FIXME: what about two parallel reads ????
1284 * ANSWER: Not supported. You can't open the device more than once,
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001285 despite what the V4L1 interface says. First, I don't see
1286 the need, second there's no mechanism of alerting the
1287 2nd/3rd/... process of events like changing image size.
1288 And I don't see the point of blocking that for the
1289 2nd/3rd/... process.
1290 In multi-threaded environments reading parallel from any
1291 device is tricky anyhow.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292 */
1293
Luc Saillard2b455db2006-04-24 10:29:46 -03001294static ssize_t pwc_video_read(struct file *file, char __user *buf,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295 size_t count, loff_t *ppos)
1296{
1297 struct video_device *vdev = file->private_data;
1298 struct pwc_device *pdev;
1299 int noblock = file->f_flags & O_NONBLOCK;
1300 DECLARE_WAITQUEUE(wait, current);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001301 int bytes_to_read, rv = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -03001302 void *image_buffer_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001303
Luc Saillard2b455db2006-04-24 10:29:46 -03001304 PWC_DEBUG_READ("pwc_video_read(vdev=0x%p, buf=%p, count=%zd) called.\n",
1305 vdev, buf, count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306 if (vdev == NULL)
1307 return -EFAULT;
1308 pdev = vdev->priv;
1309 if (pdev == NULL)
1310 return -EFAULT;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001311
1312 mutex_lock(&pdev->modlock);
1313 if (pdev->error_status) {
1314 rv = -pdev->error_status; /* Something happened, report what. */
1315 goto err_out;
1316 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317
1318 /* In case we're doing partial reads, we don't have to wait for a frame */
1319 if (pdev->image_read_pos == 0) {
1320 /* Do wait queueing according to the (doc)book */
1321 add_wait_queue(&pdev->frameq, &wait);
1322 while (pdev->full_frames == NULL) {
1323 /* Check for unplugged/etc. here */
1324 if (pdev->error_status) {
1325 remove_wait_queue(&pdev->frameq, &wait);
1326 set_current_state(TASK_RUNNING);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001327 rv = -pdev->error_status ;
1328 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001330 if (noblock) {
1331 remove_wait_queue(&pdev->frameq, &wait);
1332 set_current_state(TASK_RUNNING);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001333 rv = -EWOULDBLOCK;
1334 goto err_out;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001335 }
1336 if (signal_pending(current)) {
1337 remove_wait_queue(&pdev->frameq, &wait);
1338 set_current_state(TASK_RUNNING);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001339 rv = -ERESTARTSYS;
1340 goto err_out;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001341 }
1342 schedule();
1343 set_current_state(TASK_INTERRUPTIBLE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344 }
1345 remove_wait_queue(&pdev->frameq, &wait);
1346 set_current_state(TASK_RUNNING);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001347
Linus Torvalds1da177e2005-04-16 15:20:36 -07001348 /* Decompress and release frame */
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001349 if (pwc_handle_frame(pdev)) {
1350 rv = -EFAULT;
1351 goto err_out;
1352 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353 }
1354
Luc Saillard2b455db2006-04-24 10:29:46 -03001355 PWC_DEBUG_READ("Copying data to user space.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356 if (pdev->vpalette == VIDEO_PALETTE_RAW)
Luc Saillard2b455db2006-04-24 10:29:46 -03001357 bytes_to_read = pdev->frame_size + sizeof(struct pwc_raw_frame);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358 else
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001359 bytes_to_read = pdev->view.size;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360
1361 /* copy bytes to user space; we allow for partial reads */
1362 if (count + pdev->image_read_pos > bytes_to_read)
1363 count = bytes_to_read - pdev->image_read_pos;
Luc Saillard2b455db2006-04-24 10:29:46 -03001364 image_buffer_addr = pdev->image_data;
1365 image_buffer_addr += pdev->images[pdev->fill_image].offset;
1366 image_buffer_addr += pdev->image_read_pos;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001367 if (copy_to_user(buf, image_buffer_addr, count)) {
1368 rv = -EFAULT;
1369 goto err_out;
1370 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001371 pdev->image_read_pos += count;
1372 if (pdev->image_read_pos >= bytes_to_read) { /* All data has been read */
1373 pdev->image_read_pos = 0;
1374 pwc_next_image(pdev);
1375 }
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001376 mutex_unlock(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001377 return count;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001378err_out:
1379 mutex_unlock(&pdev->modlock);
1380 return rv;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001381}
1382
1383static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
1384{
1385 struct video_device *vdev = file->private_data;
1386 struct pwc_device *pdev;
1387
1388 if (vdev == NULL)
1389 return -EFAULT;
1390 pdev = vdev->priv;
1391 if (pdev == NULL)
1392 return -EFAULT;
1393
1394 poll_wait(file, &pdev->frameq, wait);
1395 if (pdev->error_status)
1396 return POLLERR;
1397 if (pdev->full_frames != NULL) /* we have frames waiting */
1398 return (POLLIN | POLLRDNORM);
1399
1400 return 0;
1401}
1402
Linus Torvalds1da177e2005-04-16 15:20:36 -07001403static int pwc_video_ioctl(struct inode *inode, struct file *file,
1404 unsigned int cmd, unsigned long arg)
1405{
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001406 struct video_device *vdev = file->private_data;
1407 struct pwc_device *pdev;
1408 int r = -ENODEV;
1409
1410 if (!vdev)
1411 goto out;
1412 pdev = vdev->priv;
1413
1414 mutex_lock(&pdev->modlock);
1415 if (!pdev->unplugged)
1416 r = video_usercopy(inode, file, cmd, arg, pwc_video_do_ioctl);
1417 mutex_unlock(&pdev->modlock);
1418out:
1419 return r;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001420}
1421
Linus Torvalds1da177e2005-04-16 15:20:36 -07001422static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
1423{
1424 struct video_device *vdev = file->private_data;
1425 struct pwc_device *pdev;
Luc Saillard2b455db2006-04-24 10:29:46 -03001426 unsigned long start;
1427 unsigned long size;
1428 unsigned long page, pos = 0;
1429 int index;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001430
Harvey Harrison645635b2008-04-08 23:20:00 -03001431 PWC_DEBUG_MEMORY(">> %s\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001432 pdev = vdev->priv;
Luc Saillard2b455db2006-04-24 10:29:46 -03001433 size = vma->vm_end - vma->vm_start;
1434 start = vma->vm_start;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001435
Luc Saillard2b455db2006-04-24 10:29:46 -03001436 /* Find the idx buffer for this mapping */
1437 for (index = 0; index < pwc_mbufs; index++) {
1438 pos = pdev->images[index].offset;
1439 if ((pos>>PAGE_SHIFT) == vma->vm_pgoff)
1440 break;
1441 }
1442 if (index == MAX_IMAGES)
1443 return -EINVAL;
1444 if (index == 0) {
1445 /*
1446 * Special case for v4l1. In v4l1, we map only one big buffer,
1447 * but in v4l2 each buffer is mapped
1448 */
1449 unsigned long total_size;
1450 total_size = pwc_mbufs * pdev->len_per_image;
1451 if (size != pdev->len_per_image && size != total_size) {
1452 PWC_ERROR("Wrong size (%lu) needed to be len_per_image=%d or total_size=%lu\n",
1453 size, pdev->len_per_image, total_size);
1454 return -EINVAL;
1455 }
1456 } else if (size > pdev->len_per_image)
1457 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001458
Luc Saillard2b455db2006-04-24 10:29:46 -03001459 vma->vm_flags |= VM_IO; /* from 2.6.9-acX */
1460
1461 pos += (unsigned long)pdev->image_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001462 while (size > 0) {
1463 page = vmalloc_to_pfn((void *)pos);
1464 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
1465 return -EAGAIN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001466 start += PAGE_SIZE;
1467 pos += PAGE_SIZE;
1468 if (size > PAGE_SIZE)
1469 size -= PAGE_SIZE;
1470 else
1471 size = 0;
1472 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473 return 0;
1474}
1475
1476/***************************************************************************/
1477/* USB functions */
1478
1479/* This function gets called when a new device is plugged in or the usb core
1480 * is loaded.
1481 */
1482
1483static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
1484{
1485 struct usb_device *udev = interface_to_usbdev(intf);
1486 struct pwc_device *pdev = NULL;
1487 int vendor_id, product_id, type_id;
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001488 int i, hint, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489 int features = 0;
1490 int video_nr = -1; /* default: use next available device */
1491 char serial_number[30], *name;
1492
Luc Saillard2b455db2006-04-24 10:29:46 -03001493 vendor_id = le16_to_cpu(udev->descriptor.idVendor);
1494 product_id = le16_to_cpu(udev->descriptor.idProduct);
1495
Linus Torvalds1da177e2005-04-16 15:20:36 -07001496 /* Check if we can handle this device */
Luc Saillard2b455db2006-04-24 10:29:46 -03001497 PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
1498 vendor_id, product_id,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001499 intf->altsetting->desc.bInterfaceNumber);
1500
1501 /* the interfaces are probed one by one. We are only interested in the
1502 video interface (0) now.
1503 Interface 1 is the Audio Control, and interface 2 Audio itself.
1504 */
1505 if (intf->altsetting->desc.bInterfaceNumber > 0)
1506 return -ENODEV;
1507
Linus Torvalds1da177e2005-04-16 15:20:36 -07001508 if (vendor_id == 0x0471) {
1509 switch (product_id) {
1510 case 0x0302:
Luc Saillard2b455db2006-04-24 10:29:46 -03001511 PWC_INFO("Philips PCA645VC USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001512 name = "Philips 645 webcam";
1513 type_id = 645;
1514 break;
1515 case 0x0303:
Luc Saillard2b455db2006-04-24 10:29:46 -03001516 PWC_INFO("Philips PCA646VC USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001517 name = "Philips 646 webcam";
1518 type_id = 646;
1519 break;
1520 case 0x0304:
Luc Saillard2b455db2006-04-24 10:29:46 -03001521 PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522 name = "Askey VC010 webcam";
1523 type_id = 646;
1524 break;
1525 case 0x0307:
Luc Saillard2b455db2006-04-24 10:29:46 -03001526 PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527 name = "Philips 675 webcam";
1528 type_id = 675;
1529 break;
1530 case 0x0308:
Luc Saillard2b455db2006-04-24 10:29:46 -03001531 PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001532 name = "Philips 680 webcam";
1533 type_id = 680;
1534 break;
1535 case 0x030C:
Luc Saillard2b455db2006-04-24 10:29:46 -03001536 PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537 name = "Philips 690 webcam";
1538 type_id = 690;
1539 break;
1540 case 0x0310:
Luc Saillard2b455db2006-04-24 10:29:46 -03001541 PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542 name = "Philips 730 webcam";
1543 type_id = 730;
1544 break;
1545 case 0x0311:
Luc Saillard2b455db2006-04-24 10:29:46 -03001546 PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001547 name = "Philips 740 webcam";
1548 type_id = 740;
1549 break;
1550 case 0x0312:
Luc Saillard2b455db2006-04-24 10:29:46 -03001551 PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001552 name = "Philips 750 webcam";
1553 type_id = 750;
1554 break;
1555 case 0x0313:
Luc Saillard2b455db2006-04-24 10:29:46 -03001556 PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557 name = "Philips 720K/40 webcam";
1558 type_id = 720;
1559 break;
Luc Saillard2b455db2006-04-24 10:29:46 -03001560 case 0x0329:
1561 PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
1562 name = "Philips SPC 900NC webcam";
Luc Saillard9ee6d782007-04-22 23:54:36 -03001563 type_id = 740;
Luc Saillard2b455db2006-04-24 10:29:46 -03001564 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001565 default:
1566 return -ENODEV;
1567 break;
1568 }
1569 }
1570 else if (vendor_id == 0x069A) {
1571 switch(product_id) {
1572 case 0x0001:
Luc Saillard2b455db2006-04-24 10:29:46 -03001573 PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001574 name = "Askey VC010 webcam";
1575 type_id = 645;
1576 break;
1577 default:
1578 return -ENODEV;
1579 break;
1580 }
1581 }
1582 else if (vendor_id == 0x046d) {
1583 switch(product_id) {
1584 case 0x08b0:
Luc Saillard2b455db2006-04-24 10:29:46 -03001585 PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586 name = "Logitech QuickCam Pro 3000";
1587 type_id = 740; /* CCD sensor */
1588 break;
1589 case 0x08b1:
Luc Saillard2b455db2006-04-24 10:29:46 -03001590 PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001591 name = "Logitech QuickCam Notebook Pro";
1592 type_id = 740; /* CCD sensor */
1593 break;
1594 case 0x08b2:
Luc Saillard2b455db2006-04-24 10:29:46 -03001595 PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 name = "Logitech QuickCam Pro 4000";
1597 type_id = 740; /* CCD sensor */
1598 break;
1599 case 0x08b3:
Luc Saillard2b455db2006-04-24 10:29:46 -03001600 PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001601 name = "Logitech QuickCam Zoom";
1602 type_id = 740; /* CCD sensor */
1603 break;
1604 case 0x08B4:
Luc Saillard2b455db2006-04-24 10:29:46 -03001605 PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001606 name = "Logitech QuickCam Zoom";
1607 type_id = 740; /* CCD sensor */
Luc Saillard2b455db2006-04-24 10:29:46 -03001608 power_save = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001609 break;
1610 case 0x08b5:
Luc Saillard2b455db2006-04-24 10:29:46 -03001611 PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001612 name = "Logitech QuickCam Orbit";
1613 type_id = 740; /* CCD sensor */
1614 features |= FEATURE_MOTOR_PANTILT;
1615 break;
1616 case 0x08b6:
Jean Tourrilhesa63e1572007-03-21 16:29:16 -03001617 PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
1618 name = "Cisco VT Camera";
1619 type_id = 740; /* CCD sensor */
1620 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621 case 0x08b7:
Mauro Carvalho Chehab6b1ce3c2007-03-21 16:35:28 -03001622 PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
1623 name = "Logitech ViewPort AV 100";
1624 type_id = 740; /* CCD sensor */
1625 break;
1626 case 0x08b8: /* Where this released? */
Luc Saillard2b455db2006-04-24 10:29:46 -03001627 PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628 name = "Logitech QuickCam (res.)";
1629 type_id = 730; /* Assuming CMOS */
1630 break;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001631 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632 return -ENODEV;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001633 break;
1634 }
1635 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001636 else if (vendor_id == 0x055d) {
1637 /* I don't know the difference between the C10 and the C30;
1638 I suppose the difference is the sensor, but both cameras
1639 work equally well with a type_id of 675
1640 */
1641 switch(product_id) {
1642 case 0x9000:
Luc Saillard2b455db2006-04-24 10:29:46 -03001643 PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644 name = "Samsung MPC-C10";
1645 type_id = 675;
1646 break;
1647 case 0x9001:
Luc Saillard2b455db2006-04-24 10:29:46 -03001648 PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001649 name = "Samsung MPC-C30";
1650 type_id = 675;
1651 break;
Luc Saillard2b455db2006-04-24 10:29:46 -03001652 case 0x9002:
1653 PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
1654 name = "Samsung MPC-C30";
1655 type_id = 740;
1656 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001657 default:
1658 return -ENODEV;
1659 break;
1660 }
1661 }
1662 else if (vendor_id == 0x041e) {
1663 switch(product_id) {
1664 case 0x400c:
Luc Saillard2b455db2006-04-24 10:29:46 -03001665 PWC_INFO("Creative Labs Webcam 5 detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001666 name = "Creative Labs Webcam 5";
1667 type_id = 730;
1668 break;
1669 case 0x4011:
Luc Saillard2b455db2006-04-24 10:29:46 -03001670 PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001671 name = "Creative Labs Webcam Pro Ex";
1672 type_id = 740;
1673 break;
1674 default:
1675 return -ENODEV;
1676 break;
1677 }
1678 }
1679 else if (vendor_id == 0x04cc) {
1680 switch(product_id) {
1681 case 0x8116:
Luc Saillard2b455db2006-04-24 10:29:46 -03001682 PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001683 name = "Sotec Afina Eye";
1684 type_id = 730;
1685 break;
1686 default:
1687 return -ENODEV;
1688 break;
1689 }
1690 }
1691 else if (vendor_id == 0x06be) {
1692 switch(product_id) {
1693 case 0x8116:
1694 /* This is essentially the same cam as the Sotec Afina Eye */
Luc Saillard2b455db2006-04-24 10:29:46 -03001695 PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001696 name = "AME Co. Afina Eye";
1697 type_id = 750;
1698 break;
1699 default:
1700 return -ENODEV;
1701 break;
1702 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001703
Linus Torvalds1da177e2005-04-16 15:20:36 -07001704 }
1705 else if (vendor_id == 0x0d81) {
1706 switch(product_id) {
1707 case 0x1900:
Luc Saillard2b455db2006-04-24 10:29:46 -03001708 PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001709 name = "Visionite VCS-UC300";
1710 type_id = 740; /* CCD sensor */
1711 break;
1712 case 0x1910:
Luc Saillard2b455db2006-04-24 10:29:46 -03001713 PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714 name = "Visionite VCS-UM100";
1715 type_id = 730; /* CMOS sensor */
1716 break;
1717 default:
1718 return -ENODEV;
1719 break;
1720 }
1721 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001722 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001723 return -ENODEV; /* Not any of the know types; but the list keeps growing. */
1724
1725 memset(serial_number, 0, 30);
1726 usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
Luc Saillard2b455db2006-04-24 10:29:46 -03001727 PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001728
1729 if (udev->descriptor.bNumConfigurations > 1)
Luc Saillard2b455db2006-04-24 10:29:46 -03001730 PWC_WARNING("Warning: more than 1 configuration available.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001731
1732 /* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
Eric Sesterhenn80b6ca42006-02-27 21:29:43 +01001733 pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001734 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001735 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001736 return -ENOMEM;
1737 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001738 pdev->type = type_id;
1739 pdev->vsize = default_size;
1740 pdev->vframes = default_fps;
1741 strcpy(pdev->serial, serial_number);
1742 pdev->features = features;
1743 if (vendor_id == 0x046D && product_id == 0x08B5)
1744 {
1745 /* Logitech QuickCam Orbit
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001746 The ranges have been determined experimentally; they may differ from cam to cam.
1747 Also, the exact ranges left-right and up-down are different for my cam
1748 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001749 pdev->angle_range.pan_min = -7000;
1750 pdev->angle_range.pan_max = 7000;
1751 pdev->angle_range.tilt_min = -3000;
1752 pdev->angle_range.tilt_max = 2500;
1753 }
1754
Matthias Kaehlckeb9378fd2007-07-02 10:04:52 -03001755 mutex_init(&pdev->modlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001756 spin_lock_init(&pdev->ptrlock);
1757
1758 pdev->udev = udev;
1759 init_waitqueue_head(&pdev->frameq);
1760 pdev->vcompression = pwc_preferred_compression;
1761
1762 /* Allocate video_device structure */
1763 pdev->vdev = video_device_alloc();
Al Viro5fa12472008-03-29 03:07:38 +00001764 if (!pdev->vdev) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001765 PWC_ERROR("Err, cannot allocate video_device struture. Failing probe.");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001766 kfree(pdev);
1767 return -ENOMEM;
1768 }
1769 memcpy(pdev->vdev, &pwc_template, sizeof(pwc_template));
Hans Verkuil5e85e732008-07-20 06:31:39 -03001770 pdev->vdev->parent = &(udev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001771 strcpy(pdev->vdev->name, name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001772 video_set_drvdata(pdev->vdev, pdev);
1773
1774 pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
Luc Saillard2b455db2006-04-24 10:29:46 -03001775 PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001776
1777 /* Now search device_hint[] table for a match, so we can hint a node number. */
1778 for (hint = 0; hint < MAX_DEV_HINTS; hint++) {
1779 if (((device_hint[hint].type == -1) || (device_hint[hint].type == pdev->type)) &&
1780 (device_hint[hint].pdev == NULL)) {
1781 /* so far, so good... try serial number */
1782 if ((device_hint[hint].serial_number[0] == '*') || !strcmp(device_hint[hint].serial_number, serial_number)) {
Trent Piepho657de3c2006-06-20 00:30:57 -03001783 /* match! */
1784 video_nr = device_hint[hint].device_node;
1785 PWC_DEBUG_PROBE("Found hint, will try to register as /dev/video%d\n", video_nr);
1786 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001787 }
1788 }
1789 }
1790
1791 pdev->vdev->release = video_device_release;
1792 i = video_register_device(pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1793 if (i < 0) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001794 PWC_ERROR("Failed to register as video device (%d).\n", i);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001795 rc = i;
1796 goto err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001797 }
1798 else {
Luc Saillard2b455db2006-04-24 10:29:46 -03001799 PWC_INFO("Registered as /dev/video%d.\n", pdev->vdev->minor & 0x3F);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001800 }
1801
1802 /* occupy slot */
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001803 if (hint < MAX_DEV_HINTS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001804 device_hint[hint].pdev = pdev;
1805
Luc Saillard2b455db2006-04-24 10:29:46 -03001806 PWC_DEBUG_PROBE("probe() function returning struct at 0x%p.\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001807 usb_set_intfdata (intf, pdev);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001808 rc = pwc_create_sysfs_files(pdev->vdev);
1809 if (rc)
1810 goto err_unreg;
Luc Saillard2b455db2006-04-24 10:29:46 -03001811
1812 /* Set the leds off */
1813 pwc_set_leds(pdev, 0, 0);
1814 pwc_camera_power(pdev, 0);
1815
Linus Torvalds1da177e2005-04-16 15:20:36 -07001816 return 0;
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001817
1818err_unreg:
1819 if (hint < MAX_DEV_HINTS)
1820 device_hint[hint].pdev = NULL;
1821 video_unregister_device(pdev->vdev);
1822err:
1823 video_device_release(pdev->vdev); /* Drip... drip... drip... */
1824 kfree(pdev); /* Oops, no memory leaks please */
1825 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001826}
1827
1828/* The user janked out the cable... */
1829static void usb_pwc_disconnect(struct usb_interface *intf)
1830{
1831 struct pwc_device *pdev;
1832 int hint;
1833
1834 lock_kernel();
1835 pdev = usb_get_intfdata (intf);
1836 usb_set_intfdata (intf, NULL);
1837 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001838 PWC_ERROR("pwc_disconnect() Called without private pointer.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001839 goto disconnect_out;
1840 }
1841 if (pdev->udev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001842 PWC_ERROR("pwc_disconnect() already called for %p\n", pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001843 goto disconnect_out;
1844 }
1845 if (pdev->udev != interface_to_usbdev(intf)) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001846 PWC_ERROR("pwc_disconnect() Woops: pointer mismatch udev/pdev.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847 goto disconnect_out;
1848 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001849
Linus Torvalds1da177e2005-04-16 15:20:36 -07001850 /* We got unplugged; this is signalled by an EPIPE error code */
1851 if (pdev->vopen) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001852 PWC_INFO("Disconnected while webcam is in use!\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001853 pdev->error_status = EPIPE;
1854 }
1855
1856 /* Alert waiting processes */
1857 wake_up_interruptible(&pdev->frameq);
1858 /* Wait until device is closed */
Oliver Neukum85237f22007-08-21 07:10:42 +02001859 if(pdev->vopen) {
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001860 mutex_lock(&pdev->modlock);
Oliver Neukum85237f22007-08-21 07:10:42 +02001861 pdev->unplugged = 1;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -03001862 mutex_unlock(&pdev->modlock);
1863 pwc_iso_stop(pdev);
Oliver Neukum85237f22007-08-21 07:10:42 +02001864 } else {
1865 /* Device is closed, so we can safely unregister it */
1866 PWC_DEBUG_PROBE("Unregistering video device in disconnect().\n");
1867 pwc_cleanup(pdev);
1868 /* Free memory (don't set pdev to 0 just yet) */
1869 kfree(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001870
1871disconnect_out:
Oliver Neukum85237f22007-08-21 07:10:42 +02001872 /* search device_hint[] table if we occupy a slot, by any chance */
1873 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1874 if (device_hint[hint].pdev == pdev)
1875 device_hint[hint].pdev = NULL;
1876 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001877
1878 unlock_kernel();
1879}
1880
Linus Torvalds1da177e2005-04-16 15:20:36 -07001881/* *grunt* We have to do atoi ourselves :-( */
1882static int pwc_atoi(const char *s)
1883{
1884 int k = 0;
1885
1886 k = 0;
1887 while (*s != '\0' && *s >= '0' && *s <= '9') {
1888 k = 10 * k + (*s - '0');
1889 s++;
1890 }
1891 return k;
1892}
1893
1894
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001895/*
1896 * Initialization code & module stuff
Linus Torvalds1da177e2005-04-16 15:20:36 -07001897 */
1898
Luc Saillard2b455db2006-04-24 10:29:46 -03001899static char *size;
1900static int fps;
1901static int fbufs;
1902static int mbufs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903static int compression = -1;
1904static int leds[2] = { -1, -1 };
Al Viro64a6f952007-10-14 19:35:30 +01001905static unsigned int leds_nargs;
Luc Saillard2b455db2006-04-24 10:29:46 -03001906static char *dev_hint[MAX_DEV_HINTS];
Al Viro64a6f952007-10-14 19:35:30 +01001907static unsigned int dev_hint_nargs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001908
Luc Saillard2b455db2006-04-24 10:29:46 -03001909module_param(size, charp, 0444);
1910module_param(fps, int, 0444);
1911module_param(fbufs, int, 0444);
1912module_param(mbufs, int, 0444);
Trent Piepho05ad3902007-01-30 23:26:01 -03001913#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001914module_param_named(trace, pwc_trace, int, 0644);
1915#endif
1916module_param(power_save, int, 0444);
1917module_param(compression, int, 0444);
1918module_param_array(leds, int, &leds_nargs, 0444);
1919module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
1920
Linus Torvalds1da177e2005-04-16 15:20:36 -07001921MODULE_PARM_DESC(size, "Initial image size. One of sqcif, qsif, qcif, sif, cif, vga");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001922MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001923MODULE_PARM_DESC(fbufs, "Number of internal frame buffers to reserve");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924MODULE_PARM_DESC(mbufs, "Number of external (mmap()ed) image buffers");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001925MODULE_PARM_DESC(trace, "For debugging purposes");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001926MODULE_PARM_DESC(power_save, "Turn power save feature in camera on or off");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001927MODULE_PARM_DESC(compression, "Preferred compression quality. Range 0 (uncompressed) to 3 (high compression)");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001928MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001929MODULE_PARM_DESC(dev_hint, "Device node hints");
1930
1931MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
1932MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
1933MODULE_LICENSE("GPL");
Luc Saillard2b455db2006-04-24 10:29:46 -03001934MODULE_ALIAS("pwcx");
1935MODULE_VERSION( PWC_VERSION );
Linus Torvalds1da177e2005-04-16 15:20:36 -07001936
1937static int __init usb_pwc_init(void)
1938{
1939 int i, sz;
1940 char *sizenames[PSZ_MAX] = { "sqcif", "qsif", "qcif", "sif", "cif", "vga" };
1941
Luc Saillard2b455db2006-04-24 10:29:46 -03001942 PWC_INFO("Philips webcam module version " PWC_VERSION " loaded.\n");
1943 PWC_INFO("Supports Philips PCA645/646, PCVC675/680/690, PCVC720[40]/730/740/750 & PCVC830/840.\n");
1944 PWC_INFO("Also supports the Askey VC010, various Logitech Quickcams, Samsung MPC-C10 and MPC-C30,\n");
1945 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 -07001946
1947 if (fps) {
1948 if (fps < 4 || fps > 30) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001949 PWC_ERROR("Framerate out of bounds (4-30).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001950 return -EINVAL;
1951 }
1952 default_fps = fps;
Luc Saillard2b455db2006-04-24 10:29:46 -03001953 PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001954 }
1955
Luc Saillard2b455db2006-04-24 10:29:46 -03001956 if (size) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001957 /* string; try matching with array */
1958 for (sz = 0; sz < PSZ_MAX; sz++) {
1959 if (!strcmp(sizenames[sz], size)) { /* Found! */
1960 default_size = sz;
1961 break;
1962 }
1963 }
1964 if (sz == PSZ_MAX) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001965 PWC_ERROR("Size not recognized; try size=[sqcif | qsif | qcif | sif | cif | vga].\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001966 return -EINVAL;
1967 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001968 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 -07001969 }
1970 if (mbufs) {
1971 if (mbufs < 1 || mbufs > MAX_IMAGES) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001972 PWC_ERROR("Illegal number of mmap() buffers; use a number between 1 and %d.\n", MAX_IMAGES);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001973 return -EINVAL;
1974 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001975 pwc_mbufs = mbufs;
1976 PWC_DEBUG_MODULE("Number of image buffers set to %d.\n", pwc_mbufs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001977 }
1978 if (fbufs) {
1979 if (fbufs < 2 || fbufs > MAX_FRAMES) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001980 PWC_ERROR("Illegal number of frame buffers; use a number between 2 and %d.\n", MAX_FRAMES);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001981 return -EINVAL;
1982 }
1983 default_fbufs = fbufs;
Luc Saillard2b455db2006-04-24 10:29:46 -03001984 PWC_DEBUG_MODULE("Number of frame buffers set to %d.\n", default_fbufs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001985 }
Trent Piepho05ad3902007-01-30 23:26:01 -03001986#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001987 if (pwc_trace >= 0) {
1988 PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001989 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001990#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001991 if (compression >= 0) {
1992 if (compression > 3) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001993 PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001994 return -EINVAL;
1995 }
1996 pwc_preferred_compression = compression;
Luc Saillard2b455db2006-04-24 10:29:46 -03001997 PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001998 }
1999 if (power_save)
Luc Saillard2b455db2006-04-24 10:29:46 -03002000 PWC_DEBUG_MODULE("Enabling power save on open/close.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002001 if (leds[0] >= 0)
2002 led_on = leds[0];
2003 if (leds[1] >= 0)
2004 led_off = leds[1];
2005
Steven Cole093cf722005-05-03 19:07:24 -06002006 /* Big device node whoopla. Basically, it allows you to assign a
Linus Torvalds1da177e2005-04-16 15:20:36 -07002007 device node (/dev/videoX) to a camera, based on its type
2008 & serial number. The format is [type[.serialnumber]:]node.
2009
2010 Any camera that isn't matched by these rules gets the next
2011 available free device node.
2012 */
2013 for (i = 0; i < MAX_DEV_HINTS; i++) {
2014 char *s, *colon, *dot;
2015
2016 /* This loop also initializes the array */
2017 device_hint[i].pdev = NULL;
2018 s = dev_hint[i];
2019 if (s != NULL && *s != '\0') {
2020 device_hint[i].type = -1; /* wildcard */
2021 strcpy(device_hint[i].serial_number, "*");
2022
2023 /* parse string: chop at ':' & '/' */
2024 colon = dot = s;
2025 while (*colon != '\0' && *colon != ':')
2026 colon++;
2027 while (*dot != '\0' && *dot != '.')
2028 dot++;
2029 /* Few sanity checks */
2030 if (*dot != '\0' && dot > colon) {
Luc Saillard2b455db2006-04-24 10:29:46 -03002031 PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002032 return -EINVAL;
2033 }
2034
2035 if (*colon == '\0') {
2036 /* No colon */
2037 if (*dot != '\0') {
Luc Saillard2b455db2006-04-24 10:29:46 -03002038 PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002039 return -EINVAL;
2040 }
2041 else {
2042 /* No type or serial number specified, just a number. */
2043 device_hint[i].device_node = pwc_atoi(s);
2044 }
2045 }
2046 else {
2047 /* There's a colon, so we have at least a type and a device node */
2048 device_hint[i].type = pwc_atoi(s);
2049 device_hint[i].device_node = pwc_atoi(colon + 1);
2050 if (*dot != '\0') {
2051 /* There's a serial number as well */
2052 int k;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03002053
Linus Torvalds1da177e2005-04-16 15:20:36 -07002054 dot++;
2055 k = 0;
2056 while (*dot != ':' && k < 29) {
2057 device_hint[i].serial_number[k++] = *dot;
2058 dot++;
2059 }
2060 device_hint[i].serial_number[k] = '\0';
2061 }
2062 }
Luc Saillard2b455db2006-04-24 10:29:46 -03002063 PWC_TRACE("device_hint[%d]:\n", i);
2064 PWC_TRACE(" type : %d\n", device_hint[i].type);
2065 PWC_TRACE(" serial# : %s\n", device_hint[i].serial_number);
2066 PWC_TRACE(" node : %d\n", device_hint[i].device_node);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002067 }
2068 else
2069 device_hint[i].type = 0; /* not filled */
2070 } /* ..for MAX_DEV_HINTS */
2071
Luc Saillard2b455db2006-04-24 10:29:46 -03002072 PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002073 return usb_register(&pwc_driver);
2074}
2075
2076static void __exit usb_pwc_exit(void)
2077{
Luc Saillard2b455db2006-04-24 10:29:46 -03002078 PWC_DEBUG_MODULE("Deregistering driver.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079 usb_deregister(&pwc_driver);
Luc Saillard2b455db2006-04-24 10:29:46 -03002080 PWC_INFO("Philips webcam module removed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002081}
2082
2083module_init(usb_pwc_init);
2084module_exit(usb_pwc_exit);
2085
Luc Saillard2b455db2006-04-24 10:29:46 -03002086/* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */