Merge branch 'x86/urgent' into x86/pat
[deliverable/linux.git] / drivers / media / video / pwc / pwc-if.c
CommitLineData
1da177e4
LT
1/* Linux driver for Philips webcam
2 USB and Video4Linux interface part.
3 (C) 1999-2004 Nemosoft Unv.
2b455db6 4 (C) 2004-2006 Luc Saillard (luc@saillard.org)
1da177e4
LT
5
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
d56410e0 28/*
1da177e4
LT
29 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
d56410e0 32 is thus not distributed in source form. The binary pwcx.o module
1da177e4 33 contains the code that falls under the NDA.
d56410e0
MCC
34
35 In case you're wondering: 'pwc' stands for "Philips WebCam", but
1da177e4
LT
36 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).
d56410e0 39
1da177e4
LT
40 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
e32a7ecc 56 - Pham Thanh Nam: webcam snapshot button as an event input device
1da177e4
LT
57*/
58
59#include <linux/errno.h>
60#include <linux/init.h>
61#include <linux/mm.h>
62#include <linux/module.h>
63#include <linux/poll.h>
64#include <linux/slab.h>
405f5571 65#include <linux/smp_lock.h>
e32a7ecc
NPT
66#ifdef CONFIG_USB_PWC_INPUT_EVDEV
67#include <linux/usb/input.h>
68#endif
1da177e4
LT
69#include <linux/vmalloc.h>
70#include <asm/io.h>
71
72#include "pwc.h"
1da177e4
LT
73#include "pwc-kiara.h"
74#include "pwc-timon.h"
2b455db6
LS
75#include "pwc-dec23.h"
76#include "pwc-dec1.h"
1da177e4
LT
77#include "pwc-uncompress.h"
78
79/* Function prototypes and driver templates */
80
81/* hotplug device table support */
2b455db6 82static const struct usb_device_id pwc_device_table [] = {
1da177e4
LT
83 { USB_DEVICE(0x0471, 0x0302) }, /* Philips models */
84 { USB_DEVICE(0x0471, 0x0303) },
85 { USB_DEVICE(0x0471, 0x0304) },
86 { USB_DEVICE(0x0471, 0x0307) },
87 { USB_DEVICE(0x0471, 0x0308) },
88 { USB_DEVICE(0x0471, 0x030C) },
89 { USB_DEVICE(0x0471, 0x0310) },
2b455db6 90 { USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
1da177e4
LT
91 { USB_DEVICE(0x0471, 0x0312) },
92 { USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
2b455db6 93 { USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
1da177e4
LT
94 { USB_DEVICE(0x069A, 0x0001) }, /* Askey */
95 { USB_DEVICE(0x046D, 0x08B0) }, /* Logitech QuickCam Pro 3000 */
96 { USB_DEVICE(0x046D, 0x08B1) }, /* Logitech QuickCam Notebook Pro */
97 { USB_DEVICE(0x046D, 0x08B2) }, /* Logitech QuickCam Pro 4000 */
98 { USB_DEVICE(0x046D, 0x08B3) }, /* Logitech QuickCam Zoom (old model) */
99 { USB_DEVICE(0x046D, 0x08B4) }, /* Logitech QuickCam Zoom (new model) */
100 { USB_DEVICE(0x046D, 0x08B5) }, /* Logitech QuickCam Orbit/Sphere */
6b1ce3c1
MCC
101 { USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
102 { USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
1da177e4 103 { USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
2b455db6
LS
104 { USB_DEVICE(0x055D, 0x9000) }, /* Samsung MPC-C10 */
105 { USB_DEVICE(0x055D, 0x9001) }, /* Samsung MPC-C30 */
106 { USB_DEVICE(0x055D, 0x9002) }, /* Samsung SNC-35E (Ver3.0) */
1da177e4
LT
107 { USB_DEVICE(0x041E, 0x400C) }, /* Creative Webcam 5 */
108 { USB_DEVICE(0x041E, 0x4011) }, /* Creative Webcam Pro Ex */
109 { USB_DEVICE(0x04CC, 0x8116) }, /* Afina Eye */
110 { USB_DEVICE(0x06BE, 0x8116) }, /* new Afina Eye */
111 { USB_DEVICE(0x0d81, 0x1910) }, /* Visionite */
112 { USB_DEVICE(0x0d81, 0x1900) },
113 { }
114};
115MODULE_DEVICE_TABLE(usb, pwc_device_table);
116
117static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
118static void usb_pwc_disconnect(struct usb_interface *intf);
119
120static struct usb_driver pwc_driver = {
1da177e4
LT
121 .name = "Philips webcam", /* name */
122 .id_table = pwc_device_table,
123 .probe = usb_pwc_probe, /* probe() */
124 .disconnect = usb_pwc_disconnect, /* disconnect() */
125};
126
127#define MAX_DEV_HINTS 20
128#define MAX_ISOC_ERRORS 20
129
130static int default_size = PSZ_QCIF;
131static int default_fps = 10;
132static int default_fbufs = 3; /* Default number of frame buffers */
b930e1d8 133 int pwc_mbufs = 2; /* Default number of mmap() buffers */
05ad3907 134#ifdef CONFIG_USB_PWC_DEBUG
b930e1d8 135 int pwc_trace = PWC_DEBUG_LEVEL;
2b455db6 136#endif
ff699e6b
DSL
137static int power_save;
138static int led_on = 100, led_off; /* defaults to LED that is on while in use */
b20c3cf0 139static int pwc_preferred_compression = 1; /* 0..3 = uncompressed..high */
1da177e4
LT
140static struct {
141 int type;
142 char serial_number[30];
143 int device_node;
144 struct pwc_device *pdev;
145} device_hint[MAX_DEV_HINTS];
146
147/***/
148
bec43661
HV
149static int pwc_video_open(struct file *file);
150static int pwc_video_close(struct file *file);
2b455db6 151static ssize_t pwc_video_read(struct file *file, char __user *buf,
1da177e4
LT
152 size_t count, loff_t *ppos);
153static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
069b7479 154static long pwc_video_ioctl(struct file *file,
1da177e4
LT
155 unsigned int ioctlnr, unsigned long arg);
156static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma);
157
bec43661 158static const struct v4l2_file_operations pwc_fops = {
1da177e4
LT
159 .owner = THIS_MODULE,
160 .open = pwc_video_open,
161 .release = pwc_video_close,
162 .read = pwc_video_read,
163 .poll = pwc_video_poll,
164 .mmap = pwc_video_mmap,
165 .ioctl = pwc_video_ioctl,
1da177e4
LT
166};
167static struct video_device pwc_template = {
1da177e4 168 .name = "Philips Webcam", /* Filled in later */
1da177e4
LT
169 .release = video_device_release,
170 .fops = &pwc_fops,
171 .minor = -1,
172};
173
174/***************************************************************************/
175
176/* Okay, this is some magic that I worked out and the reasoning behind it...
177
d56410e0 178 The biggest problem with any USB device is of course: "what to do
1da177e4
LT
179 when the user unplugs the device while it is in use by an application?"
180 We have several options:
181 1) Curse them with the 7 plagues when they do (requires divine intervention)
182 2) Tell them not to (won't work: they'll do it anyway)
183 3) Oops the kernel (this will have a negative effect on a user's uptime)
184 4) Do something sensible.
d56410e0 185
1da177e4
LT
186 Of course, we go for option 4.
187
188 It happens that this device will be linked to two times, once from
189 usb_device and once from the video_device in their respective 'private'
190 pointers. This is done when the device is probed() and all initialization
191 succeeded. The pwc_device struct links back to both structures.
192
d56410e0
MCC
193 When a device is unplugged while in use it will be removed from the
194 list of known USB devices; I also de-register it as a V4L device, but
1da177e4
LT
195 unfortunately I can't free the memory since the struct is still in use
196 by the file descriptor. This free-ing is then deferend until the first
197 opportunity. Crude, but it works.
d56410e0 198
1da177e4
LT
199 A small 'advantage' is that if a user unplugs the cam and plugs it back
200 in, it should get assigned the same video device minor, but unfortunately
d56410e0 201 it's non-trivial to re-link the cam back to the video device... (that
1da177e4
LT
202 would surely be magic! :))
203*/
204
205/***************************************************************************/
206/* Private functions */
207
208/* Here we want the physical address of the memory.
209 * This is used when initializing the contents of the area.
210 */
1da177e4 211
1da177e4 212
2b455db6
LS
213
214static void *pwc_rvmalloc(unsigned long size)
1da177e4
LT
215{
216 void * mem;
217 unsigned long adr;
218
d56410e0 219 mem=vmalloc_32(size);
2b455db6
LS
220 if (!mem)
221 return NULL;
222
223 memset(mem, 0, size); /* Clear the ram out, no junk to the user */
224 adr=(unsigned long) mem;
225 while (size > 0)
226 {
227 SetPageReserved(vmalloc_to_page((void *)adr));
228 adr += PAGE_SIZE;
229 size -= PAGE_SIZE;
230 }
1da177e4
LT
231 return mem;
232}
233
2b455db6 234static void pwc_rvfree(void * mem, unsigned long size)
1da177e4 235{
d56410e0 236 unsigned long adr;
1da177e4 237
2b455db6
LS
238 if (!mem)
239 return;
240
241 adr=(unsigned long) mem;
242 while ((long) size > 0)
243 {
244 ClearPageReserved(vmalloc_to_page((void *)adr));
245 adr += PAGE_SIZE;
246 size -= PAGE_SIZE;
247 }
248 vfree(mem);
1da177e4
LT
249}
250
251
252
253
254static int pwc_allocate_buffers(struct pwc_device *pdev)
255{
2b455db6 256 int i, err;
1da177e4
LT
257 void *kbuf;
258
2b455db6 259 PWC_DEBUG_MEMORY(">> pwc_allocate_buffers(pdev = 0x%p)\n", pdev);
1da177e4
LT
260
261 if (pdev == NULL)
262 return -ENXIO;
d56410e0 263
2b455db6 264 /* Allocate Isochronuous pipe buffers */
1da177e4
LT
265 for (i = 0; i < MAX_ISO_BUFS; i++) {
266 if (pdev->sbuf[i].data == NULL) {
2b455db6 267 kbuf = kzalloc(ISO_BUFFER_SIZE, GFP_KERNEL);
1da177e4 268 if (kbuf == NULL) {
2b455db6 269 PWC_ERROR("Failed to allocate iso buffer %d.\n", i);
1da177e4
LT
270 return -ENOMEM;
271 }
2b455db6 272 PWC_DEBUG_MEMORY("Allocated iso buffer at %p.\n", kbuf);
1da177e4 273 pdev->sbuf[i].data = kbuf;
1da177e4
LT
274 }
275 }
276
277 /* Allocate frame buffer structure */
278 if (pdev->fbuf == NULL) {
2b455db6 279 kbuf = kzalloc(default_fbufs * sizeof(struct pwc_frame_buf), GFP_KERNEL);
1da177e4 280 if (kbuf == NULL) {
2b455db6 281 PWC_ERROR("Failed to allocate frame buffer structure.\n");
1da177e4
LT
282 return -ENOMEM;
283 }
2b455db6 284 PWC_DEBUG_MEMORY("Allocated frame buffer structure at %p.\n", kbuf);
1da177e4 285 pdev->fbuf = kbuf;
1da177e4 286 }
2b455db6 287
1da177e4
LT
288 /* create frame buffers, and make circular ring */
289 for (i = 0; i < default_fbufs; i++) {
290 if (pdev->fbuf[i].data == NULL) {
291 kbuf = vmalloc(PWC_FRAME_SIZE); /* need vmalloc since frame buffer > 128K */
292 if (kbuf == NULL) {
2b455db6 293 PWC_ERROR("Failed to allocate frame buffer %d.\n", i);
1da177e4
LT
294 return -ENOMEM;
295 }
2b455db6 296 PWC_DEBUG_MEMORY("Allocated frame buffer %d at %p.\n", i, kbuf);
1da177e4 297 pdev->fbuf[i].data = kbuf;
2b455db6 298 memset(kbuf, 0, PWC_FRAME_SIZE);
1da177e4
LT
299 }
300 }
d56410e0 301
1da177e4 302 /* Allocate decompressor table space */
2b455db6
LS
303 if (DEVICE_USE_CODEC1(pdev->type))
304 err = pwc_dec1_alloc(pdev);
305 else
306 err = pwc_dec23_alloc(pdev);
307
308 if (err) {
309 PWC_ERROR("Failed to allocate decompress table.\n");
310 return err;
311 }
d56410e0 312
1da177e4 313 /* Allocate image buffer; double buffer for mmap() */
2b455db6 314 kbuf = pwc_rvmalloc(pwc_mbufs * pdev->len_per_image);
1da177e4 315 if (kbuf == NULL) {
2b455db6
LS
316 PWC_ERROR("Failed to allocate image buffer(s). needed (%d)\n",
317 pwc_mbufs * pdev->len_per_image);
1da177e4
LT
318 return -ENOMEM;
319 }
2b455db6 320 PWC_DEBUG_MEMORY("Allocated image buffer at %p.\n", kbuf);
1da177e4 321 pdev->image_data = kbuf;
2b455db6
LS
322 for (i = 0; i < pwc_mbufs; i++) {
323 pdev->images[i].offset = i * pdev->len_per_image;
324 pdev->images[i].vma_use_count = 0;
325 }
326 for (; i < MAX_IMAGES; i++) {
327 pdev->images[i].offset = 0;
328 }
1da177e4
LT
329
330 kbuf = NULL;
d56410e0 331
2b455db6 332 PWC_DEBUG_MEMORY("<< pwc_allocate_buffers()\n");
1da177e4
LT
333 return 0;
334}
335
336static void pwc_free_buffers(struct pwc_device *pdev)
337{
338 int i;
339
2b455db6 340 PWC_DEBUG_MEMORY("Entering free_buffers(%p).\n", pdev);
1da177e4
LT
341
342 if (pdev == NULL)
343 return;
1da177e4
LT
344 /* Release Iso-pipe buffers */
345 for (i = 0; i < MAX_ISO_BUFS; i++)
346 if (pdev->sbuf[i].data != NULL) {
2b455db6 347 PWC_DEBUG_MEMORY("Freeing ISO buffer at %p.\n", pdev->sbuf[i].data);
1da177e4
LT
348 kfree(pdev->sbuf[i].data);
349 pdev->sbuf[i].data = NULL;
350 }
351
352 /* The same for frame buffers */
353 if (pdev->fbuf != NULL) {
354 for (i = 0; i < default_fbufs; i++) {
355 if (pdev->fbuf[i].data != NULL) {
2b455db6 356 PWC_DEBUG_MEMORY("Freeing frame buffer %d at %p.\n", i, pdev->fbuf[i].data);
1da177e4
LT
357 vfree(pdev->fbuf[i].data);
358 pdev->fbuf[i].data = NULL;
359 }
360 }
361 kfree(pdev->fbuf);
362 pdev->fbuf = NULL;
363 }
364
365 /* Intermediate decompression buffer & tables */
366 if (pdev->decompress_data != NULL) {
2b455db6 367 PWC_DEBUG_MEMORY("Freeing decompression buffer at %p.\n", pdev->decompress_data);
1da177e4
LT
368 kfree(pdev->decompress_data);
369 pdev->decompress_data = NULL;
370 }
1da177e4
LT
371
372 /* Release image buffers */
373 if (pdev->image_data != NULL) {
2b455db6
LS
374 PWC_DEBUG_MEMORY("Freeing image buffer at %p.\n", pdev->image_data);
375 pwc_rvfree(pdev->image_data, pwc_mbufs * pdev->len_per_image);
1da177e4
LT
376 }
377 pdev->image_data = NULL;
d56410e0 378
2b455db6 379 PWC_DEBUG_MEMORY("Leaving free_buffers().\n");
1da177e4
LT
380}
381
d56410e0 382/* The frame & image buffer mess.
1da177e4
LT
383
384 Yes, this is a mess. Well, it used to be simple, but alas... In this
385 module, 3 buffers schemes are used to get the data from the USB bus to
386 the user program. The first scheme involves the ISO buffers (called thus
387 since they transport ISO data from the USB controller), and not really
d56410e0 388 interesting. Suffices to say the data from this buffer is quickly
1da177e4
LT
389 gathered in an interrupt handler (pwc_isoc_handler) and placed into the
390 frame buffer.
391
392 The frame buffer is the second scheme, and is the central element here.
393 It collects the data from a single frame from the camera (hence, the
394 name). Frames are delimited by the USB camera with a short USB packet,
395 so that's easy to detect. The frame buffers form a list that is filled
396 by the camera+USB controller and drained by the user process through
397 either read() or mmap().
398
399 The image buffer is the third scheme, in which frames are decompressed
400 and converted into planar format. For mmap() there is more than
401 one image buffer available.
402
403 The frame buffers provide the image buffering. In case the user process
404 is a bit slow, this introduces lag and some undesired side-effects.
405 The problem arises when the frame buffer is full. I used to drop the last
406 frame, which makes the data in the queue stale very quickly. But dropping
407 the frame at the head of the queue proved to be a litte bit more difficult.
408 I tried a circular linked scheme, but this introduced more problems than
409 it solved.
410
411 Because filling and draining are completely asynchronous processes, this
412 requires some fiddling with pointers and mutexes.
413
414 Eventually, I came up with a system with 2 lists: an 'empty' frame list
415 and a 'full' frame list:
416 * Initially, all frame buffers but one are on the 'empty' list; the one
417 remaining buffer is our initial fill frame.
d56410e0
MCC
418 * If a frame is needed for filling, we try to take it from the 'empty'
419 list, unless that list is empty, in which case we take the buffer at
1da177e4
LT
420 the head of the 'full' list.
421 * When our fill buffer has been filled, it is appended to the 'full'
422 list.
423 * If a frame is needed by read() or mmap(), it is taken from the head of
424 the 'full' list, handled, and then appended to the 'empty' list. If no
425 buffer is present on the 'full' list, we wait.
426 The advantage is that the buffer that is currently being decompressed/
427 converted, is on neither list, and thus not in our way (any other scheme
428 I tried had the problem of old data lingering in the queue).
429
430 Whatever strategy you choose, it always remains a tradeoff: with more
431 frame buffers the chances of a missed frame are reduced. On the other
432 hand, on slower machines it introduces lag because the queue will
433 always be full.
434 */
435
436/**
437 \brief Find next frame buffer to fill. Take from empty or full list, whichever comes first.
438 */
2b455db6 439static int pwc_next_fill_frame(struct pwc_device *pdev)
1da177e4
LT
440{
441 int ret;
442 unsigned long flags;
443
444 ret = 0;
445 spin_lock_irqsave(&pdev->ptrlock, flags);
446 if (pdev->fill_frame != NULL) {
447 /* append to 'full' list */
448 if (pdev->full_frames == NULL) {
449 pdev->full_frames = pdev->fill_frame;
450 pdev->full_frames_tail = pdev->full_frames;
451 }
452 else {
453 pdev->full_frames_tail->next = pdev->fill_frame;
454 pdev->full_frames_tail = pdev->fill_frame;
455 }
456 }
457 if (pdev->empty_frames != NULL) {
458 /* We have empty frames available. That's easy */
459 pdev->fill_frame = pdev->empty_frames;
460 pdev->empty_frames = pdev->empty_frames->next;
461 }
462 else {
463 /* Hmm. Take it from the full list */
1da177e4
LT
464 /* sanity check */
465 if (pdev->full_frames == NULL) {
2b455db6 466 PWC_ERROR("Neither empty or full frames available!\n");
1da177e4
LT
467 spin_unlock_irqrestore(&pdev->ptrlock, flags);
468 return -EINVAL;
469 }
1da177e4
LT
470 pdev->fill_frame = pdev->full_frames;
471 pdev->full_frames = pdev->full_frames->next;
472 ret = 1;
473 }
474 pdev->fill_frame->next = NULL;
1da177e4
LT
475 spin_unlock_irqrestore(&pdev->ptrlock, flags);
476 return ret;
477}
478
479
480/**
481 \brief Reset all buffers, pointers and lists, except for the image_used[] buffer.
482
483 If the image_used[] buffer is cleared too, mmap()/VIDIOCSYNC will run into trouble.
484 */
485static void pwc_reset_buffers(struct pwc_device *pdev)
486{
487 int i;
488 unsigned long flags;
489
645635b0 490 PWC_DEBUG_MEMORY(">> %s __enter__\n", __func__);
2b455db6 491
1da177e4
LT
492 spin_lock_irqsave(&pdev->ptrlock, flags);
493 pdev->full_frames = NULL;
494 pdev->full_frames_tail = NULL;
495 for (i = 0; i < default_fbufs; i++) {
496 pdev->fbuf[i].filled = 0;
497 if (i > 0)
498 pdev->fbuf[i].next = &pdev->fbuf[i - 1];
499 else
500 pdev->fbuf->next = NULL;
501 }
502 pdev->empty_frames = &pdev->fbuf[default_fbufs - 1];
503 pdev->empty_frames_tail = pdev->fbuf;
504 pdev->read_frame = NULL;
505 pdev->fill_frame = pdev->empty_frames;
506 pdev->empty_frames = pdev->empty_frames->next;
507
508 pdev->image_read_pos = 0;
509 pdev->fill_image = 0;
510 spin_unlock_irqrestore(&pdev->ptrlock, flags);
2b455db6 511
645635b0 512 PWC_DEBUG_MEMORY("<< %s __leaving__\n", __func__);
1da177e4
LT
513}
514
515
516/**
517 \brief Do all the handling for getting one frame: get pointer, decompress, advance pointers.
518 */
2b455db6 519int pwc_handle_frame(struct pwc_device *pdev)
1da177e4
LT
520{
521 int ret = 0;
522 unsigned long flags;
523
524 spin_lock_irqsave(&pdev->ptrlock, flags);
525 /* First grab our read_frame; this is removed from all lists, so
526 we can release the lock after this without problems */
527 if (pdev->read_frame != NULL) {
528 /* This can't theoretically happen */
2b455db6
LS
529 PWC_ERROR("Huh? Read frame still in use?\n");
530 spin_unlock_irqrestore(&pdev->ptrlock, flags);
531 return ret;
532 }
533
534
535 if (pdev->full_frames == NULL) {
536 PWC_ERROR("Woops. No frames ready.\n");
1da177e4
LT
537 }
538 else {
2b455db6
LS
539 pdev->read_frame = pdev->full_frames;
540 pdev->full_frames = pdev->full_frames->next;
541 pdev->read_frame->next = NULL;
542 }
543
544 if (pdev->read_frame != NULL) {
efad798b 545 /* Decompression is a lengthy process, so it's outside of the lock.
2b455db6
LS
546 This gives the isoc_handler the opportunity to fill more frames
547 in the mean time.
548 */
549 spin_unlock_irqrestore(&pdev->ptrlock, flags);
550 ret = pwc_decompress(pdev);
551 spin_lock_irqsave(&pdev->ptrlock, flags);
552
553 /* We're done with read_buffer, tack it to the end of the empty buffer list */
554 if (pdev->empty_frames == NULL) {
555 pdev->empty_frames = pdev->read_frame;
556 pdev->empty_frames_tail = pdev->empty_frames;
1da177e4
LT
557 }
558 else {
2b455db6
LS
559 pdev->empty_frames_tail->next = pdev->read_frame;
560 pdev->empty_frames_tail = pdev->read_frame;
1da177e4 561 }
2b455db6 562 pdev->read_frame = NULL;
1da177e4
LT
563 }
564 spin_unlock_irqrestore(&pdev->ptrlock, flags);
565 return ret;
566}
567
568/**
569 \brief Advance pointers of image buffer (after each user request)
570*/
2b455db6 571void pwc_next_image(struct pwc_device *pdev)
1da177e4
LT
572{
573 pdev->image_used[pdev->fill_image] = 0;
2b455db6 574 pdev->fill_image = (pdev->fill_image + 1) % pwc_mbufs;
1da177e4
LT
575}
576
2b455db6
LS
577/**
578 * Print debug information when a frame is discarded because all of our buffer
579 * is full
580 */
581static void pwc_frame_dumped(struct pwc_device *pdev)
582{
583 pdev->vframes_dumped++;
584 if (pdev->vframe_count < FRAME_LOWMARK)
585 return;
586
587 if (pdev->vframes_dumped < 20)
588 PWC_DEBUG_FLOW("Dumping frame %d\n", pdev->vframe_count);
589 else if (pdev->vframes_dumped == 20)
590 PWC_DEBUG_FLOW("Dumping frame %d (last message)\n",
591 pdev->vframe_count);
592}
593
e32a7ecc
NPT
594static void pwc_snapshot_button(struct pwc_device *pdev, int down)
595{
596 if (down) {
597 PWC_TRACE("Snapshot button pressed.\n");
598 pdev->snapshot_button_status = 1;
599 } else {
600 PWC_TRACE("Snapshot button released.\n");
601 }
602
603#ifdef CONFIG_USB_PWC_INPUT_EVDEV
604 if (pdev->button_dev) {
bcd3e4b3 605 input_report_key(pdev->button_dev, KEY_CAMERA, down);
e32a7ecc
NPT
606 input_sync(pdev->button_dev);
607 }
608#endif
609}
610
2b455db6
LS
611static int pwc_rcv_short_packet(struct pwc_device *pdev, const struct pwc_frame_buf *fbuf)
612{
613 int awake = 0;
614
615 /* The ToUCam Fun CMOS sensor causes the firmware to send 2 or 3 bogus
616 frames on the USB wire after an exposure change. This conditition is
617 however detected in the cam and a bit is set in the header.
618 */
619 if (pdev->type == 730) {
620 unsigned char *ptr = (unsigned char *)fbuf->data;
621
622 if (ptr[1] == 1 && ptr[0] & 0x10) {
623 PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
624 pdev->drop_frames += 2;
625 pdev->vframes_error++;
626 }
627 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
e32a7ecc 628 pwc_snapshot_button(pdev, ptr[0] & 0x01);
2b455db6
LS
629 }
630 if ((ptr[0] ^ pdev->vmirror) & 0x02) {
631 if (ptr[0] & 0x02)
632 PWC_TRACE("Image is mirrored.\n");
633 else
634 PWC_TRACE("Image is normal.\n");
635 }
636 pdev->vmirror = ptr[0] & 0x03;
637 /* Sometimes the trailer of the 730 is still sent as a 4 byte packet
638 after a short frame; this condition is filtered out specifically. A 4 byte
639 frame doesn't make sense anyway.
640 So we get either this sequence:
641 drop_bit set -> 4 byte frame -> short frame -> good frame
642 Or this one:
643 drop_bit set -> short frame -> good frame
644 So we drop either 3 or 2 frames in all!
645 */
646 if (fbuf->filled == 4)
647 pdev->drop_frames++;
648 }
649 else if (pdev->type == 740 || pdev->type == 720) {
650 unsigned char *ptr = (unsigned char *)fbuf->data;
651 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
e32a7ecc 652 pwc_snapshot_button(pdev, ptr[0] & 0x01);
2b455db6
LS
653 }
654 pdev->vmirror = ptr[0] & 0x03;
655 }
656
657 /* In case we were instructed to drop the frame, do so silently.
658 The buffer pointers are not updated either (but the counters are reset below).
659 */
660 if (pdev->drop_frames > 0)
661 pdev->drop_frames--;
662 else {
663 /* Check for underflow first */
664 if (fbuf->filled < pdev->frame_total_size) {
665 PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
666 " discarded.\n", fbuf->filled);
667 pdev->vframes_error++;
668 }
669 else {
670 /* Send only once per EOF */
671 awake = 1; /* delay wake_ups */
672
673 /* Find our next frame to fill. This will always succeed, since we
674 * nick a frame from either empty or full list, but if we had to
675 * take it from the full list, it means a frame got dropped.
676 */
677 if (pwc_next_fill_frame(pdev))
678 pwc_frame_dumped(pdev);
679
680 }
681 } /* !drop_frames */
682 pdev->vframe_count++;
683 return awake;
684}
1da177e4
LT
685
686/* This gets called for the Isochronous pipe (video). This is done in
687 * interrupt time, so it has to be fast, not crash, and not stall. Neat.
688 */
7d12e780 689static void pwc_isoc_handler(struct urb *urb)
1da177e4
LT
690{
691 struct pwc_device *pdev;
692 int i, fst, flen;
693 int awake;
694 struct pwc_frame_buf *fbuf;
695 unsigned char *fillptr = NULL, *iso_buf = NULL;
696
697 awake = 0;
698 pdev = (struct pwc_device *)urb->context;
699 if (pdev == NULL) {
2b455db6 700 PWC_ERROR("isoc_handler() called with NULL device?!\n");
1da177e4
LT
701 return;
702 }
2b455db6 703
1da177e4 704 if (urb->status == -ENOENT || urb->status == -ECONNRESET) {
2b455db6 705 PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
1da177e4
LT
706 return;
707 }
708 if (urb->status != -EINPROGRESS && urb->status != 0) {
709 const char *errmsg;
710
711 errmsg = "Unknown";
712 switch(urb->status) {
713 case -ENOSR: errmsg = "Buffer error (overrun)"; break;
714 case -EPIPE: errmsg = "Stalled (device not responding)"; break;
715 case -EOVERFLOW: errmsg = "Babble (bad cable?)"; break;
716 case -EPROTO: errmsg = "Bit-stuff error (bad cable?)"; break;
717 case -EILSEQ: errmsg = "CRC/Timeout (could be anything)"; break;
38e2bfc9 718 case -ETIME: errmsg = "Device does not respond"; break;
1da177e4 719 }
2b455db6 720 PWC_DEBUG_FLOW("pwc_isoc_handler() called with status %d [%s].\n", urb->status, errmsg);
d56410e0 721 /* Give up after a number of contiguous errors on the USB bus.
1da177e4
LT
722 Appearantly something is wrong so we simulate an unplug event.
723 */
724 if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
725 {
2b455db6 726 PWC_INFO("Too many ISOC errors, bailing out.\n");
1da177e4
LT
727 pdev->error_status = EIO;
728 awake = 1;
729 wake_up_interruptible(&pdev->frameq);
730 }
731 goto handler_end; // ugly, but practical
732 }
733
734 fbuf = pdev->fill_frame;
735 if (fbuf == NULL) {
2b455db6 736 PWC_ERROR("pwc_isoc_handler without valid fill frame.\n");
1da177e4
LT
737 awake = 1;
738 goto handler_end;
739 }
740 else {
741 fillptr = fbuf->data + fbuf->filled;
742 }
743
744 /* Reset ISOC error counter. We did get here, after all. */
745 pdev->visoc_errors = 0;
746
747 /* vsync: 0 = don't copy data
d56410e0
MCC
748 1 = sync-hunt
749 2 = synched
1da177e4
LT
750 */
751 /* Compact data */
752 for (i = 0; i < urb->number_of_packets; i++) {
753 fst = urb->iso_frame_desc[i].status;
754 flen = urb->iso_frame_desc[i].actual_length;
755 iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
756 if (fst == 0) {
757 if (flen > 0) { /* if valid data... */
758 if (pdev->vsync > 0) { /* ...and we are not sync-hunting... */
759 pdev->vsync = 2;
760
761 /* ...copy data to frame buffer, if possible */
762 if (flen + fbuf->filled > pdev->frame_total_size) {
2b455db6 763 PWC_DEBUG_FLOW("Frame buffer overflow (flen = %d, frame_total_size = %d).\n", flen, pdev->frame_total_size);
1da177e4
LT
764 pdev->vsync = 0; /* Hmm, let's wait for an EOF (end-of-frame) */
765 pdev->vframes_error++;
766 }
767 else {
768 memmove(fillptr, iso_buf, flen);
769 fillptr += flen;
770 }
771 }
772 fbuf->filled += flen;
773 } /* ..flen > 0 */
774
775 if (flen < pdev->vlast_packet_size) {
d56410e0 776 /* Shorter packet... We probably have the end of an image-frame;
1da177e4
LT
777 wake up read() process and let select()/poll() do something.
778 Decompression is done in user time over there.
2b455db6 779 */
1da177e4 780 if (pdev->vsync == 2) {
2b455db6
LS
781 if (pwc_rcv_short_packet(pdev, fbuf)) {
782 awake = 1;
783 fbuf = pdev->fill_frame;
1da177e4 784 }
1da177e4
LT
785 }
786 fbuf->filled = 0;
787 fillptr = fbuf->data;
788 pdev->vsync = 1;
2b455db6
LS
789 }
790
1da177e4
LT
791 pdev->vlast_packet_size = flen;
792 } /* ..status == 0 */
1da177e4 793 else {
2b455db6 794 /* This is normally not interesting to the user, unless
ff699e6b
DSL
795 * you are really debugging something, default = 0 */
796 static int iso_error;
1da177e4
LT
797 iso_error++;
798 if (iso_error < 20)
2b455db6 799 PWC_DEBUG_FLOW("Iso frame %d of USB has error %d\n", i, fst);
1da177e4 800 }
1da177e4
LT
801 }
802
803handler_end:
804 if (awake)
805 wake_up_interruptible(&pdev->frameq);
806
807 urb->dev = pdev->udev;
808 i = usb_submit_urb(urb, GFP_ATOMIC);
809 if (i != 0)
2b455db6 810 PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
1da177e4
LT
811}
812
813
2b455db6 814int pwc_isoc_init(struct pwc_device *pdev)
1da177e4
LT
815{
816 struct usb_device *udev;
817 struct urb *urb;
818 int i, j, ret;
819
820 struct usb_interface *intf;
821 struct usb_host_interface *idesc = NULL;
822
823 if (pdev == NULL)
824 return -EFAULT;
825 if (pdev->iso_init)
826 return 0;
827 pdev->vsync = 0;
828 udev = pdev->udev;
829
830 /* Get the current alternate interface, adjust packet size */
831 if (!udev->actconfig)
832 return -EFAULT;
1da177e4
LT
833 intf = usb_ifnum_to_if(udev, 0);
834 if (intf)
835 idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
d56410e0 836
1da177e4
LT
837 if (!idesc)
838 return -EFAULT;
839
840 /* Search video endpoint */
841 pdev->vmax_packet_size = -1;
2b455db6 842 for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
1da177e4
LT
843 if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
844 pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
845 break;
846 }
2b455db6 847 }
d56410e0 848
1da177e4 849 if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
2b455db6 850 PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
093cf723 851 return -ENFILE; /* Odd error, that should be noticeable */
1da177e4
LT
852 }
853
854 /* Set alternate interface */
855 ret = 0;
2b455db6 856 PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
1da177e4
LT
857 ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
858 if (ret < 0)
859 return ret;
860
861 for (i = 0; i < MAX_ISO_BUFS; i++) {
862 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
863 if (urb == NULL) {
2b455db6 864 PWC_ERROR("Failed to allocate urb %d\n", i);
1da177e4
LT
865 ret = -ENOMEM;
866 break;
867 }
868 pdev->sbuf[i].urb = urb;
2b455db6 869 PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
1da177e4
LT
870 }
871 if (ret) {
872 /* De-allocate in reverse order */
444f4f91 873 while (i--) {
90b2625a 874 usb_free_urb(pdev->sbuf[i].urb);
1da177e4 875 pdev->sbuf[i].urb = NULL;
1da177e4
LT
876 }
877 return ret;
878 }
879
d56410e0 880 /* init URB structure */
1da177e4
LT
881 for (i = 0; i < MAX_ISO_BUFS; i++) {
882 urb = pdev->sbuf[i].urb;
883
884 urb->interval = 1; // devik
885 urb->dev = udev;
d56410e0 886 urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
1da177e4 887 urb->transfer_flags = URB_ISO_ASAP;
d56410e0
MCC
888 urb->transfer_buffer = pdev->sbuf[i].data;
889 urb->transfer_buffer_length = ISO_BUFFER_SIZE;
890 urb->complete = pwc_isoc_handler;
891 urb->context = pdev;
1da177e4
LT
892 urb->start_frame = 0;
893 urb->number_of_packets = ISO_FRAMES_PER_DESC;
894 for (j = 0; j < ISO_FRAMES_PER_DESC; j++) {
895 urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE;
896 urb->iso_frame_desc[j].length = pdev->vmax_packet_size;
897 }
898 }
899
900 /* link */
901 for (i = 0; i < MAX_ISO_BUFS; i++) {
902 ret = usb_submit_urb(pdev->sbuf[i].urb, GFP_KERNEL);
903 if (ret)
2b455db6 904 PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
1da177e4 905 else
2b455db6 906 PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->sbuf[i].urb);
1da177e4
LT
907 }
908
909 /* All is done... */
910 pdev->iso_init = 1;
2b455db6 911 PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
1da177e4
LT
912 return 0;
913}
914
0b67f5c5 915static void pwc_iso_stop(struct pwc_device *pdev)
1da177e4
LT
916{
917 int i;
918
1da177e4
LT
919 /* Unlinking ISOC buffers one by one */
920 for (i = 0; i < MAX_ISO_BUFS; i++) {
921 struct urb *urb;
922
923 urb = pdev->sbuf[i].urb;
5fa1247a 924 if (urb) {
0b67f5c5
ON
925 PWC_DEBUG_MEMORY("Unlinking URB %p\n", urb);
926 usb_kill_urb(urb);
927 }
928 }
929}
930
931static void pwc_iso_free(struct pwc_device *pdev)
932{
933 int i;
934
935 /* Freeing ISOC buffers one by one */
936 for (i = 0; i < MAX_ISO_BUFS; i++) {
937 struct urb *urb;
938
939 urb = pdev->sbuf[i].urb;
5fa1247a 940 if (urb) {
2b455db6 941 PWC_DEBUG_MEMORY("Freeing URB\n");
1da177e4
LT
942 usb_free_urb(urb);
943 pdev->sbuf[i].urb = NULL;
944 }
945 }
0b67f5c5
ON
946}
947
948void pwc_isoc_cleanup(struct pwc_device *pdev)
949{
950 PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
951 if (pdev == NULL)
952 return;
953 if (pdev->iso_init == 0)
954 return;
955
956 pwc_iso_stop(pdev);
957 pwc_iso_free(pdev);
1da177e4
LT
958
959 /* Stop camera, but only if we are sure the camera is still there (unplug
d56410e0 960 is signalled by EPIPE)
1da177e4
LT
961 */
962 if (pdev->error_status && pdev->error_status != EPIPE) {
2b455db6 963 PWC_DEBUG_OPEN("Setting alternate interface 0.\n");
1da177e4
LT
964 usb_set_interface(pdev->udev, 0, 0);
965 }
966
967 pdev->iso_init = 0;
2b455db6 968 PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
1da177e4
LT
969}
970
971int pwc_try_video_mode(struct pwc_device *pdev, int width, int height, int new_fps, int new_compression, int new_snapshot)
972{
973 int ret, start;
974
975 /* Stop isoc stuff */
976 pwc_isoc_cleanup(pdev);
977 /* Reset parameters */
978 pwc_reset_buffers(pdev);
979 /* Try to set video mode... */
980 start = ret = pwc_set_video_mode(pdev, width, height, new_fps, new_compression, new_snapshot);
d56410e0 981 if (ret) {
2b455db6 982 PWC_DEBUG_FLOW("pwc_set_video_mode attempt 1 failed.\n");
1da177e4
LT
983 /* That failed... restore old mode (we know that worked) */
984 start = pwc_set_video_mode(pdev, pdev->view.x, pdev->view.y, pdev->vframes, pdev->vcompression, pdev->vsnapshot);
985 if (start) {
2b455db6 986 PWC_DEBUG_FLOW("pwc_set_video_mode attempt 2 failed.\n");
1da177e4
LT
987 }
988 }
989 if (start == 0)
990 {
991 if (pwc_isoc_init(pdev) < 0)
992 {
2b455db6 993 PWC_WARNING("Failed to restart ISOC transfers in pwc_try_video_mode.\n");
1da177e4
LT
994 ret = -EAGAIN; /* let's try again, who knows if it works a second time */
995 }
996 }
997 pdev->drop_frames++; /* try to avoid garbage during switch */
998 return ret; /* Return original error code */
999}
1000
2b455db6
LS
1001/*********
1002 * sysfs
1003 *********/
54bd5b66 1004static struct pwc_device *cd_to_pwc(struct device *cd)
2b455db6
LS
1005{
1006 struct video_device *vdev = to_video_device(cd);
1007 return video_get_drvdata(vdev);
1008}
1009
54bd5b66
KS
1010static ssize_t show_pan_tilt(struct device *class_dev,
1011 struct device_attribute *attr, char *buf)
2b455db6
LS
1012{
1013 struct pwc_device *pdev = cd_to_pwc(class_dev);
1014 return sprintf(buf, "%d %d\n", pdev->pan_angle, pdev->tilt_angle);
1015}
1016
54bd5b66
KS
1017static ssize_t store_pan_tilt(struct device *class_dev,
1018 struct device_attribute *attr,
1019 const char *buf, size_t count)
2b455db6
LS
1020{
1021 struct pwc_device *pdev = cd_to_pwc(class_dev);
1022 int pan, tilt;
1023 int ret = -EINVAL;
1024
1025 if (strncmp(buf, "reset", 5) == 0)
1026 ret = pwc_mpt_reset(pdev, 0x3);
1027
1028 else if (sscanf(buf, "%d %d", &pan, &tilt) > 0)
1029 ret = pwc_mpt_set_angle(pdev, pan, tilt);
1030
1031 if (ret < 0)
1032 return ret;
1033 return strlen(buf);
1034}
54bd5b66
KS
1035static DEVICE_ATTR(pan_tilt, S_IRUGO | S_IWUSR, show_pan_tilt,
1036 store_pan_tilt);
2b455db6 1037
54bd5b66
KS
1038static ssize_t show_snapshot_button_status(struct device *class_dev,
1039 struct device_attribute *attr, char *buf)
2b455db6
LS
1040{
1041 struct pwc_device *pdev = cd_to_pwc(class_dev);
1042 int status = pdev->snapshot_button_status;
1043 pdev->snapshot_button_status = 0;
1044 return sprintf(buf, "%d\n", status);
1045}
1046
54bd5b66
KS
1047static DEVICE_ATTR(button, S_IRUGO | S_IWUSR, show_snapshot_button_status,
1048 NULL);
2b455db6 1049
c12e3be0 1050static int pwc_create_sysfs_files(struct video_device *vdev)
2b455db6
LS
1051{
1052 struct pwc_device *pdev = video_get_drvdata(vdev);
c12e3be0
JG
1053 int rc;
1054
f894dfd7 1055 rc = device_create_file(&vdev->dev, &dev_attr_button);
c12e3be0
JG
1056 if (rc)
1057 goto err;
1058 if (pdev->features & FEATURE_MOTOR_PANTILT) {
f894dfd7 1059 rc = device_create_file(&vdev->dev, &dev_attr_pan_tilt);
c12e3be0
JG
1060 if (rc) goto err_button;
1061 }
1062
1063 return 0;
1064
1065err_button:
f894dfd7 1066 device_remove_file(&vdev->dev, &dev_attr_button);
c12e3be0 1067err:
f894dfd7 1068 PWC_ERROR("Could not create sysfs files.\n");
c12e3be0 1069 return rc;
2b455db6
LS
1070}
1071
1072static void pwc_remove_sysfs_files(struct video_device *vdev)
1073{
1074 struct pwc_device *pdev = video_get_drvdata(vdev);
1075 if (pdev->features & FEATURE_MOTOR_PANTILT)
f894dfd7
HV
1076 device_remove_file(&vdev->dev, &dev_attr_pan_tilt);
1077 device_remove_file(&vdev->dev, &dev_attr_button);
2b455db6
LS
1078}
1079
05ad3907 1080#ifdef CONFIG_USB_PWC_DEBUG
2b455db6
LS
1081static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
1082{
1083 switch(sensor_type) {
1084 case 0x00:
1085 return "Hyundai CMOS sensor";
1086 case 0x20:
1087 return "Sony CCD sensor + TDA8787";
1088 case 0x2E:
1089 return "Sony CCD sensor + Exas 98L59";
1090 case 0x2F:
1091 return "Sony CCD sensor + ADI 9804";
1092 case 0x30:
1093 return "Sharp CCD sensor + TDA8787";
1094 case 0x3E:
1095 return "Sharp CCD sensor + Exas 98L59";
1096 case 0x3F:
1097 return "Sharp CCD sensor + ADI 9804";
1098 case 0x40:
1099 return "UPA 1021 sensor";
1100 case 0x100:
1101 return "VGA sensor";
1102 case 0x101:
1103 return "PAL MR sensor";
1104 default:
657de3cd 1105 return "unknown type of sensor";
2b455db6
LS
1106 }
1107}
1108#endif
1da177e4
LT
1109
1110/***************************************************************************/
1111/* Video4Linux functions */
1112
bec43661 1113static int pwc_video_open(struct file *file)
1da177e4 1114{
2b455db6 1115 int i, ret;
1da177e4
LT
1116 struct video_device *vdev = video_devdata(file);
1117 struct pwc_device *pdev;
1118
2b455db6 1119 PWC_DEBUG_OPEN(">> video_open called(vdev = 0x%p).\n", vdev);
d56410e0 1120
601e9444 1121 pdev = video_get_drvdata(vdev);
5d9a276a 1122 BUG_ON(!pdev);
2b455db6
LS
1123 if (pdev->vopen) {
1124 PWC_DEBUG_OPEN("I'm busy, someone is using the device.\n");
1da177e4 1125 return -EBUSY;
2b455db6 1126 }
d56410e0 1127
b9378fdb 1128 mutex_lock(&pdev->modlock);
5c8e2403 1129 pwc_construct(pdev); /* set min/max sizes correct */
1da177e4 1130 if (!pdev->usb_init) {
2b455db6 1131 PWC_DEBUG_OPEN("Doing first time initialization.\n");
1da177e4 1132 pdev->usb_init = 1;
d56410e0 1133
2b455db6
LS
1134 /* Query sensor type */
1135 ret = pwc_get_cmos_sensor(pdev, &i);
1136 if (ret >= 0)
1da177e4 1137 {
2b455db6
LS
1138 PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
1139 pdev->vdev->name,
1140 pwc_sensor_type_to_string(i), i);
1da177e4
LT
1141 }
1142 }
1143
1144 /* Turn on camera */
1145 if (power_save) {
1146 i = pwc_camera_power(pdev, 1);
1147 if (i < 0)
2b455db6 1148 PWC_DEBUG_OPEN("Failed to restore power to the camera! (%d)\n", i);
1da177e4
LT
1149 }
1150 /* Set LED on/off time */
1151 if (pwc_set_leds(pdev, led_on, led_off) < 0)
2b455db6 1152 PWC_DEBUG_OPEN("Failed to set LED on/off time.\n");
d56410e0 1153
1da177e4
LT
1154
1155 /* So far, so good. Allocate memory. */
1156 i = pwc_allocate_buffers(pdev);
1157 if (i < 0) {
2b455db6
LS
1158 PWC_DEBUG_OPEN("Failed to allocate buffers memory.\n");
1159 pwc_free_buffers(pdev);
b9378fdb 1160 mutex_unlock(&pdev->modlock);
1da177e4
LT
1161 return i;
1162 }
d56410e0 1163
1da177e4
LT
1164 /* Reset buffers & parameters */
1165 pwc_reset_buffers(pdev);
2b455db6 1166 for (i = 0; i < pwc_mbufs; i++)
1da177e4
LT
1167 pdev->image_used[i] = 0;
1168 pdev->vframe_count = 0;
1169 pdev->vframes_dumped = 0;
1170 pdev->vframes_error = 0;
1171 pdev->visoc_errors = 0;
1172 pdev->error_status = 0;
1da177e4
LT
1173 pwc_construct(pdev); /* set min/max sizes correct */
1174
1175 /* Set some defaults */
1176 pdev->vsnapshot = 0;
1177
1178 /* Start iso pipe for video; first try the last used video size
1179 (or the default one); if that fails try QCIF/10 or QSIF/10;
1180 it that fails too, give up.
1181 */
1182 i = pwc_set_video_mode(pdev, pwc_image_sizes[pdev->vsize].x, pwc_image_sizes[pdev->vsize].y, pdev->vframes, pdev->vcompression, 0);
1183 if (i) {
2b455db6
LS
1184 unsigned int default_resolution;
1185 PWC_DEBUG_OPEN("First attempt at set_video_mode failed.\n");
1186 if (pdev->type>= 730)
1187 default_resolution = PSZ_QSIF;
1da177e4 1188 else
2b455db6
LS
1189 default_resolution = PSZ_QCIF;
1190
1191 i = pwc_set_video_mode(pdev,
1192 pwc_image_sizes[default_resolution].x,
1193 pwc_image_sizes[default_resolution].y,
1194 10,
1195 pdev->vcompression,
1196 0);
1da177e4
LT
1197 }
1198 if (i) {
2b455db6
LS
1199 PWC_DEBUG_OPEN("Second attempt at set_video_mode failed.\n");
1200 pwc_free_buffers(pdev);
b9378fdb 1201 mutex_unlock(&pdev->modlock);
1da177e4
LT
1202 return i;
1203 }
d56410e0 1204
1da177e4
LT
1205 i = pwc_isoc_init(pdev);
1206 if (i) {
2b455db6
LS
1207 PWC_DEBUG_OPEN("Failed to init ISOC stuff = %d.\n", i);
1208 pwc_isoc_cleanup(pdev);
1209 pwc_free_buffers(pdev);
b9378fdb 1210 mutex_unlock(&pdev->modlock);
1da177e4
LT
1211 return i;
1212 }
1213
2b455db6
LS
1214 /* Initialize the webcam to sane value */
1215 pwc_set_brightness(pdev, 0x7fff);
1216 pwc_set_agc(pdev, 1, 0);
1217
1da177e4
LT
1218 pdev->vopen++;
1219 file->private_data = vdev;
b9378fdb 1220 mutex_unlock(&pdev->modlock);
2b455db6 1221 PWC_DEBUG_OPEN("<< video_open() returns 0.\n");
1da177e4
LT
1222 return 0;
1223}
1224
85237f20
ON
1225
1226static void pwc_cleanup(struct pwc_device *pdev)
1227{
1228 pwc_remove_sysfs_files(pdev->vdev);
1229 video_unregister_device(pdev->vdev);
e32a7ecc
NPT
1230
1231#ifdef CONFIG_USB_PWC_INPUT_EVDEV
1232 if (pdev->button_dev) {
1233 input_unregister_device(pdev->button_dev);
1234 input_free_device(pdev->button_dev);
1235 kfree(pdev->button_dev->phys);
1236 pdev->button_dev = NULL;
1237 }
1238#endif
85237f20
ON
1239}
1240
1da177e4 1241/* Note that all cleanup is done in the reverse order as in _open */
bec43661 1242static int pwc_video_close(struct file *file)
1da177e4
LT
1243{
1244 struct video_device *vdev = file->private_data;
1245 struct pwc_device *pdev;
85237f20 1246 int i, hint;
1da177e4 1247
2b455db6 1248 PWC_DEBUG_OPEN(">> video_close called(vdev = 0x%p).\n", vdev);
1da177e4 1249
0b67f5c5 1250 lock_kernel();
601e9444 1251 pdev = video_get_drvdata(vdev);
1da177e4 1252 if (pdev->vopen == 0)
2b455db6 1253 PWC_DEBUG_MODULE("video_close() called on closed device?\n");
1da177e4
LT
1254
1255 /* Dump statistics, but only if a reasonable amount of frames were
1256 processed (to prevent endless log-entries in case of snap-shot
1257 programs)
1258 */
1259 if (pdev->vframe_count > 20)
2b455db6 1260 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);
1da177e4 1261
2b455db6
LS
1262 if (DEVICE_USE_CODEC1(pdev->type))
1263 pwc_dec1_exit();
1264 else
1265 pwc_dec23_exit();
1da177e4
LT
1266
1267 pwc_isoc_cleanup(pdev);
1268 pwc_free_buffers(pdev);
1269
1270 /* Turn off LEDS and power down camera, but only when not unplugged */
85237f20 1271 if (!pdev->unplugged) {
1da177e4
LT
1272 /* Turn LEDs off */
1273 if (pwc_set_leds(pdev, 0, 0) < 0)
2b455db6 1274 PWC_DEBUG_MODULE("Failed to set LED on/off time.\n");
1da177e4
LT
1275 if (power_save) {
1276 i = pwc_camera_power(pdev, 0);
1277 if (i < 0)
2b455db6 1278 PWC_ERROR("Failed to power down camera (%d)\n", i);
1da177e4 1279 }
85237f20 1280 pdev->vopen--;
7b9fbc3e 1281 PWC_DEBUG_OPEN("<< video_close() vopen=%d\n", pdev->vopen);
85237f20
ON
1282 } else {
1283 pwc_cleanup(pdev);
1284 /* Free memory (don't set pdev to 0 just yet) */
1285 kfree(pdev);
1286 /* search device_hint[] table if we occupy a slot, by any chance */
1287 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1288 if (device_hint[hint].pdev == pdev)
1289 device_hint[hint].pdev = NULL;
1da177e4 1290 }
85237f20
ON
1291 unlock_kernel();
1292
1da177e4
LT
1293 return 0;
1294}
1295
1296/*
1297 * FIXME: what about two parallel reads ????
1298 * ANSWER: Not supported. You can't open the device more than once,
d56410e0
MCC
1299 despite what the V4L1 interface says. First, I don't see
1300 the need, second there's no mechanism of alerting the
1301 2nd/3rd/... process of events like changing image size.
1302 And I don't see the point of blocking that for the
1303 2nd/3rd/... process.
1304 In multi-threaded environments reading parallel from any
1305 device is tricky anyhow.
1da177e4
LT
1306 */
1307
2b455db6 1308static ssize_t pwc_video_read(struct file *file, char __user *buf,
1da177e4
LT
1309 size_t count, loff_t *ppos)
1310{
1311 struct video_device *vdev = file->private_data;
1312 struct pwc_device *pdev;
1313 int noblock = file->f_flags & O_NONBLOCK;
1314 DECLARE_WAITQUEUE(wait, current);
0b67f5c5 1315 int bytes_to_read, rv = 0;
2b455db6 1316 void *image_buffer_addr;
1da177e4 1317
2b455db6
LS
1318 PWC_DEBUG_READ("pwc_video_read(vdev=0x%p, buf=%p, count=%zd) called.\n",
1319 vdev, buf, count);
1da177e4
LT
1320 if (vdev == NULL)
1321 return -EFAULT;
601e9444 1322 pdev = video_get_drvdata(vdev);
1da177e4
LT
1323 if (pdev == NULL)
1324 return -EFAULT;
0b67f5c5
ON
1325
1326 mutex_lock(&pdev->modlock);
1327 if (pdev->error_status) {
1328 rv = -pdev->error_status; /* Something happened, report what. */
1329 goto err_out;
1330 }
1da177e4
LT
1331
1332 /* In case we're doing partial reads, we don't have to wait for a frame */
1333 if (pdev->image_read_pos == 0) {
1334 /* Do wait queueing according to the (doc)book */
1335 add_wait_queue(&pdev->frameq, &wait);
1336 while (pdev->full_frames == NULL) {
1337 /* Check for unplugged/etc. here */
1338 if (pdev->error_status) {
1339 remove_wait_queue(&pdev->frameq, &wait);
1340 set_current_state(TASK_RUNNING);
0b67f5c5
ON
1341 rv = -pdev->error_status ;
1342 goto err_out;
1da177e4 1343 }
d56410e0
MCC
1344 if (noblock) {
1345 remove_wait_queue(&pdev->frameq, &wait);
1346 set_current_state(TASK_RUNNING);
0b67f5c5
ON
1347 rv = -EWOULDBLOCK;
1348 goto err_out;
d56410e0
MCC
1349 }
1350 if (signal_pending(current)) {
1351 remove_wait_queue(&pdev->frameq, &wait);
1352 set_current_state(TASK_RUNNING);
0b67f5c5
ON
1353 rv = -ERESTARTSYS;
1354 goto err_out;
d56410e0
MCC
1355 }
1356 schedule();
1357 set_current_state(TASK_INTERRUPTIBLE);
1da177e4
LT
1358 }
1359 remove_wait_queue(&pdev->frameq, &wait);
1360 set_current_state(TASK_RUNNING);
d56410e0 1361
1da177e4 1362 /* Decompress and release frame */
0b67f5c5
ON
1363 if (pwc_handle_frame(pdev)) {
1364 rv = -EFAULT;
1365 goto err_out;
1366 }
1da177e4
LT
1367 }
1368
2b455db6 1369 PWC_DEBUG_READ("Copying data to user space.\n");
1da177e4 1370 if (pdev->vpalette == VIDEO_PALETTE_RAW)
2b455db6 1371 bytes_to_read = pdev->frame_size + sizeof(struct pwc_raw_frame);
1da177e4 1372 else
d56410e0 1373 bytes_to_read = pdev->view.size;
1da177e4
LT
1374
1375 /* copy bytes to user space; we allow for partial reads */
1376 if (count + pdev->image_read_pos > bytes_to_read)
1377 count = bytes_to_read - pdev->image_read_pos;
2b455db6
LS
1378 image_buffer_addr = pdev->image_data;
1379 image_buffer_addr += pdev->images[pdev->fill_image].offset;
1380 image_buffer_addr += pdev->image_read_pos;
0b67f5c5
ON
1381 if (copy_to_user(buf, image_buffer_addr, count)) {
1382 rv = -EFAULT;
1383 goto err_out;
1384 }
1da177e4
LT
1385 pdev->image_read_pos += count;
1386 if (pdev->image_read_pos >= bytes_to_read) { /* All data has been read */
1387 pdev->image_read_pos = 0;
1388 pwc_next_image(pdev);
1389 }
0b67f5c5 1390 mutex_unlock(&pdev->modlock);
1da177e4 1391 return count;
0b67f5c5
ON
1392err_out:
1393 mutex_unlock(&pdev->modlock);
1394 return rv;
1da177e4
LT
1395}
1396
1397static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
1398{
1399 struct video_device *vdev = file->private_data;
1400 struct pwc_device *pdev;
1401
1402 if (vdev == NULL)
1403 return -EFAULT;
601e9444 1404 pdev = video_get_drvdata(vdev);
1da177e4
LT
1405 if (pdev == NULL)
1406 return -EFAULT;
1407
1408 poll_wait(file, &pdev->frameq, wait);
1409 if (pdev->error_status)
1410 return POLLERR;
1411 if (pdev->full_frames != NULL) /* we have frames waiting */
1412 return (POLLIN | POLLRDNORM);
1413
1414 return 0;
1415}
1416
069b7479 1417static long pwc_video_ioctl(struct file *file,
1da177e4
LT
1418 unsigned int cmd, unsigned long arg)
1419{
0b67f5c5
ON
1420 struct video_device *vdev = file->private_data;
1421 struct pwc_device *pdev;
069b7479 1422 long r = -ENODEV;
0b67f5c5
ON
1423
1424 if (!vdev)
1425 goto out;
601e9444 1426 pdev = video_get_drvdata(vdev);
0b67f5c5
ON
1427
1428 mutex_lock(&pdev->modlock);
1429 if (!pdev->unplugged)
f473bf76 1430 r = video_usercopy(file, cmd, arg, pwc_video_do_ioctl);
0b67f5c5
ON
1431 mutex_unlock(&pdev->modlock);
1432out:
1433 return r;
1da177e4
LT
1434}
1435
1da177e4
LT
1436static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
1437{
1438 struct video_device *vdev = file->private_data;
1439 struct pwc_device *pdev;
2b455db6
LS
1440 unsigned long start;
1441 unsigned long size;
1442 unsigned long page, pos = 0;
1443 int index;
d56410e0 1444
645635b0 1445 PWC_DEBUG_MEMORY(">> %s\n", __func__);
601e9444 1446 pdev = video_get_drvdata(vdev);
2b455db6
LS
1447 size = vma->vm_end - vma->vm_start;
1448 start = vma->vm_start;
d56410e0 1449
2b455db6
LS
1450 /* Find the idx buffer for this mapping */
1451 for (index = 0; index < pwc_mbufs; index++) {
1452 pos = pdev->images[index].offset;
1453 if ((pos>>PAGE_SHIFT) == vma->vm_pgoff)
1454 break;
1455 }
1456 if (index == MAX_IMAGES)
1457 return -EINVAL;
1458 if (index == 0) {
1459 /*
1460 * Special case for v4l1. In v4l1, we map only one big buffer,
1461 * but in v4l2 each buffer is mapped
1462 */
1463 unsigned long total_size;
1464 total_size = pwc_mbufs * pdev->len_per_image;
1465 if (size != pdev->len_per_image && size != total_size) {
1466 PWC_ERROR("Wrong size (%lu) needed to be len_per_image=%d or total_size=%lu\n",
1467 size, pdev->len_per_image, total_size);
1468 return -EINVAL;
1469 }
1470 } else if (size > pdev->len_per_image)
1471 return -EINVAL;
1472
1473 vma->vm_flags |= VM_IO; /* from 2.6.9-acX */
1da177e4 1474
2b455db6 1475 pos += (unsigned long)pdev->image_data;
1da177e4
LT
1476 while (size > 0) {
1477 page = vmalloc_to_pfn((void *)pos);
1478 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
1479 return -EAGAIN;
1da177e4
LT
1480 start += PAGE_SIZE;
1481 pos += PAGE_SIZE;
1482 if (size > PAGE_SIZE)
1483 size -= PAGE_SIZE;
1484 else
1485 size = 0;
1486 }
1da177e4
LT
1487 return 0;
1488}
1489
1490/***************************************************************************/
1491/* USB functions */
1492
1493/* This function gets called when a new device is plugged in or the usb core
1494 * is loaded.
1495 */
1496
1497static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
1498{
1499 struct usb_device *udev = interface_to_usbdev(intf);
1500 struct pwc_device *pdev = NULL;
1501 int vendor_id, product_id, type_id;
c12e3be0 1502 int i, hint, rc;
1da177e4
LT
1503 int features = 0;
1504 int video_nr = -1; /* default: use next available device */
1505 char serial_number[30], *name;
e32a7ecc
NPT
1506#ifdef CONFIG_USB_PWC_INPUT_EVDEV
1507 char *phys = NULL;
1508#endif
1da177e4 1509
2b455db6
LS
1510 vendor_id = le16_to_cpu(udev->descriptor.idVendor);
1511 product_id = le16_to_cpu(udev->descriptor.idProduct);
1512
1da177e4 1513 /* Check if we can handle this device */
2b455db6
LS
1514 PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
1515 vendor_id, product_id,
1da177e4
LT
1516 intf->altsetting->desc.bInterfaceNumber);
1517
1518 /* the interfaces are probed one by one. We are only interested in the
1519 video interface (0) now.
1520 Interface 1 is the Audio Control, and interface 2 Audio itself.
1521 */
1522 if (intf->altsetting->desc.bInterfaceNumber > 0)
1523 return -ENODEV;
1524
1da177e4
LT
1525 if (vendor_id == 0x0471) {
1526 switch (product_id) {
1527 case 0x0302:
2b455db6 1528 PWC_INFO("Philips PCA645VC USB webcam detected.\n");
1da177e4
LT
1529 name = "Philips 645 webcam";
1530 type_id = 645;
1531 break;
1532 case 0x0303:
2b455db6 1533 PWC_INFO("Philips PCA646VC USB webcam detected.\n");
1da177e4
LT
1534 name = "Philips 646 webcam";
1535 type_id = 646;
1536 break;
1537 case 0x0304:
2b455db6 1538 PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
1da177e4
LT
1539 name = "Askey VC010 webcam";
1540 type_id = 646;
1541 break;
1542 case 0x0307:
2b455db6 1543 PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
1da177e4
LT
1544 name = "Philips 675 webcam";
1545 type_id = 675;
1546 break;
1547 case 0x0308:
2b455db6 1548 PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
1da177e4
LT
1549 name = "Philips 680 webcam";
1550 type_id = 680;
1551 break;
1552 case 0x030C:
2b455db6 1553 PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
1da177e4
LT
1554 name = "Philips 690 webcam";
1555 type_id = 690;
1556 break;
1557 case 0x0310:
2b455db6 1558 PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
1da177e4
LT
1559 name = "Philips 730 webcam";
1560 type_id = 730;
1561 break;
1562 case 0x0311:
2b455db6 1563 PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
1da177e4
LT
1564 name = "Philips 740 webcam";
1565 type_id = 740;
1566 break;
1567 case 0x0312:
2b455db6 1568 PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
1da177e4
LT
1569 name = "Philips 750 webcam";
1570 type_id = 750;
1571 break;
1572 case 0x0313:
2b455db6 1573 PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
1da177e4
LT
1574 name = "Philips 720K/40 webcam";
1575 type_id = 720;
1576 break;
2b455db6
LS
1577 case 0x0329:
1578 PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
1579 name = "Philips SPC 900NC webcam";
9ee6d78c 1580 type_id = 740;
2b455db6 1581 break;
1da177e4
LT
1582 default:
1583 return -ENODEV;
1584 break;
1585 }
1586 }
1587 else if (vendor_id == 0x069A) {
1588 switch(product_id) {
1589 case 0x0001:
2b455db6 1590 PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
1da177e4
LT
1591 name = "Askey VC010 webcam";
1592 type_id = 645;
1593 break;
1594 default:
1595 return -ENODEV;
1596 break;
1597 }
1598 }
1599 else if (vendor_id == 0x046d) {
1600 switch(product_id) {
1601 case 0x08b0:
2b455db6 1602 PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
1da177e4
LT
1603 name = "Logitech QuickCam Pro 3000";
1604 type_id = 740; /* CCD sensor */
1605 break;
1606 case 0x08b1:
2b455db6 1607 PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
1da177e4
LT
1608 name = "Logitech QuickCam Notebook Pro";
1609 type_id = 740; /* CCD sensor */
1610 break;
1611 case 0x08b2:
2b455db6 1612 PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
1da177e4
LT
1613 name = "Logitech QuickCam Pro 4000";
1614 type_id = 740; /* CCD sensor */
1615 break;
1616 case 0x08b3:
2b455db6 1617 PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
1da177e4
LT
1618 name = "Logitech QuickCam Zoom";
1619 type_id = 740; /* CCD sensor */
1620 break;
1621 case 0x08B4:
2b455db6 1622 PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
1da177e4
LT
1623 name = "Logitech QuickCam Zoom";
1624 type_id = 740; /* CCD sensor */
2b455db6 1625 power_save = 1;
1da177e4
LT
1626 break;
1627 case 0x08b5:
2b455db6 1628 PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
1da177e4
LT
1629 name = "Logitech QuickCam Orbit";
1630 type_id = 740; /* CCD sensor */
1631 features |= FEATURE_MOTOR_PANTILT;
1632 break;
1633 case 0x08b6:
a63e157f
JT
1634 PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
1635 name = "Cisco VT Camera";
1636 type_id = 740; /* CCD sensor */
1637 break;
1da177e4 1638 case 0x08b7:
6b1ce3c1
MCC
1639 PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
1640 name = "Logitech ViewPort AV 100";
1641 type_id = 740; /* CCD sensor */
1642 break;
1643 case 0x08b8: /* Where this released? */
2b455db6 1644 PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
1da177e4
LT
1645 name = "Logitech QuickCam (res.)";
1646 type_id = 730; /* Assuming CMOS */
1647 break;
d56410e0 1648 default:
1da177e4 1649 return -ENODEV;
d56410e0
MCC
1650 break;
1651 }
1652 }
1da177e4
LT
1653 else if (vendor_id == 0x055d) {
1654 /* I don't know the difference between the C10 and the C30;
1655 I suppose the difference is the sensor, but both cameras
1656 work equally well with a type_id of 675
1657 */
1658 switch(product_id) {
1659 case 0x9000:
2b455db6 1660 PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
1da177e4
LT
1661 name = "Samsung MPC-C10";
1662 type_id = 675;
1663 break;
1664 case 0x9001:
2b455db6 1665 PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
1da177e4
LT
1666 name = "Samsung MPC-C30";
1667 type_id = 675;
1668 break;
2b455db6
LS
1669 case 0x9002:
1670 PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
1671 name = "Samsung MPC-C30";
1672 type_id = 740;
1673 break;
1da177e4
LT
1674 default:
1675 return -ENODEV;
1676 break;
1677 }
1678 }
1679 else if (vendor_id == 0x041e) {
1680 switch(product_id) {
1681 case 0x400c:
2b455db6 1682 PWC_INFO("Creative Labs Webcam 5 detected.\n");
1da177e4
LT
1683 name = "Creative Labs Webcam 5";
1684 type_id = 730;
1685 break;
1686 case 0x4011:
2b455db6 1687 PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
1da177e4
LT
1688 name = "Creative Labs Webcam Pro Ex";
1689 type_id = 740;
1690 break;
1691 default:
1692 return -ENODEV;
1693 break;
1694 }
1695 }
1696 else if (vendor_id == 0x04cc) {
1697 switch(product_id) {
1698 case 0x8116:
2b455db6 1699 PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
1da177e4
LT
1700 name = "Sotec Afina Eye";
1701 type_id = 730;
1702 break;
1703 default:
1704 return -ENODEV;
1705 break;
1706 }
1707 }
1708 else if (vendor_id == 0x06be) {
1709 switch(product_id) {
1710 case 0x8116:
1711 /* This is essentially the same cam as the Sotec Afina Eye */
2b455db6 1712 PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
1da177e4
LT
1713 name = "AME Co. Afina Eye";
1714 type_id = 750;
1715 break;
1716 default:
1717 return -ENODEV;
1718 break;
1719 }
d56410e0 1720
1da177e4
LT
1721 }
1722 else if (vendor_id == 0x0d81) {
1723 switch(product_id) {
1724 case 0x1900:
2b455db6 1725 PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
1da177e4
LT
1726 name = "Visionite VCS-UC300";
1727 type_id = 740; /* CCD sensor */
1728 break;
1729 case 0x1910:
2b455db6 1730 PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
1da177e4
LT
1731 name = "Visionite VCS-UM100";
1732 type_id = 730; /* CMOS sensor */
1733 break;
1734 default:
1735 return -ENODEV;
1736 break;
1737 }
1738 }
d56410e0 1739 else
1da177e4
LT
1740 return -ENODEV; /* Not any of the know types; but the list keeps growing. */
1741
1742 memset(serial_number, 0, 30);
1743 usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
2b455db6 1744 PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
1da177e4
LT
1745
1746 if (udev->descriptor.bNumConfigurations > 1)
2b455db6 1747 PWC_WARNING("Warning: more than 1 configuration available.\n");
1da177e4
LT
1748
1749 /* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
80b6ca48 1750 pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
1da177e4 1751 if (pdev == NULL) {
2b455db6 1752 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
1da177e4
LT
1753 return -ENOMEM;
1754 }
1da177e4
LT
1755 pdev->type = type_id;
1756 pdev->vsize = default_size;
1757 pdev->vframes = default_fps;
1758 strcpy(pdev->serial, serial_number);
1759 pdev->features = features;
1760 if (vendor_id == 0x046D && product_id == 0x08B5)
1761 {
1762 /* Logitech QuickCam Orbit
d56410e0
MCC
1763 The ranges have been determined experimentally; they may differ from cam to cam.
1764 Also, the exact ranges left-right and up-down are different for my cam
1765 */
1da177e4
LT
1766 pdev->angle_range.pan_min = -7000;
1767 pdev->angle_range.pan_max = 7000;
1768 pdev->angle_range.tilt_min = -3000;
1769 pdev->angle_range.tilt_max = 2500;
1770 }
1771
b9378fdb 1772 mutex_init(&pdev->modlock);
1da177e4
LT
1773 spin_lock_init(&pdev->ptrlock);
1774
1775 pdev->udev = udev;
1776 init_waitqueue_head(&pdev->frameq);
1777 pdev->vcompression = pwc_preferred_compression;
1778
1779 /* Allocate video_device structure */
1780 pdev->vdev = video_device_alloc();
5fa1247a 1781 if (!pdev->vdev) {
2b455db6 1782 PWC_ERROR("Err, cannot allocate video_device struture. Failing probe.");
1da177e4
LT
1783 kfree(pdev);
1784 return -ENOMEM;
1785 }
1786 memcpy(pdev->vdev, &pwc_template, sizeof(pwc_template));
52a85e17 1787 pdev->vdev->parent = &intf->dev;
1da177e4 1788 strcpy(pdev->vdev->name, name);
1da177e4
LT
1789 video_set_drvdata(pdev->vdev, pdev);
1790
1791 pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
2b455db6 1792 PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
1da177e4
LT
1793
1794 /* Now search device_hint[] table for a match, so we can hint a node number. */
1795 for (hint = 0; hint < MAX_DEV_HINTS; hint++) {
1796 if (((device_hint[hint].type == -1) || (device_hint[hint].type == pdev->type)) &&
1797 (device_hint[hint].pdev == NULL)) {
1798 /* so far, so good... try serial number */
1799 if ((device_hint[hint].serial_number[0] == '*') || !strcmp(device_hint[hint].serial_number, serial_number)) {
657de3cd
TP
1800 /* match! */
1801 video_nr = device_hint[hint].device_node;
1802 PWC_DEBUG_PROBE("Found hint, will try to register as /dev/video%d\n", video_nr);
1803 break;
1da177e4
LT
1804 }
1805 }
1806 }
1807
1808 pdev->vdev->release = video_device_release;
1809 i = video_register_device(pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1810 if (i < 0) {
2b455db6 1811 PWC_ERROR("Failed to register as video device (%d).\n", i);
c12e3be0
JG
1812 rc = i;
1813 goto err;
1da177e4
LT
1814 }
1815 else {
c6330fb8 1816 PWC_INFO("Registered as /dev/video%d.\n", pdev->vdev->num);
1da177e4
LT
1817 }
1818
1819 /* occupy slot */
d56410e0 1820 if (hint < MAX_DEV_HINTS)
1da177e4
LT
1821 device_hint[hint].pdev = pdev;
1822
2b455db6 1823 PWC_DEBUG_PROBE("probe() function returning struct at 0x%p.\n", pdev);
1da177e4 1824 usb_set_intfdata (intf, pdev);
c12e3be0
JG
1825 rc = pwc_create_sysfs_files(pdev->vdev);
1826 if (rc)
1827 goto err_unreg;
2b455db6
LS
1828
1829 /* Set the leds off */
1830 pwc_set_leds(pdev, 0, 0);
1831 pwc_camera_power(pdev, 0);
1832
e32a7ecc
NPT
1833#ifdef CONFIG_USB_PWC_INPUT_EVDEV
1834 /* register webcam snapshot button input device */
1835 pdev->button_dev = input_allocate_device();
1836 if (!pdev->button_dev) {
1837 PWC_ERROR("Err, insufficient memory for webcam snapshot button device.");
1838 return -ENOMEM;
1839 }
1840
1841 pdev->button_dev->name = "PWC snapshot button";
1842 phys = kasprintf(GFP_KERNEL,"usb-%s-%s", pdev->udev->bus->bus_name, pdev->udev->devpath);
1843 if (!phys) {
1844 input_free_device(pdev->button_dev);
1845 return -ENOMEM;
1846 }
1847 pdev->button_dev->phys = phys;
1848 usb_to_input_id(pdev->udev, &pdev->button_dev->id);
1849 pdev->button_dev->dev.parent = &pdev->udev->dev;
1850 pdev->button_dev->evbit[0] = BIT_MASK(EV_KEY);
bcd3e4b3 1851 pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
e32a7ecc
NPT
1852
1853 rc = input_register_device(pdev->button_dev);
1854 if (rc) {
1855 input_free_device(pdev->button_dev);
1856 kfree(pdev->button_dev->phys);
1857 pdev->button_dev = NULL;
1858 return rc;
1859 }
1860#endif
1861
1da177e4 1862 return 0;
c12e3be0
JG
1863
1864err_unreg:
1865 if (hint < MAX_DEV_HINTS)
1866 device_hint[hint].pdev = NULL;
1867 video_unregister_device(pdev->vdev);
1868err:
1869 video_device_release(pdev->vdev); /* Drip... drip... drip... */
1870 kfree(pdev); /* Oops, no memory leaks please */
1871 return rc;
1da177e4
LT
1872}
1873
1874/* The user janked out the cable... */
1875static void usb_pwc_disconnect(struct usb_interface *intf)
1876{
1877 struct pwc_device *pdev;
1878 int hint;
1879
1880 lock_kernel();
1881 pdev = usb_get_intfdata (intf);
1882 usb_set_intfdata (intf, NULL);
1883 if (pdev == NULL) {
2b455db6 1884 PWC_ERROR("pwc_disconnect() Called without private pointer.\n");
1da177e4
LT
1885 goto disconnect_out;
1886 }
1887 if (pdev->udev == NULL) {
2b455db6 1888 PWC_ERROR("pwc_disconnect() already called for %p\n", pdev);
1da177e4
LT
1889 goto disconnect_out;
1890 }
1891 if (pdev->udev != interface_to_usbdev(intf)) {
2b455db6 1892 PWC_ERROR("pwc_disconnect() Woops: pointer mismatch udev/pdev.\n");
1da177e4
LT
1893 goto disconnect_out;
1894 }
d56410e0 1895
1da177e4
LT
1896 /* We got unplugged; this is signalled by an EPIPE error code */
1897 if (pdev->vopen) {
2b455db6 1898 PWC_INFO("Disconnected while webcam is in use!\n");
1da177e4
LT
1899 pdev->error_status = EPIPE;
1900 }
1901
1902 /* Alert waiting processes */
1903 wake_up_interruptible(&pdev->frameq);
1904 /* Wait until device is closed */
85237f20 1905 if(pdev->vopen) {
0b67f5c5 1906 mutex_lock(&pdev->modlock);
85237f20 1907 pdev->unplugged = 1;
0b67f5c5
ON
1908 mutex_unlock(&pdev->modlock);
1909 pwc_iso_stop(pdev);
85237f20
ON
1910 } else {
1911 /* Device is closed, so we can safely unregister it */
1912 PWC_DEBUG_PROBE("Unregistering video device in disconnect().\n");
1913 pwc_cleanup(pdev);
1914 /* Free memory (don't set pdev to 0 just yet) */
1915 kfree(pdev);
1da177e4
LT
1916
1917disconnect_out:
85237f20
ON
1918 /* search device_hint[] table if we occupy a slot, by any chance */
1919 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1920 if (device_hint[hint].pdev == pdev)
1921 device_hint[hint].pdev = NULL;
1922 }
1da177e4
LT
1923
1924 unlock_kernel();
1925}
1926
1da177e4
LT
1927/* *grunt* We have to do atoi ourselves :-( */
1928static int pwc_atoi(const char *s)
1929{
1930 int k = 0;
1931
1932 k = 0;
1933 while (*s != '\0' && *s >= '0' && *s <= '9') {
1934 k = 10 * k + (*s - '0');
1935 s++;
1936 }
1937 return k;
1938}
1939
1940
d56410e0
MCC
1941/*
1942 * Initialization code & module stuff
1da177e4
LT
1943 */
1944
2b455db6
LS
1945static char *size;
1946static int fps;
1947static int fbufs;
1948static int mbufs;
1da177e4
LT
1949static int compression = -1;
1950static int leds[2] = { -1, -1 };
64a6f950 1951static unsigned int leds_nargs;
2b455db6 1952static char *dev_hint[MAX_DEV_HINTS];
64a6f950 1953static unsigned int dev_hint_nargs;
2b455db6
LS
1954
1955module_param(size, charp, 0444);
1956module_param(fps, int, 0444);
1957module_param(fbufs, int, 0444);
1958module_param(mbufs, int, 0444);
05ad3907 1959#ifdef CONFIG_USB_PWC_DEBUG
2b455db6
LS
1960module_param_named(trace, pwc_trace, int, 0644);
1961#endif
1962module_param(power_save, int, 0444);
1963module_param(compression, int, 0444);
1964module_param_array(leds, int, &leds_nargs, 0444);
1965module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
1da177e4 1966
1da177e4 1967MODULE_PARM_DESC(size, "Initial image size. One of sqcif, qsif, qcif, sif, cif, vga");
1da177e4 1968MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
1da177e4 1969MODULE_PARM_DESC(fbufs, "Number of internal frame buffers to reserve");
1da177e4 1970MODULE_PARM_DESC(mbufs, "Number of external (mmap()ed) image buffers");
1da177e4 1971MODULE_PARM_DESC(trace, "For debugging purposes");
1da177e4 1972MODULE_PARM_DESC(power_save, "Turn power save feature in camera on or off");
1da177e4 1973MODULE_PARM_DESC(compression, "Preferred compression quality. Range 0 (uncompressed) to 3 (high compression)");
1da177e4 1974MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
1da177e4
LT
1975MODULE_PARM_DESC(dev_hint, "Device node hints");
1976
1977MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
1978MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
1979MODULE_LICENSE("GPL");
2b455db6
LS
1980MODULE_ALIAS("pwcx");
1981MODULE_VERSION( PWC_VERSION );
1da177e4
LT
1982
1983static int __init usb_pwc_init(void)
1984{
1985 int i, sz;
1986 char *sizenames[PSZ_MAX] = { "sqcif", "qsif", "qcif", "sif", "cif", "vga" };
1987
2b455db6
LS
1988 PWC_INFO("Philips webcam module version " PWC_VERSION " loaded.\n");
1989 PWC_INFO("Supports Philips PCA645/646, PCVC675/680/690, PCVC720[40]/730/740/750 & PCVC830/840.\n");
1990 PWC_INFO("Also supports the Askey VC010, various Logitech Quickcams, Samsung MPC-C10 and MPC-C30,\n");
1991 PWC_INFO("the Creative WebCam 5 & Pro Ex, SOTEC Afina Eye and Visionite VCS-UC300 and VCS-UM100.\n");
1da177e4
LT
1992
1993 if (fps) {
1994 if (fps < 4 || fps > 30) {
2b455db6 1995 PWC_ERROR("Framerate out of bounds (4-30).\n");
1da177e4
LT
1996 return -EINVAL;
1997 }
1998 default_fps = fps;
2b455db6 1999 PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
1da177e4
LT
2000 }
2001
2b455db6 2002 if (size) {
1da177e4
LT
2003 /* string; try matching with array */
2004 for (sz = 0; sz < PSZ_MAX; sz++) {
2005 if (!strcmp(sizenames[sz], size)) { /* Found! */
2006 default_size = sz;
2007 break;
2008 }
2009 }
2010 if (sz == PSZ_MAX) {
2b455db6 2011 PWC_ERROR("Size not recognized; try size=[sqcif | qsif | qcif | sif | cif | vga].\n");
1da177e4
LT
2012 return -EINVAL;
2013 }
2b455db6 2014 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);
1da177e4
LT
2015 }
2016 if (mbufs) {
2017 if (mbufs < 1 || mbufs > MAX_IMAGES) {
2b455db6 2018 PWC_ERROR("Illegal number of mmap() buffers; use a number between 1 and %d.\n", MAX_IMAGES);
1da177e4
LT
2019 return -EINVAL;
2020 }
2b455db6
LS
2021 pwc_mbufs = mbufs;
2022 PWC_DEBUG_MODULE("Number of image buffers set to %d.\n", pwc_mbufs);
1da177e4
LT
2023 }
2024 if (fbufs) {
2025 if (fbufs < 2 || fbufs > MAX_FRAMES) {
2b455db6 2026 PWC_ERROR("Illegal number of frame buffers; use a number between 2 and %d.\n", MAX_FRAMES);
1da177e4
LT
2027 return -EINVAL;
2028 }
2029 default_fbufs = fbufs;
2b455db6 2030 PWC_DEBUG_MODULE("Number of frame buffers set to %d.\n", default_fbufs);
1da177e4 2031 }
05ad3907 2032#ifdef CONFIG_USB_PWC_DEBUG
2b455db6
LS
2033 if (pwc_trace >= 0) {
2034 PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
1da177e4 2035 }
2b455db6 2036#endif
1da177e4
LT
2037 if (compression >= 0) {
2038 if (compression > 3) {
2b455db6 2039 PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
1da177e4
LT
2040 return -EINVAL;
2041 }
2042 pwc_preferred_compression = compression;
2b455db6 2043 PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
1da177e4
LT
2044 }
2045 if (power_save)
2b455db6 2046 PWC_DEBUG_MODULE("Enabling power save on open/close.\n");
1da177e4
LT
2047 if (leds[0] >= 0)
2048 led_on = leds[0];
2049 if (leds[1] >= 0)
2050 led_off = leds[1];
2051
093cf723 2052 /* Big device node whoopla. Basically, it allows you to assign a
1da177e4
LT
2053 device node (/dev/videoX) to a camera, based on its type
2054 & serial number. The format is [type[.serialnumber]:]node.
2055
2056 Any camera that isn't matched by these rules gets the next
2057 available free device node.
2058 */
2059 for (i = 0; i < MAX_DEV_HINTS; i++) {
2060 char *s, *colon, *dot;
2061
2062 /* This loop also initializes the array */
2063 device_hint[i].pdev = NULL;
2064 s = dev_hint[i];
2065 if (s != NULL && *s != '\0') {
2066 device_hint[i].type = -1; /* wildcard */
2067 strcpy(device_hint[i].serial_number, "*");
2068
2069 /* parse string: chop at ':' & '/' */
2070 colon = dot = s;
2071 while (*colon != '\0' && *colon != ':')
2072 colon++;
2073 while (*dot != '\0' && *dot != '.')
2074 dot++;
2075 /* Few sanity checks */
2076 if (*dot != '\0' && dot > colon) {
2b455db6 2077 PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
1da177e4
LT
2078 return -EINVAL;
2079 }
2080
2081 if (*colon == '\0') {
2082 /* No colon */
2083 if (*dot != '\0') {
2b455db6 2084 PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
1da177e4
LT
2085 return -EINVAL;
2086 }
2087 else {
2088 /* No type or serial number specified, just a number. */
2089 device_hint[i].device_node = pwc_atoi(s);
2090 }
2091 }
2092 else {
2093 /* There's a colon, so we have at least a type and a device node */
2094 device_hint[i].type = pwc_atoi(s);
2095 device_hint[i].device_node = pwc_atoi(colon + 1);
2096 if (*dot != '\0') {
2097 /* There's a serial number as well */
2098 int k;
d56410e0 2099
1da177e4
LT
2100 dot++;
2101 k = 0;
2102 while (*dot != ':' && k < 29) {
2103 device_hint[i].serial_number[k++] = *dot;
2104 dot++;
2105 }
2106 device_hint[i].serial_number[k] = '\0';
2107 }
2108 }
2b455db6
LS
2109 PWC_TRACE("device_hint[%d]:\n", i);
2110 PWC_TRACE(" type : %d\n", device_hint[i].type);
2111 PWC_TRACE(" serial# : %s\n", device_hint[i].serial_number);
2112 PWC_TRACE(" node : %d\n", device_hint[i].device_node);
1da177e4
LT
2113 }
2114 else
2115 device_hint[i].type = 0; /* not filled */
2116 } /* ..for MAX_DEV_HINTS */
2117
2b455db6 2118 PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
1da177e4
LT
2119 return usb_register(&pwc_driver);
2120}
2121
2122static void __exit usb_pwc_exit(void)
2123{
2b455db6 2124 PWC_DEBUG_MODULE("Deregistering driver.\n");
1da177e4 2125 usb_deregister(&pwc_driver);
2b455db6 2126 PWC_INFO("Philips webcam module removed.\n");
1da177e4
LT
2127}
2128
2129module_init(usb_pwc_init);
2130module_exit(usb_pwc_exit);
2131
2b455db6 2132/* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */
This page took 0.867234 seconds and 5 git commands to generate.