Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/avi/kvm
[linux-2.6] / drivers / media / video / pwc / pwc-if.c
1 /* Linux driver for Philips webcam
2    USB and Video4Linux interface part.
3    (C) 1999-2004 Nemosoft Unv.
4    (C) 2004-2006 Luc Saillard (luc@saillard.org)
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
28 /*
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
32    is thus not distributed in source form. The binary pwcx.o module
33    contains the code that falls under the NDA.
34
35    In case you're wondering: 'pwc' stands for "Philips WebCam", but
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).
39
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
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>
65 #include <linux/version.h>
66 #include <asm/io.h>
67
68 #include "pwc.h"
69 #include "pwc-kiara.h"
70 #include "pwc-timon.h"
71 #include "pwc-dec23.h"
72 #include "pwc-dec1.h"
73 #include "pwc-uncompress.h"
74
75 /* Function prototypes and driver templates */
76
77 /* hotplug device table support */
78 static const struct usb_device_id pwc_device_table [] = {
79         { 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) },
86         { USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
87         { USB_DEVICE(0x0471, 0x0312) },
88         { USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
89         { USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
90         { 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 */
97         { USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
98         { USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
99         { USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
100         { 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) */
103         { 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 };
111 MODULE_DEVICE_TABLE(usb, pwc_device_table);
112
113 static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
114 static void usb_pwc_disconnect(struct usb_interface *intf);
115
116 static struct usb_driver pwc_driver = {
117         .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
126 static int default_size = PSZ_QCIF;
127 static int default_fps = 10;
128 static int default_fbufs = 3;   /* Default number of frame buffers */
129         int pwc_mbufs = 2;      /* Default number of mmap() buffers */
130 #ifdef CONFIG_USB_PWC_DEBUG
131         int pwc_trace = PWC_DEBUG_LEVEL;
132 #endif
133 static int power_save = 0;
134 static int led_on = 100, led_off = 0; /* defaults to LED that is on while in use */
135 static int pwc_preferred_compression = 1; /* 0..3 = uncompressed..high */
136 static 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
145 static int pwc_video_open(struct inode *inode, struct file *file);
146 static int pwc_video_close(struct inode *inode, struct file *file);
147 static ssize_t pwc_video_read(struct file *file, char __user *buf,
148                           size_t count, loff_t *ppos);
149 static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
150 static int  pwc_video_ioctl(struct inode *inode, struct file *file,
151                             unsigned int ioctlnr, unsigned long arg);
152 static int  pwc_video_mmap(struct file *file, struct vm_area_struct *vma);
153
154 static const struct file_operations pwc_fops = {
155         .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,
162         .compat_ioctl = v4l_compat_ioctl32,
163         .llseek =       no_llseek,
164 };
165 static struct video_device pwc_template = {
166         .owner =        THIS_MODULE,
167         .name =         "Philips Webcam",       /* Filled in later */
168         .type =         VID_TYPE_CAPTURE,
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
178    The biggest problem with any USB device is of course: "what to do
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.
185
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
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
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.
198
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
201    it's non-trivial to re-link the cam back to the video device... (that
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  */
211
212
213
214 static void *pwc_rvmalloc(unsigned long size)
215 {
216         void * mem;
217         unsigned long adr;
218
219         mem=vmalloc_32(size);
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          }
231         return mem;
232 }
233
234 static void pwc_rvfree(void * mem, unsigned long size)
235 {
236         unsigned long adr;
237
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);
249 }
250
251
252
253
254 static int pwc_allocate_buffers(struct pwc_device *pdev)
255 {
256         int i, err;
257         void *kbuf;
258
259         PWC_DEBUG_MEMORY(">> pwc_allocate_buffers(pdev = 0x%p)\n", pdev);
260
261         if (pdev == NULL)
262                 return -ENXIO;
263
264         /* Allocate Isochronuous pipe buffers */
265         for (i = 0; i < MAX_ISO_BUFS; i++) {
266                 if (pdev->sbuf[i].data == NULL) {
267                         kbuf = kzalloc(ISO_BUFFER_SIZE, GFP_KERNEL);
268                         if (kbuf == NULL) {
269                                 PWC_ERROR("Failed to allocate iso buffer %d.\n", i);
270                                 return -ENOMEM;
271                         }
272                         PWC_DEBUG_MEMORY("Allocated iso buffer at %p.\n", kbuf);
273                         pdev->sbuf[i].data = kbuf;
274                 }
275         }
276
277         /* Allocate frame buffer structure */
278         if (pdev->fbuf == NULL) {
279                 kbuf = kzalloc(default_fbufs * sizeof(struct pwc_frame_buf), GFP_KERNEL);
280                 if (kbuf == NULL) {
281                         PWC_ERROR("Failed to allocate frame buffer structure.\n");
282                         return -ENOMEM;
283                 }
284                 PWC_DEBUG_MEMORY("Allocated frame buffer structure at %p.\n", kbuf);
285                 pdev->fbuf = kbuf;
286         }
287
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) {
293                                 PWC_ERROR("Failed to allocate frame buffer %d.\n", i);
294                                 return -ENOMEM;
295                         }
296                         PWC_DEBUG_MEMORY("Allocated frame buffer %d at %p.\n", i, kbuf);
297                         pdev->fbuf[i].data = kbuf;
298                         memset(kbuf, 0, PWC_FRAME_SIZE);
299                 }
300         }
301
302         /* Allocate decompressor table space */
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         }
312
313         /* Allocate image buffer; double buffer for mmap() */
314         kbuf = pwc_rvmalloc(pwc_mbufs * pdev->len_per_image);
315         if (kbuf == NULL) {
316                 PWC_ERROR("Failed to allocate image buffer(s). needed (%d)\n",
317                                 pwc_mbufs * pdev->len_per_image);
318                 return -ENOMEM;
319         }
320         PWC_DEBUG_MEMORY("Allocated image buffer at %p.\n", kbuf);
321         pdev->image_data = kbuf;
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         }
329
330         kbuf = NULL;
331
332         PWC_DEBUG_MEMORY("<< pwc_allocate_buffers()\n");
333         return 0;
334 }
335
336 static void pwc_free_buffers(struct pwc_device *pdev)
337 {
338         int i;
339
340         PWC_DEBUG_MEMORY("Entering free_buffers(%p).\n", pdev);
341
342         if (pdev == NULL)
343                 return;
344         /* Release Iso-pipe buffers */
345         for (i = 0; i < MAX_ISO_BUFS; i++)
346                 if (pdev->sbuf[i].data != NULL) {
347                         PWC_DEBUG_MEMORY("Freeing ISO buffer at %p.\n", pdev->sbuf[i].data);
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) {
356                                 PWC_DEBUG_MEMORY("Freeing frame buffer %d at %p.\n", i, pdev->fbuf[i].data);
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) {
367                 PWC_DEBUG_MEMORY("Freeing decompression buffer at %p.\n", pdev->decompress_data);
368                 kfree(pdev->decompress_data);
369                 pdev->decompress_data = NULL;
370         }
371
372         /* Release image buffers */
373         if (pdev->image_data != NULL) {
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);
376         }
377         pdev->image_data = NULL;
378
379         PWC_DEBUG_MEMORY("Leaving free_buffers().\n");
380 }
381
382 /* The frame & image buffer mess.
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
388    interesting. Suffices to say the data from this buffer is quickly
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.
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
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  */
439 static int pwc_next_fill_frame(struct pwc_device *pdev)
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 */
464                 /* sanity check */
465                 if (pdev->full_frames == NULL) {
466                         PWC_ERROR("Neither empty or full frames available!\n");
467                         spin_unlock_irqrestore(&pdev->ptrlock, flags);
468                         return -EINVAL;
469                 }
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;
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  */
485 static void pwc_reset_buffers(struct pwc_device *pdev)
486 {
487         int i;
488         unsigned long flags;
489
490         PWC_DEBUG_MEMORY(">> %s __enter__\n", __FUNCTION__);
491
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);
511
512         PWC_DEBUG_MEMORY("<< %s __leaving__\n", __FUNCTION__);
513 }
514
515
516 /**
517   \brief Do all the handling for getting one frame: get pointer, decompress, advance pointers.
518  */
519 int pwc_handle_frame(struct pwc_device *pdev)
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 */
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");
537         }
538         else {
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) {
545                 /* Decompression is a lenghty process, so it's outside of the lock.
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;
557                 }
558                 else {
559                         pdev->empty_frames_tail->next = pdev->read_frame;
560                         pdev->empty_frames_tail = pdev->read_frame;
561                 }
562                 pdev->read_frame = NULL;
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 */
571 void pwc_next_image(struct pwc_device *pdev)
572 {
573         pdev->image_used[pdev->fill_image] = 0;
574         pdev->fill_image = (pdev->fill_image + 1) % pwc_mbufs;
575 }
576
577 /**
578  * Print debug information when a frame is discarded because all of our buffer
579  * is full
580  */
581 static 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
594 static int pwc_rcv_short_packet(struct pwc_device *pdev, const struct pwc_frame_buf *fbuf)
595 {
596         int awake = 0;
597
598         /* The ToUCam Fun CMOS sensor causes the firmware to send 2 or 3 bogus
599            frames on the USB wire after an exposure change. This conditition is
600            however detected  in the cam and a bit is set in the header.
601            */
602         if (pdev->type == 730) {
603                 unsigned char *ptr = (unsigned char *)fbuf->data;
604
605                 if (ptr[1] == 1 && ptr[0] & 0x10) {
606                         PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
607                         pdev->drop_frames += 2;
608                         pdev->vframes_error++;
609                 }
610                 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
611                         if (ptr[0] & 0x01) {
612                                 pdev->snapshot_button_status = 1;
613                                 PWC_TRACE("Snapshot button pressed.\n");
614                         }
615                         else {
616                                 PWC_TRACE("Snapshot button released.\n");
617                         }
618                 }
619                 if ((ptr[0] ^ pdev->vmirror) & 0x02) {
620                         if (ptr[0] & 0x02)
621                                 PWC_TRACE("Image is mirrored.\n");
622                         else
623                                 PWC_TRACE("Image is normal.\n");
624                 }
625                 pdev->vmirror = ptr[0] & 0x03;
626                 /* Sometimes the trailer of the 730 is still sent as a 4 byte packet
627                    after a short frame; this condition is filtered out specifically. A 4 byte
628                    frame doesn't make sense anyway.
629                    So we get either this sequence:
630                    drop_bit set -> 4 byte frame -> short frame -> good frame
631                    Or this one:
632                    drop_bit set -> short frame -> good frame
633                    So we drop either 3 or 2 frames in all!
634                    */
635                 if (fbuf->filled == 4)
636                         pdev->drop_frames++;
637         }
638         else if (pdev->type == 740 || pdev->type == 720) {
639                 unsigned char *ptr = (unsigned char *)fbuf->data;
640                 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
641                         if (ptr[0] & 0x01) {
642                                 pdev->snapshot_button_status = 1;
643                                 PWC_TRACE("Snapshot button pressed.\n");
644                         }
645                         else
646                                 PWC_TRACE("Snapshot button released.\n");
647                 }
648                 pdev->vmirror = ptr[0] & 0x03;
649         }
650
651         /* In case we were instructed to drop the frame, do so silently.
652            The buffer pointers are not updated either (but the counters are reset below).
653            */
654         if (pdev->drop_frames > 0)
655                 pdev->drop_frames--;
656         else {
657                 /* Check for underflow first */
658                 if (fbuf->filled < pdev->frame_total_size) {
659                         PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
660                                        " discarded.\n", fbuf->filled);
661                         pdev->vframes_error++;
662                 }
663                 else {
664                         /* Send only once per EOF */
665                         awake = 1; /* delay wake_ups */
666
667                         /* Find our next frame to fill. This will always succeed, since we
668                          * nick a frame from either empty or full list, but if we had to
669                          * take it from the full list, it means a frame got dropped.
670                          */
671                         if (pwc_next_fill_frame(pdev))
672                                 pwc_frame_dumped(pdev);
673
674                 }
675         } /* !drop_frames */
676         pdev->vframe_count++;
677         return awake;
678 }
679
680 /* This gets called for the Isochronous pipe (video). This is done in
681  * interrupt time, so it has to be fast, not crash, and not stall. Neat.
682  */
683 static void pwc_isoc_handler(struct urb *urb)
684 {
685         struct pwc_device *pdev;
686         int i, fst, flen;
687         int awake;
688         struct pwc_frame_buf *fbuf;
689         unsigned char *fillptr = NULL, *iso_buf = NULL;
690
691         awake = 0;
692         pdev = (struct pwc_device *)urb->context;
693         if (pdev == NULL) {
694                 PWC_ERROR("isoc_handler() called with NULL device?!\n");
695                 return;
696         }
697
698         if (urb->status == -ENOENT || urb->status == -ECONNRESET) {
699                 PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
700                 return;
701         }
702         if (urb->status != -EINPROGRESS && urb->status != 0) {
703                 const char *errmsg;
704
705                 errmsg = "Unknown";
706                 switch(urb->status) {
707                         case -ENOSR:            errmsg = "Buffer error (overrun)"; break;
708                         case -EPIPE:            errmsg = "Stalled (device not responding)"; break;
709                         case -EOVERFLOW:        errmsg = "Babble (bad cable?)"; break;
710                         case -EPROTO:           errmsg = "Bit-stuff error (bad cable?)"; break;
711                         case -EILSEQ:           errmsg = "CRC/Timeout (could be anything)"; break;
712                         case -ETIME:            errmsg = "Device does not respond"; break;
713                 }
714                 PWC_DEBUG_FLOW("pwc_isoc_handler() called with status %d [%s].\n", urb->status, errmsg);
715                 /* Give up after a number of contiguous errors on the USB bus.
716                    Appearantly something is wrong so we simulate an unplug event.
717                  */
718                 if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
719                 {
720                         PWC_INFO("Too many ISOC errors, bailing out.\n");
721                         pdev->error_status = EIO;
722                         awake = 1;
723                         wake_up_interruptible(&pdev->frameq);
724                 }
725                 goto handler_end; // ugly, but practical
726         }
727
728         fbuf = pdev->fill_frame;
729         if (fbuf == NULL) {
730                 PWC_ERROR("pwc_isoc_handler without valid fill frame.\n");
731                 awake = 1;
732                 goto handler_end;
733         }
734         else {
735                 fillptr = fbuf->data + fbuf->filled;
736         }
737
738         /* Reset ISOC error counter. We did get here, after all. */
739         pdev->visoc_errors = 0;
740
741         /* vsync: 0 = don't copy data
742                   1 = sync-hunt
743                   2 = synched
744          */
745         /* Compact data */
746         for (i = 0; i < urb->number_of_packets; i++) {
747                 fst  = urb->iso_frame_desc[i].status;
748                 flen = urb->iso_frame_desc[i].actual_length;
749                 iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
750                 if (fst == 0) {
751                         if (flen > 0) { /* if valid data... */
752                                 if (pdev->vsync > 0) { /* ...and we are not sync-hunting... */
753                                         pdev->vsync = 2;
754
755                                         /* ...copy data to frame buffer, if possible */
756                                         if (flen + fbuf->filled > pdev->frame_total_size) {
757                                                 PWC_DEBUG_FLOW("Frame buffer overflow (flen = %d, frame_total_size = %d).\n", flen, pdev->frame_total_size);
758                                                 pdev->vsync = 0; /* Hmm, let's wait for an EOF (end-of-frame) */
759                                                 pdev->vframes_error++;
760                                         }
761                                         else {
762                                                 memmove(fillptr, iso_buf, flen);
763                                                 fillptr += flen;
764                                         }
765                                 }
766                                 fbuf->filled += flen;
767                         } /* ..flen > 0 */
768
769                         if (flen < pdev->vlast_packet_size) {
770                                 /* Shorter packet... We probably have the end of an image-frame;
771                                    wake up read() process and let select()/poll() do something.
772                                    Decompression is done in user time over there.
773                                    */
774                                 if (pdev->vsync == 2) {
775                                         if (pwc_rcv_short_packet(pdev, fbuf)) {
776                                                 awake = 1;
777                                                 fbuf = pdev->fill_frame;
778                                         }
779                                 }
780                                 fbuf->filled = 0;
781                                 fillptr = fbuf->data;
782                                 pdev->vsync = 1;
783                         }
784
785                         pdev->vlast_packet_size = flen;
786                 } /* ..status == 0 */
787                 else {
788                         /* This is normally not interesting to the user, unless
789                          * you are really debugging something */
790                         static int iso_error = 0;
791                         iso_error++;
792                         if (iso_error < 20)
793                                 PWC_DEBUG_FLOW("Iso frame %d of USB has error %d\n", i, fst);
794                 }
795         }
796
797 handler_end:
798         if (awake)
799                 wake_up_interruptible(&pdev->frameq);
800
801         urb->dev = pdev->udev;
802         i = usb_submit_urb(urb, GFP_ATOMIC);
803         if (i != 0)
804                 PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
805 }
806
807
808 int pwc_isoc_init(struct pwc_device *pdev)
809 {
810         struct usb_device *udev;
811         struct urb *urb;
812         int i, j, ret;
813
814         struct usb_interface *intf;
815         struct usb_host_interface *idesc = NULL;
816
817         if (pdev == NULL)
818                 return -EFAULT;
819         if (pdev->iso_init)
820                 return 0;
821         pdev->vsync = 0;
822         udev = pdev->udev;
823
824         /* Get the current alternate interface, adjust packet size */
825         if (!udev->actconfig)
826                 return -EFAULT;
827         intf = usb_ifnum_to_if(udev, 0);
828         if (intf)
829                 idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
830
831         if (!idesc)
832                 return -EFAULT;
833
834         /* Search video endpoint */
835         pdev->vmax_packet_size = -1;
836         for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
837                 if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
838                         pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
839                         break;
840                 }
841         }
842
843         if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
844                 PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
845                 return -ENFILE; /* Odd error, that should be noticeable */
846         }
847
848         /* Set alternate interface */
849         ret = 0;
850         PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
851         ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
852         if (ret < 0)
853                 return ret;
854
855         for (i = 0; i < MAX_ISO_BUFS; i++) {
856                 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
857                 if (urb == NULL) {
858                         PWC_ERROR("Failed to allocate urb %d\n", i);
859                         ret = -ENOMEM;
860                         break;
861                 }
862                 pdev->sbuf[i].urb = urb;
863                 PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
864         }
865         if (ret) {
866                 /* De-allocate in reverse order */
867                 while (i--) {
868                         usb_free_urb(pdev->sbuf[i].urb);
869                         pdev->sbuf[i].urb = NULL;
870                 }
871                 return ret;
872         }
873
874         /* init URB structure */
875         for (i = 0; i < MAX_ISO_BUFS; i++) {
876                 urb = pdev->sbuf[i].urb;
877
878                 urb->interval = 1; // devik
879                 urb->dev = udev;
880                 urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
881                 urb->transfer_flags = URB_ISO_ASAP;
882                 urb->transfer_buffer = pdev->sbuf[i].data;
883                 urb->transfer_buffer_length = ISO_BUFFER_SIZE;
884                 urb->complete = pwc_isoc_handler;
885                 urb->context = pdev;
886                 urb->start_frame = 0;
887                 urb->number_of_packets = ISO_FRAMES_PER_DESC;
888                 for (j = 0; j < ISO_FRAMES_PER_DESC; j++) {
889                         urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE;
890                         urb->iso_frame_desc[j].length = pdev->vmax_packet_size;
891                 }
892         }
893
894         /* link */
895         for (i = 0; i < MAX_ISO_BUFS; i++) {
896                 ret = usb_submit_urb(pdev->sbuf[i].urb, GFP_KERNEL);
897                 if (ret)
898                         PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
899                 else
900                         PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->sbuf[i].urb);
901         }
902
903         /* All is done... */
904         pdev->iso_init = 1;
905         PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
906         return 0;
907 }
908
909 static void pwc_iso_stop(struct pwc_device *pdev)
910 {
911         int i;
912
913         /* Unlinking ISOC buffers one by one */
914         for (i = 0; i < MAX_ISO_BUFS; i++) {
915                 struct urb *urb;
916
917                 urb = pdev->sbuf[i].urb;
918                 if (urb != 0) {
919                         PWC_DEBUG_MEMORY("Unlinking URB %p\n", urb);
920                         usb_kill_urb(urb);
921                 }
922         }
923 }
924
925 static void pwc_iso_free(struct pwc_device *pdev)
926 {
927         int i;
928
929         /* Freeing ISOC buffers one by one */
930         for (i = 0; i < MAX_ISO_BUFS; i++) {
931                 struct urb *urb;
932
933                 urb = pdev->sbuf[i].urb;
934                 if (urb != 0) {
935                         PWC_DEBUG_MEMORY("Freeing URB\n");
936                         usb_free_urb(urb);
937                         pdev->sbuf[i].urb = NULL;
938                 }
939         }
940 }
941
942 void pwc_isoc_cleanup(struct pwc_device *pdev)
943 {
944         PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
945         if (pdev == NULL)
946                 return;
947         if (pdev->iso_init == 0)
948                 return;
949
950         pwc_iso_stop(pdev);
951         pwc_iso_free(pdev);
952
953         /* Stop camera, but only if we are sure the camera is still there (unplug
954            is signalled by EPIPE)
955          */
956         if (pdev->error_status && pdev->error_status != EPIPE) {
957                 PWC_DEBUG_OPEN("Setting alternate interface 0.\n");
958                 usb_set_interface(pdev->udev, 0, 0);
959         }
960
961         pdev->iso_init = 0;
962         PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
963 }
964
965 int pwc_try_video_mode(struct pwc_device *pdev, int width, int height, int new_fps, int new_compression, int new_snapshot)
966 {
967         int ret, start;
968
969         /* Stop isoc stuff */
970         pwc_isoc_cleanup(pdev);
971         /* Reset parameters */
972         pwc_reset_buffers(pdev);
973         /* Try to set video mode... */
974         start = ret = pwc_set_video_mode(pdev, width, height, new_fps, new_compression, new_snapshot);
975         if (ret) {
976                 PWC_DEBUG_FLOW("pwc_set_video_mode attempt 1 failed.\n");
977                 /* That failed... restore old mode (we know that worked) */
978                 start = pwc_set_video_mode(pdev, pdev->view.x, pdev->view.y, pdev->vframes, pdev->vcompression, pdev->vsnapshot);
979                 if (start) {
980                         PWC_DEBUG_FLOW("pwc_set_video_mode attempt 2 failed.\n");
981                 }
982         }
983         if (start == 0)
984         {
985                 if (pwc_isoc_init(pdev) < 0)
986                 {
987                         PWC_WARNING("Failed to restart ISOC transfers in pwc_try_video_mode.\n");
988                         ret = -EAGAIN; /* let's try again, who knows if it works a second time */
989                 }
990         }
991         pdev->drop_frames++; /* try to avoid garbage during switch */
992         return ret; /* Return original error code */
993 }
994
995 /*********
996  * sysfs
997  *********/
998 static struct pwc_device *cd_to_pwc(struct device *cd)
999 {
1000         struct video_device *vdev = to_video_device(cd);
1001         return video_get_drvdata(vdev);
1002 }
1003
1004 static ssize_t show_pan_tilt(struct device *class_dev,
1005                              struct device_attribute *attr, char *buf)
1006 {
1007         struct pwc_device *pdev = cd_to_pwc(class_dev);
1008         return sprintf(buf, "%d %d\n", pdev->pan_angle, pdev->tilt_angle);
1009 }
1010
1011 static ssize_t store_pan_tilt(struct device *class_dev,
1012                               struct device_attribute *attr,
1013                               const char *buf, size_t count)
1014 {
1015         struct pwc_device *pdev = cd_to_pwc(class_dev);
1016         int pan, tilt;
1017         int ret = -EINVAL;
1018
1019         if (strncmp(buf, "reset", 5) == 0)
1020                 ret = pwc_mpt_reset(pdev, 0x3);
1021
1022         else if (sscanf(buf, "%d %d", &pan, &tilt) > 0)
1023                 ret = pwc_mpt_set_angle(pdev, pan, tilt);
1024
1025         if (ret < 0)
1026                 return ret;
1027         return strlen(buf);
1028 }
1029 static DEVICE_ATTR(pan_tilt, S_IRUGO | S_IWUSR, show_pan_tilt,
1030                    store_pan_tilt);
1031
1032 static ssize_t show_snapshot_button_status(struct device *class_dev,
1033                                            struct device_attribute *attr, char *buf)
1034 {
1035         struct pwc_device *pdev = cd_to_pwc(class_dev);
1036         int status = pdev->snapshot_button_status;
1037         pdev->snapshot_button_status = 0;
1038         return sprintf(buf, "%d\n", status);
1039 }
1040
1041 static DEVICE_ATTR(button, S_IRUGO | S_IWUSR, show_snapshot_button_status,
1042                    NULL);
1043
1044 static int pwc_create_sysfs_files(struct video_device *vdev)
1045 {
1046         struct pwc_device *pdev = video_get_drvdata(vdev);
1047         int rc;
1048
1049         rc = video_device_create_file(vdev, &dev_attr_button);
1050         if (rc)
1051                 goto err;
1052         if (pdev->features & FEATURE_MOTOR_PANTILT) {
1053                 rc = video_device_create_file(vdev, &dev_attr_pan_tilt);
1054                 if (rc) goto err_button;
1055         }
1056
1057         return 0;
1058
1059 err_button:
1060         video_device_remove_file(vdev, &dev_attr_button);
1061 err:
1062         return rc;
1063 }
1064
1065 static void pwc_remove_sysfs_files(struct video_device *vdev)
1066 {
1067         struct pwc_device *pdev = video_get_drvdata(vdev);
1068         if (pdev->features & FEATURE_MOTOR_PANTILT)
1069                 video_device_remove_file(vdev, &dev_attr_pan_tilt);
1070         video_device_remove_file(vdev, &dev_attr_button);
1071 }
1072
1073 #ifdef CONFIG_USB_PWC_DEBUG
1074 static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
1075 {
1076         switch(sensor_type) {
1077                 case 0x00:
1078                         return "Hyundai CMOS sensor";
1079                 case 0x20:
1080                         return "Sony CCD sensor + TDA8787";
1081                 case 0x2E:
1082                         return "Sony CCD sensor + Exas 98L59";
1083                 case 0x2F:
1084                         return "Sony CCD sensor + ADI 9804";
1085                 case 0x30:
1086                         return "Sharp CCD sensor + TDA8787";
1087                 case 0x3E:
1088                         return "Sharp CCD sensor + Exas 98L59";
1089                 case 0x3F:
1090                         return "Sharp CCD sensor + ADI 9804";
1091                 case 0x40:
1092                         return "UPA 1021 sensor";
1093                 case 0x100:
1094                         return "VGA sensor";
1095                 case 0x101:
1096                         return "PAL MR sensor";
1097                 default:
1098                         return "unknown type of sensor";
1099         }
1100 }
1101 #endif
1102
1103 /***************************************************************************/
1104 /* Video4Linux functions */
1105
1106 static int pwc_video_open(struct inode *inode, struct file *file)
1107 {
1108         int i, ret;
1109         struct video_device *vdev = video_devdata(file);
1110         struct pwc_device *pdev;
1111
1112         PWC_DEBUG_OPEN(">> video_open called(vdev = 0x%p).\n", vdev);
1113
1114         pdev = (struct pwc_device *)vdev->priv;
1115         BUG_ON(!pdev);
1116         if (pdev->vopen) {
1117                 PWC_DEBUG_OPEN("I'm busy, someone is using the device.\n");
1118                 return -EBUSY;
1119         }
1120
1121         mutex_lock(&pdev->modlock);
1122         if (!pdev->usb_init) {
1123                 PWC_DEBUG_OPEN("Doing first time initialization.\n");
1124                 pdev->usb_init = 1;
1125
1126                 /* Query sensor type */
1127                 ret = pwc_get_cmos_sensor(pdev, &i);
1128                 if (ret >= 0)
1129                 {
1130                         PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
1131                                         pdev->vdev->name,
1132                                         pwc_sensor_type_to_string(i), i);
1133                 }
1134         }
1135
1136         /* Turn on camera */
1137         if (power_save) {
1138                 i = pwc_camera_power(pdev, 1);
1139                 if (i < 0)
1140                         PWC_DEBUG_OPEN("Failed to restore power to the camera! (%d)\n", i);
1141         }
1142         /* Set LED on/off time */
1143         if (pwc_set_leds(pdev, led_on, led_off) < 0)
1144                 PWC_DEBUG_OPEN("Failed to set LED on/off time.\n");
1145
1146         pwc_construct(pdev); /* set min/max sizes correct */
1147
1148         /* So far, so good. Allocate memory. */
1149         i = pwc_allocate_buffers(pdev);
1150         if (i < 0) {
1151                 PWC_DEBUG_OPEN("Failed to allocate buffers memory.\n");
1152                 pwc_free_buffers(pdev);
1153                 mutex_unlock(&pdev->modlock);
1154                 return i;
1155         }
1156
1157         /* Reset buffers & parameters */
1158         pwc_reset_buffers(pdev);
1159         for (i = 0; i < pwc_mbufs; i++)
1160                 pdev->image_used[i] = 0;
1161         pdev->vframe_count = 0;
1162         pdev->vframes_dumped = 0;
1163         pdev->vframes_error = 0;
1164         pdev->visoc_errors = 0;
1165         pdev->error_status = 0;
1166         pwc_construct(pdev); /* set min/max sizes correct */
1167
1168         /* Set some defaults */
1169         pdev->vsnapshot = 0;
1170
1171         /* Start iso pipe for video; first try the last used video size
1172            (or the default one); if that fails try QCIF/10 or QSIF/10;
1173            it that fails too, give up.
1174          */
1175         i = pwc_set_video_mode(pdev, pwc_image_sizes[pdev->vsize].x, pwc_image_sizes[pdev->vsize].y, pdev->vframes, pdev->vcompression, 0);
1176         if (i)  {
1177                 unsigned int default_resolution;
1178                 PWC_DEBUG_OPEN("First attempt at set_video_mode failed.\n");
1179                 if (pdev->type>= 730)
1180                         default_resolution = PSZ_QSIF;
1181                 else
1182                         default_resolution = PSZ_QCIF;
1183
1184                 i = pwc_set_video_mode(pdev,
1185                                        pwc_image_sizes[default_resolution].x,
1186                                        pwc_image_sizes[default_resolution].y,
1187                                        10,
1188                                        pdev->vcompression,
1189                                        0);
1190         }
1191         if (i) {
1192                 PWC_DEBUG_OPEN("Second attempt at set_video_mode failed.\n");
1193                 pwc_free_buffers(pdev);
1194                 mutex_unlock(&pdev->modlock);
1195                 return i;
1196         }
1197
1198         i = pwc_isoc_init(pdev);
1199         if (i) {
1200                 PWC_DEBUG_OPEN("Failed to init ISOC stuff = %d.\n", i);
1201                 pwc_isoc_cleanup(pdev);
1202                 pwc_free_buffers(pdev);
1203                 mutex_unlock(&pdev->modlock);
1204                 return i;
1205         }
1206
1207         /* Initialize the webcam to sane value */
1208         pwc_set_brightness(pdev, 0x7fff);
1209         pwc_set_agc(pdev, 1, 0);
1210
1211         pdev->vopen++;
1212         file->private_data = vdev;
1213         mutex_unlock(&pdev->modlock);
1214         PWC_DEBUG_OPEN("<< video_open() returns 0.\n");
1215         return 0;
1216 }
1217
1218
1219 static void pwc_cleanup(struct pwc_device *pdev)
1220 {
1221         pwc_remove_sysfs_files(pdev->vdev);
1222         video_unregister_device(pdev->vdev);
1223 }
1224
1225 /* Note that all cleanup is done in the reverse order as in _open */
1226 static int pwc_video_close(struct inode *inode, struct file *file)
1227 {
1228         struct video_device *vdev = file->private_data;
1229         struct pwc_device *pdev;
1230         int i, hint;
1231
1232         PWC_DEBUG_OPEN(">> video_close called(vdev = 0x%p).\n", vdev);
1233
1234         lock_kernel();
1235         pdev = (struct pwc_device *)vdev->priv;
1236         if (pdev->vopen == 0)
1237                 PWC_DEBUG_MODULE("video_close() called on closed device?\n");
1238
1239         /* Dump statistics, but only if a reasonable amount of frames were
1240            processed (to prevent endless log-entries in case of snap-shot
1241            programs)
1242          */
1243         if (pdev->vframe_count > 20)
1244                 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);
1245
1246         if (DEVICE_USE_CODEC1(pdev->type))
1247             pwc_dec1_exit();
1248         else
1249             pwc_dec23_exit();
1250
1251         pwc_isoc_cleanup(pdev);
1252         pwc_free_buffers(pdev);
1253
1254         /* Turn off LEDS and power down camera, but only when not unplugged */
1255         if (!pdev->unplugged) {
1256                 /* Turn LEDs off */
1257                 if (pwc_set_leds(pdev, 0, 0) < 0)
1258                         PWC_DEBUG_MODULE("Failed to set LED on/off time.\n");
1259                 if (power_save) {
1260                         i = pwc_camera_power(pdev, 0);
1261                         if (i < 0)
1262                                 PWC_ERROR("Failed to power down camera (%d)\n", i);
1263                 }
1264                 pdev->vopen--;
1265                 PWC_DEBUG_OPEN("<< video_close() vopen=%d\n", pdev->vopen);
1266         } else {
1267                 pwc_cleanup(pdev);
1268                 /* Free memory (don't set pdev to 0 just yet) */
1269                 kfree(pdev);
1270                 /* search device_hint[] table if we occupy a slot, by any chance */
1271                 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
1272                         if (device_hint[hint].pdev == pdev)
1273                                 device_hint[hint].pdev = NULL;
1274         }
1275         unlock_kernel();
1276
1277         return 0;
1278 }
1279
1280 /*
1281  *      FIXME: what about two parallel reads ????
1282  *      ANSWER: Not supported. You can't open the device more than once,
1283                 despite what the V4L1 interface says. First, I don't see
1284                 the need, second there's no mechanism of alerting the
1285                 2nd/3rd/... process of events like changing image size.
1286                 And I don't see the point of blocking that for the
1287                 2nd/3rd/... process.
1288                 In multi-threaded environments reading parallel from any
1289                 device is tricky anyhow.
1290  */
1291
1292 static ssize_t pwc_video_read(struct file *file, char __user *buf,
1293                           size_t count, loff_t *ppos)
1294 {
1295         struct video_device *vdev = file->private_data;
1296         struct pwc_device *pdev;
1297         int noblock = file->f_flags & O_NONBLOCK;
1298         DECLARE_WAITQUEUE(wait, current);
1299         int bytes_to_read, rv = 0;
1300         void *image_buffer_addr;
1301
1302         PWC_DEBUG_READ("pwc_video_read(vdev=0x%p, buf=%p, count=%zd) called.\n",
1303                         vdev, buf, count);
1304         if (vdev == NULL)
1305                 return -EFAULT;
1306         pdev = vdev->priv;
1307         if (pdev == NULL)
1308                 return -EFAULT;
1309
1310         mutex_lock(&pdev->modlock);
1311         if (pdev->error_status) {
1312                 rv = -pdev->error_status; /* Something happened, report what. */
1313                 goto err_out;
1314         }
1315
1316         /* In case we're doing partial reads, we don't have to wait for a frame */
1317         if (pdev->image_read_pos == 0) {
1318                 /* Do wait queueing according to the (doc)book */
1319                 add_wait_queue(&pdev->frameq, &wait);
1320                 while (pdev->full_frames == NULL) {
1321                         /* Check for unplugged/etc. here */
1322                         if (pdev->error_status) {
1323                                 remove_wait_queue(&pdev->frameq, &wait);
1324                                 set_current_state(TASK_RUNNING);
1325                                 rv = -pdev->error_status ;
1326                                 goto err_out;
1327                         }
1328                         if (noblock) {
1329                                 remove_wait_queue(&pdev->frameq, &wait);
1330                                 set_current_state(TASK_RUNNING);
1331                                 rv = -EWOULDBLOCK;
1332                                 goto err_out;
1333                         }
1334                         if (signal_pending(current)) {
1335                                 remove_wait_queue(&pdev->frameq, &wait);
1336                                 set_current_state(TASK_RUNNING);
1337                                 rv = -ERESTARTSYS;
1338                                 goto err_out;
1339                         }
1340                         schedule();
1341                         set_current_state(TASK_INTERRUPTIBLE);
1342                 }
1343                 remove_wait_queue(&pdev->frameq, &wait);
1344                 set_current_state(TASK_RUNNING);
1345
1346                 /* Decompress and release frame */
1347                 if (pwc_handle_frame(pdev)) {
1348                         rv = -EFAULT;
1349                         goto err_out;
1350                 }
1351         }
1352
1353         PWC_DEBUG_READ("Copying data to user space.\n");
1354         if (pdev->vpalette == VIDEO_PALETTE_RAW)
1355                 bytes_to_read = pdev->frame_size + sizeof(struct pwc_raw_frame);
1356         else
1357                 bytes_to_read = pdev->view.size;
1358
1359         /* copy bytes to user space; we allow for partial reads */
1360         if (count + pdev->image_read_pos > bytes_to_read)
1361                 count = bytes_to_read - pdev->image_read_pos;
1362         image_buffer_addr = pdev->image_data;
1363         image_buffer_addr += pdev->images[pdev->fill_image].offset;
1364         image_buffer_addr += pdev->image_read_pos;
1365         if (copy_to_user(buf, image_buffer_addr, count)) {
1366                 rv = -EFAULT;
1367                 goto err_out;
1368         }
1369         pdev->image_read_pos += count;
1370         if (pdev->image_read_pos >= bytes_to_read) { /* All data has been read */
1371                 pdev->image_read_pos = 0;
1372                 pwc_next_image(pdev);
1373         }
1374         mutex_unlock(&pdev->modlock);
1375         return count;
1376 err_out:
1377         mutex_unlock(&pdev->modlock);
1378         return rv;
1379 }
1380
1381 static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
1382 {
1383         struct video_device *vdev = file->private_data;
1384         struct pwc_device *pdev;
1385
1386         if (vdev == NULL)
1387                 return -EFAULT;
1388         pdev = vdev->priv;
1389         if (pdev == NULL)
1390                 return -EFAULT;
1391
1392         poll_wait(file, &pdev->frameq, wait);
1393         if (pdev->error_status)
1394                 return POLLERR;
1395         if (pdev->full_frames != NULL) /* we have frames waiting */
1396                 return (POLLIN | POLLRDNORM);
1397
1398         return 0;
1399 }
1400
1401 static int pwc_video_ioctl(struct inode *inode, struct file *file,
1402                            unsigned int cmd, unsigned long arg)
1403 {
1404         struct video_device *vdev = file->private_data;
1405         struct pwc_device *pdev;
1406         int r = -ENODEV;
1407
1408         if (!vdev)
1409                 goto out;
1410         pdev = vdev->priv;
1411
1412         mutex_lock(&pdev->modlock);
1413         if (!pdev->unplugged)
1414                 r = video_usercopy(inode, file, cmd, arg, pwc_video_do_ioctl);
1415         mutex_unlock(&pdev->modlock);
1416 out:
1417         return r;
1418 }
1419
1420 static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
1421 {
1422         struct video_device *vdev = file->private_data;
1423         struct pwc_device *pdev;
1424         unsigned long start;
1425         unsigned long size;
1426         unsigned long page, pos = 0;
1427         int index;
1428
1429         PWC_DEBUG_MEMORY(">> %s\n", __FUNCTION__);
1430         pdev = vdev->priv;
1431         size = vma->vm_end - vma->vm_start;
1432         start = vma->vm_start;
1433
1434         /* Find the idx buffer for this mapping */
1435         for (index = 0; index < pwc_mbufs; index++) {
1436                 pos = pdev->images[index].offset;
1437                 if ((pos>>PAGE_SHIFT) == vma->vm_pgoff)
1438                         break;
1439         }
1440         if (index == MAX_IMAGES)
1441                 return -EINVAL;
1442         if (index == 0) {
1443                 /*
1444                  * Special case for v4l1. In v4l1, we map only one big buffer,
1445                  * but in v4l2 each buffer is mapped
1446                  */
1447                 unsigned long total_size;
1448                 total_size = pwc_mbufs * pdev->len_per_image;
1449                 if (size != pdev->len_per_image && size != total_size) {
1450                         PWC_ERROR("Wrong size (%lu) needed to be len_per_image=%d or total_size=%lu\n",
1451                                    size, pdev->len_per_image, total_size);
1452                         return -EINVAL;
1453                 }
1454         } else if (size > pdev->len_per_image)
1455                 return -EINVAL;
1456
1457         vma->vm_flags |= VM_IO; /* from 2.6.9-acX */
1458
1459         pos += (unsigned long)pdev->image_data;
1460         while (size > 0) {
1461                 page = vmalloc_to_pfn((void *)pos);
1462                 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED))
1463                         return -EAGAIN;
1464                 start += PAGE_SIZE;
1465                 pos += PAGE_SIZE;
1466                 if (size > PAGE_SIZE)
1467                         size -= PAGE_SIZE;
1468                 else
1469                         size = 0;
1470         }
1471         return 0;
1472 }
1473
1474 /***************************************************************************/
1475 /* USB functions */
1476
1477 /* This function gets called when a new device is plugged in or the usb core
1478  * is loaded.
1479  */
1480
1481 static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
1482 {
1483         struct usb_device *udev = interface_to_usbdev(intf);
1484         struct pwc_device *pdev = NULL;
1485         int vendor_id, product_id, type_id;
1486         int i, hint, rc;
1487         int features = 0;
1488         int video_nr = -1; /* default: use next available device */
1489         char serial_number[30], *name;
1490
1491         vendor_id = le16_to_cpu(udev->descriptor.idVendor);
1492         product_id = le16_to_cpu(udev->descriptor.idProduct);
1493
1494         /* Check if we can handle this device */
1495         PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
1496                 vendor_id, product_id,
1497                 intf->altsetting->desc.bInterfaceNumber);
1498
1499         /* the interfaces are probed one by one. We are only interested in the
1500            video interface (0) now.
1501            Interface 1 is the Audio Control, and interface 2 Audio itself.
1502          */
1503         if (intf->altsetting->desc.bInterfaceNumber > 0)
1504                 return -ENODEV;
1505
1506         if (vendor_id == 0x0471) {
1507                 switch (product_id) {
1508                 case 0x0302:
1509                         PWC_INFO("Philips PCA645VC USB webcam detected.\n");
1510                         name = "Philips 645 webcam";
1511                         type_id = 645;
1512                         break;
1513                 case 0x0303:
1514                         PWC_INFO("Philips PCA646VC USB webcam detected.\n");
1515                         name = "Philips 646 webcam";
1516                         type_id = 646;
1517                         break;
1518                 case 0x0304:
1519                         PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
1520                         name = "Askey VC010 webcam";
1521                         type_id = 646;
1522                         break;
1523                 case 0x0307:
1524                         PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
1525                         name = "Philips 675 webcam";
1526                         type_id = 675;
1527                         break;
1528                 case 0x0308:
1529                         PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
1530                         name = "Philips 680 webcam";
1531                         type_id = 680;
1532                         break;
1533                 case 0x030C:
1534                         PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
1535                         name = "Philips 690 webcam";
1536                         type_id = 690;
1537                         break;
1538                 case 0x0310:
1539                         PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
1540                         name = "Philips 730 webcam";
1541                         type_id = 730;
1542                         break;
1543                 case 0x0311:
1544                         PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
1545                         name = "Philips 740 webcam";
1546                         type_id = 740;
1547                         break;
1548                 case 0x0312:
1549                         PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
1550                         name = "Philips 750 webcam";
1551                         type_id = 750;
1552                         break;
1553                 case 0x0313:
1554                         PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
1555                         name = "Philips 720K/40 webcam";
1556                         type_id = 720;
1557                         break;
1558                 case 0x0329:
1559                         PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
1560                         name = "Philips SPC 900NC webcam";
1561                         type_id = 740;
1562                         break;
1563                 default:
1564                         return -ENODEV;
1565                         break;
1566                 }
1567         }
1568         else if (vendor_id == 0x069A) {
1569                 switch(product_id) {
1570                 case 0x0001:
1571                         PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
1572                         name = "Askey VC010 webcam";
1573                         type_id = 645;
1574                         break;
1575                 default:
1576                         return -ENODEV;
1577                         break;
1578                 }
1579         }
1580         else if (vendor_id == 0x046d) {
1581                 switch(product_id) {
1582                 case 0x08b0:
1583                         PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
1584                         name = "Logitech QuickCam Pro 3000";
1585                         type_id = 740; /* CCD sensor */
1586                         break;
1587                 case 0x08b1:
1588                         PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
1589                         name = "Logitech QuickCam Notebook Pro";
1590                         type_id = 740; /* CCD sensor */
1591                         break;
1592                 case 0x08b2:
1593                         PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
1594                         name = "Logitech QuickCam Pro 4000";
1595                         type_id = 740; /* CCD sensor */
1596                         break;
1597                 case 0x08b3:
1598                         PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
1599                         name = "Logitech QuickCam Zoom";
1600                         type_id = 740; /* CCD sensor */
1601                         break;
1602                 case 0x08B4:
1603                         PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
1604                         name = "Logitech QuickCam Zoom";
1605                         type_id = 740; /* CCD sensor */
1606                         power_save = 1;
1607                         break;
1608                 case 0x08b5:
1609                         PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
1610                         name = "Logitech QuickCam Orbit";
1611                         type_id = 740; /* CCD sensor */
1612                         features |= FEATURE_MOTOR_PANTILT;
1613                         break;
1614                 case 0x08b6:
1615                         PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
1616                         name = "Cisco VT Camera";
1617                         type_id = 740; /* CCD sensor */
1618                         break;
1619                 case 0x08b7:
1620                         PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
1621                         name = "Logitech ViewPort AV 100";
1622                         type_id = 740; /* CCD sensor */
1623                         break;
1624                 case 0x08b8: /* Where this released? */
1625                         PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
1626                         name = "Logitech QuickCam (res.)";
1627                         type_id = 730; /* Assuming CMOS */
1628                         break;
1629                 default:
1630                         return -ENODEV;
1631                         break;
1632                 }
1633         }
1634         else if (vendor_id == 0x055d) {
1635                 /* I don't know the difference between the C10 and the C30;
1636                    I suppose the difference is the sensor, but both cameras
1637                    work equally well with a type_id of 675
1638                  */
1639                 switch(product_id) {
1640                 case 0x9000:
1641                         PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
1642                         name = "Samsung MPC-C10";
1643                         type_id = 675;
1644                         break;
1645                 case 0x9001:
1646                         PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
1647                         name = "Samsung MPC-C30";
1648                         type_id = 675;
1649                         break;
1650                 case 0x9002:
1651                         PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
1652                         name = "Samsung MPC-C30";
1653                         type_id = 740;
1654                         break;
1655                 default:
1656                         return -ENODEV;
1657                         break;
1658                 }
1659         }
1660         else if (vendor_id == 0x041e) {
1661                 switch(product_id) {
1662                 case 0x400c:
1663                         PWC_INFO("Creative Labs Webcam 5 detected.\n");
1664                         name = "Creative Labs Webcam 5";
1665                         type_id = 730;
1666                         break;
1667                 case 0x4011:
1668                         PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
1669                         name = "Creative Labs Webcam Pro Ex";
1670                         type_id = 740;
1671                         break;
1672                 default:
1673                         return -ENODEV;
1674                         break;
1675                 }
1676         }
1677         else if (vendor_id == 0x04cc) {
1678                 switch(product_id) {
1679                 case 0x8116:
1680                         PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
1681                         name = "Sotec Afina Eye";
1682                         type_id = 730;
1683                         break;
1684                 default:
1685                         return -ENODEV;
1686                         break;
1687                 }
1688         }
1689         else if (vendor_id == 0x06be) {
1690                 switch(product_id) {
1691                 case 0x8116:
1692                         /* This is essentially the same cam as the Sotec Afina Eye */
1693                         PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
1694                         name = "AME Co. Afina Eye";
1695                         type_id = 750;
1696                         break;
1697                 default:
1698                         return -ENODEV;
1699                         break;
1700                 }
1701
1702         }
1703         else if (vendor_id == 0x0d81) {
1704                 switch(product_id) {
1705                 case 0x1900:
1706                         PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
1707                         name = "Visionite VCS-UC300";
1708                         type_id = 740; /* CCD sensor */
1709                         break;
1710                 case 0x1910:
1711                         PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
1712                         name = "Visionite VCS-UM100";
1713                         type_id = 730; /* CMOS sensor */
1714                         break;
1715                 default:
1716                         return -ENODEV;
1717                         break;
1718                 }
1719         }
1720         else
1721                 return -ENODEV; /* Not any of the know types; but the list keeps growing. */
1722
1723         memset(serial_number, 0, 30);
1724         usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
1725         PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
1726
1727         if (udev->descriptor.bNumConfigurations > 1)
1728                 PWC_WARNING("Warning: more than 1 configuration available.\n");
1729
1730         /* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
1731         pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
1732         if (pdev == NULL) {
1733                 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
1734                 return -ENOMEM;
1735         }
1736         pdev->type = type_id;
1737         pdev->vsize = default_size;
1738         pdev->vframes = default_fps;
1739         strcpy(pdev->serial, serial_number);
1740         pdev->features = features;
1741         if (vendor_id == 0x046D && product_id == 0x08B5)
1742         {
1743                 /* Logitech QuickCam Orbit
1744                    The ranges have been determined experimentally; they may differ from cam to cam.
1745                    Also, the exact ranges left-right and up-down are different for my cam
1746                   */
1747                 pdev->angle_range.pan_min  = -7000;
1748                 pdev->angle_range.pan_max  =  7000;
1749                 pdev->angle_range.tilt_min = -3000;
1750                 pdev->angle_range.tilt_max =  2500;
1751         }
1752
1753         mutex_init(&pdev->modlock);
1754         spin_lock_init(&pdev->ptrlock);
1755
1756         pdev->udev = udev;
1757         init_waitqueue_head(&pdev->frameq);
1758         pdev->vcompression = pwc_preferred_compression;
1759
1760         /* Allocate video_device structure */
1761         pdev->vdev = video_device_alloc();
1762         if (pdev->vdev == 0)
1763         {
1764                 PWC_ERROR("Err, cannot allocate video_device struture. Failing probe.");
1765                 kfree(pdev);
1766                 return -ENOMEM;
1767         }
1768         memcpy(pdev->vdev, &pwc_template, sizeof(pwc_template));
1769         pdev->vdev->dev = &(udev->dev);
1770         strcpy(pdev->vdev->name, name);
1771         pdev->vdev->owner = THIS_MODULE;
1772         video_set_drvdata(pdev->vdev, pdev);
1773
1774         pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
1775         PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
1776
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)) {
1783                                 /* 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;
1787                         }
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) {
1794                 PWC_ERROR("Failed to register as video device (%d).\n", i);
1795                 rc = i;
1796                 goto err;
1797         }
1798         else {
1799                 PWC_INFO("Registered as /dev/video%d.\n", pdev->vdev->minor & 0x3F);
1800         }
1801
1802         /* occupy slot */
1803         if (hint < MAX_DEV_HINTS)
1804                 device_hint[hint].pdev = pdev;
1805
1806         PWC_DEBUG_PROBE("probe() function returning struct at 0x%p.\n", pdev);
1807         usb_set_intfdata (intf, pdev);
1808         rc = pwc_create_sysfs_files(pdev->vdev);
1809         if (rc)
1810                 goto err_unreg;
1811
1812         /* Set the leds off */
1813         pwc_set_leds(pdev, 0, 0);
1814         pwc_camera_power(pdev, 0);
1815
1816         return 0;
1817
1818 err_unreg:
1819         if (hint < MAX_DEV_HINTS)
1820                 device_hint[hint].pdev = NULL;
1821         video_unregister_device(pdev->vdev);
1822 err:
1823         video_device_release(pdev->vdev); /* Drip... drip... drip... */
1824         kfree(pdev); /* Oops, no memory leaks please */
1825         return rc;
1826 }
1827
1828 /* The user janked out the cable... */
1829 static 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) {
1838                 PWC_ERROR("pwc_disconnect() Called without private pointer.\n");
1839                 goto disconnect_out;
1840         }
1841         if (pdev->udev == NULL) {
1842                 PWC_ERROR("pwc_disconnect() already called for %p\n", pdev);
1843                 goto disconnect_out;
1844         }
1845         if (pdev->udev != interface_to_usbdev(intf)) {
1846                 PWC_ERROR("pwc_disconnect() Woops: pointer mismatch udev/pdev.\n");
1847                 goto disconnect_out;
1848         }
1849
1850         /* We got unplugged; this is signalled by an EPIPE error code */
1851         if (pdev->vopen) {
1852                 PWC_INFO("Disconnected while webcam is in use!\n");
1853                 pdev->error_status = EPIPE;
1854         }
1855
1856         /* Alert waiting processes */
1857         wake_up_interruptible(&pdev->frameq);
1858         /* Wait until device is closed */
1859         if(pdev->vopen) {
1860                 mutex_lock(&pdev->modlock);
1861                 pdev->unplugged = 1;
1862                 mutex_unlock(&pdev->modlock);
1863                 pwc_iso_stop(pdev);
1864         } 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);
1870
1871 disconnect_out:
1872                 /* 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         }
1877
1878         unlock_kernel();
1879 }
1880
1881 /* *grunt* We have to do atoi ourselves :-( */
1882 static 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
1895 /*
1896  * Initialization code & module stuff
1897  */
1898
1899 static char *size;
1900 static int fps;
1901 static int fbufs;
1902 static int mbufs;
1903 static int compression = -1;
1904 static int leds[2] = { -1, -1 };
1905 static unsigned int leds_nargs;
1906 static char *dev_hint[MAX_DEV_HINTS];
1907 static unsigned int dev_hint_nargs;
1908
1909 module_param(size, charp, 0444);
1910 module_param(fps, int, 0444);
1911 module_param(fbufs, int, 0444);
1912 module_param(mbufs, int, 0444);
1913 #ifdef CONFIG_USB_PWC_DEBUG
1914 module_param_named(trace, pwc_trace, int, 0644);
1915 #endif
1916 module_param(power_save, int, 0444);
1917 module_param(compression, int, 0444);
1918 module_param_array(leds, int, &leds_nargs, 0444);
1919 module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
1920
1921 MODULE_PARM_DESC(size, "Initial image size. One of sqcif, qsif, qcif, sif, cif, vga");
1922 MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
1923 MODULE_PARM_DESC(fbufs, "Number of internal frame buffers to reserve");
1924 MODULE_PARM_DESC(mbufs, "Number of external (mmap()ed) image buffers");
1925 MODULE_PARM_DESC(trace, "For debugging purposes");
1926 MODULE_PARM_DESC(power_save, "Turn power save feature in camera on or off");
1927 MODULE_PARM_DESC(compression, "Preferred compression quality. Range 0 (uncompressed) to 3 (high compression)");
1928 MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
1929 MODULE_PARM_DESC(dev_hint, "Device node hints");
1930
1931 MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
1932 MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
1933 MODULE_LICENSE("GPL");
1934 MODULE_ALIAS("pwcx");
1935 MODULE_VERSION( PWC_VERSION );
1936
1937 static int __init usb_pwc_init(void)
1938 {
1939         int i, sz;
1940         char *sizenames[PSZ_MAX] = { "sqcif", "qsif", "qcif", "sif", "cif", "vga" };
1941
1942         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");
1946
1947         if (fps) {
1948                 if (fps < 4 || fps > 30) {
1949                         PWC_ERROR("Framerate out of bounds (4-30).\n");
1950                         return -EINVAL;
1951                 }
1952                 default_fps = fps;
1953                 PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
1954         }
1955
1956         if (size) {
1957                 /* 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) {
1965                         PWC_ERROR("Size not recognized; try size=[sqcif | qsif | qcif | sif | cif | vga].\n");
1966                         return -EINVAL;
1967                 }
1968                 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);
1969         }
1970         if (mbufs) {
1971                 if (mbufs < 1 || mbufs > MAX_IMAGES) {
1972                         PWC_ERROR("Illegal number of mmap() buffers; use a number between 1 and %d.\n", MAX_IMAGES);
1973                         return -EINVAL;
1974                 }
1975                 pwc_mbufs = mbufs;
1976                 PWC_DEBUG_MODULE("Number of image buffers set to %d.\n", pwc_mbufs);
1977         }
1978         if (fbufs) {
1979                 if (fbufs < 2 || fbufs > MAX_FRAMES) {
1980                         PWC_ERROR("Illegal number of frame buffers; use a number between 2 and %d.\n", MAX_FRAMES);
1981                         return -EINVAL;
1982                 }
1983                 default_fbufs = fbufs;
1984                 PWC_DEBUG_MODULE("Number of frame buffers set to %d.\n", default_fbufs);
1985         }
1986 #ifdef CONFIG_USB_PWC_DEBUG
1987         if (pwc_trace >= 0) {
1988                 PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
1989         }
1990 #endif
1991         if (compression >= 0) {
1992                 if (compression > 3) {
1993                         PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
1994                         return -EINVAL;
1995                 }
1996                 pwc_preferred_compression = compression;
1997                 PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
1998         }
1999         if (power_save)
2000                 PWC_DEBUG_MODULE("Enabling power save on open/close.\n");
2001         if (leds[0] >= 0)
2002                 led_on = leds[0];
2003         if (leds[1] >= 0)
2004                 led_off = leds[1];
2005
2006         /* Big device node whoopla. Basically, it allows you to assign a
2007            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) {
2031                                 PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
2032                                 return -EINVAL;
2033                         }
2034
2035                         if (*colon == '\0') {
2036                                 /* No colon */
2037                                 if (*dot != '\0') {
2038                                         PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
2039                                         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;
2053
2054                                         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                         }
2063                         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);
2067                 }
2068                 else
2069                         device_hint[i].type = 0; /* not filled */
2070         } /* ..for MAX_DEV_HINTS */
2071
2072         PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
2073         return usb_register(&pwc_driver);
2074 }
2075
2076 static void __exit usb_pwc_exit(void)
2077 {
2078         PWC_DEBUG_MODULE("Deregistering driver.\n");
2079         usb_deregister(&pwc_driver);
2080         PWC_INFO("Philips webcam module removed.\n");
2081 }
2082
2083 module_init(usb_pwc_init);
2084 module_exit(usb_pwc_exit);
2085
2086 /* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */