[media] pwc: Avoid sending mode info to the camera when it is not needed
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / media / video / pwc / pwc-if.c
blob23eaceea4862030bcbfa4f47ed35c914caf88003
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 (C) 2011 Hans de Goede <hdegoede@redhat.com>
7 NOTE: this version of pwc is an unofficial (modified) release of pwc & pcwx
8 driver and thus may have bugs that are not present in the original version.
9 Please send bug reports and support requests to <luc@saillard.org>.
10 The decompression routines have been implemented by reverse-engineering the
11 Nemosoft binary pwcx module. Caveat emptor.
13 This program is free software; you can redistribute it and/or modify
14 it under the terms of the GNU General Public License as published by
15 the Free Software Foundation; either version 2 of the License, or
16 (at your option) any later version.
18 This program is distributed in the hope that it will be useful,
19 but WITHOUT ANY WARRANTY; without even the implied warranty of
20 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 GNU General Public License for more details.
23 You should have received a copy of the GNU General Public License
24 along with this program; if not, write to the Free Software
25 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
30 This code forms the interface between the USB layers and the Philips
31 specific stuff. Some adanved stuff of the driver falls under an
32 NDA, signed between me and Philips B.V., Eindhoven, the Netherlands, and
33 is thus not distributed in source form. The binary pwcx.o module
34 contains the code that falls under the NDA.
36 In case you're wondering: 'pwc' stands for "Philips WebCam", but
37 I really didn't want to type 'philips_web_cam' every time (I'm lazy as
38 any Linux kernel hacker, but I don't like uncomprehensible abbreviations
39 without explanation).
41 Oh yes, convention: to disctinguish between all the various pointers to
42 device-structures, I use these names for the pointer variables:
43 udev: struct usb_device *
44 vdev: struct video_device (member of pwc_dev)
45 pdev: struct pwc_devive *
48 /* Contributors:
49 - Alvarado: adding whitebalance code
50 - Alistar Moire: QuickCam 3000 Pro device/product ID
51 - Tony Hoyle: Creative Labs Webcam 5 device/product ID
52 - Mark Burazin: solving hang in VIDIOCSYNC when camera gets unplugged
53 - Jk Fang: Sotec Afina Eye ID
54 - Xavier Roche: QuickCam Pro 4000 ID
55 - Jens Knudsen: QuickCam Zoom ID
56 - J. Debert: QuickCam for Notebooks ID
57 - Pham Thanh Nam: webcam snapshot button as an event input device
60 #include <linux/errno.h>
61 #include <linux/init.h>
62 #include <linux/mm.h>
63 #include <linux/module.h>
64 #include <linux/poll.h>
65 #include <linux/slab.h>
66 #ifdef CONFIG_USB_PWC_INPUT_EVDEV
67 #include <linux/usb/input.h>
68 #endif
69 #include <linux/vmalloc.h>
70 #include <asm/io.h>
71 #include <linux/kernel.h> /* simple_strtol() */
73 #include "pwc.h"
74 #include "pwc-kiara.h"
75 #include "pwc-timon.h"
76 #include "pwc-dec23.h"
77 #include "pwc-dec1.h"
79 /* Function prototypes and driver templates */
81 /* hotplug device table support */
82 static const struct usb_device_id pwc_device_table [] = {
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) },
90 { USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
91 { USB_DEVICE(0x0471, 0x0312) },
92 { USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
93 { USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
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 */
101 { USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
102 { USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
103 { USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
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) */
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) },
115 MODULE_DEVICE_TABLE(usb, pwc_device_table);
117 static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
118 static void usb_pwc_disconnect(struct usb_interface *intf);
119 static void pwc_isoc_cleanup(struct pwc_device *pdev);
121 static struct usb_driver pwc_driver = {
122 .name = "Philips webcam", /* name */
123 .id_table = pwc_device_table,
124 .probe = usb_pwc_probe, /* probe() */
125 .disconnect = usb_pwc_disconnect, /* disconnect() */
128 #define MAX_DEV_HINTS 20
129 #define MAX_ISOC_ERRORS 20
131 #ifdef CONFIG_USB_PWC_DEBUG
132 int pwc_trace = PWC_DEBUG_LEVEL;
133 #endif
134 static int power_save = -1;
135 static int led_on = 100, led_off; /* defaults to LED that is on while in use */
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];
143 /***/
145 static int pwc_video_close(struct file *file);
146 static ssize_t pwc_video_read(struct file *file, char __user *buf,
147 size_t count, loff_t *ppos);
148 static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
149 static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma);
151 static const struct v4l2_file_operations pwc_fops = {
152 .owner = THIS_MODULE,
153 .open = v4l2_fh_open,
154 .release = pwc_video_close,
155 .read = pwc_video_read,
156 .poll = pwc_video_poll,
157 .mmap = pwc_video_mmap,
158 .unlocked_ioctl = video_ioctl2,
160 static struct video_device pwc_template = {
161 .name = "Philips Webcam", /* Filled in later */
162 .release = video_device_release_empty,
163 .fops = &pwc_fops,
164 .ioctl_ops = &pwc_ioctl_ops,
167 /***************************************************************************/
168 /* Private functions */
170 struct pwc_frame_buf *pwc_get_next_fill_buf(struct pwc_device *pdev)
172 unsigned long flags = 0;
173 struct pwc_frame_buf *buf = NULL;
175 spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
176 if (list_empty(&pdev->queued_bufs))
177 goto leave;
179 buf = list_entry(pdev->queued_bufs.next, struct pwc_frame_buf, list);
180 list_del(&buf->list);
181 leave:
182 spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
183 return buf;
186 static void pwc_snapshot_button(struct pwc_device *pdev, int down)
188 if (down) {
189 PWC_TRACE("Snapshot button pressed.\n");
190 } else {
191 PWC_TRACE("Snapshot button released.\n");
194 #ifdef CONFIG_USB_PWC_INPUT_EVDEV
195 if (pdev->button_dev) {
196 input_report_key(pdev->button_dev, KEY_CAMERA, down);
197 input_sync(pdev->button_dev);
199 #endif
202 static void pwc_frame_complete(struct pwc_device *pdev)
204 struct pwc_frame_buf *fbuf = pdev->fill_buf;
206 /* The ToUCam Fun CMOS sensor causes the firmware to send 2 or 3 bogus
207 frames on the USB wire after an exposure change. This conditition is
208 however detected in the cam and a bit is set in the header.
210 if (pdev->type == 730) {
211 unsigned char *ptr = (unsigned char *)fbuf->data;
213 if (ptr[1] == 1 && ptr[0] & 0x10) {
214 PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
215 pdev->drop_frames += 2;
217 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
218 pwc_snapshot_button(pdev, ptr[0] & 0x01);
220 if ((ptr[0] ^ pdev->vmirror) & 0x02) {
221 if (ptr[0] & 0x02)
222 PWC_TRACE("Image is mirrored.\n");
223 else
224 PWC_TRACE("Image is normal.\n");
226 pdev->vmirror = ptr[0] & 0x03;
227 /* Sometimes the trailer of the 730 is still sent as a 4 byte packet
228 after a short frame; this condition is filtered out specifically. A 4 byte
229 frame doesn't make sense anyway.
230 So we get either this sequence:
231 drop_bit set -> 4 byte frame -> short frame -> good frame
232 Or this one:
233 drop_bit set -> short frame -> good frame
234 So we drop either 3 or 2 frames in all!
236 if (fbuf->filled == 4)
237 pdev->drop_frames++;
238 } else if (pdev->type == 740 || pdev->type == 720) {
239 unsigned char *ptr = (unsigned char *)fbuf->data;
240 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
241 pwc_snapshot_button(pdev, ptr[0] & 0x01);
243 pdev->vmirror = ptr[0] & 0x03;
246 /* In case we were instructed to drop the frame, do so silently. */
247 if (pdev->drop_frames > 0) {
248 pdev->drop_frames--;
249 } else {
250 /* Check for underflow first */
251 if (fbuf->filled < pdev->frame_total_size) {
252 PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
253 " discarded.\n", fbuf->filled);
254 } else {
255 fbuf->vb.v4l2_buf.field = V4L2_FIELD_NONE;
256 fbuf->vb.v4l2_buf.sequence = pdev->vframe_count;
257 vb2_buffer_done(&fbuf->vb, VB2_BUF_STATE_DONE);
258 pdev->fill_buf = NULL;
259 pdev->vsync = 0;
261 } /* !drop_frames */
262 pdev->vframe_count++;
265 /* This gets called for the Isochronous pipe (video). This is done in
266 * interrupt time, so it has to be fast, not crash, and not stall. Neat.
268 static void pwc_isoc_handler(struct urb *urb)
270 struct pwc_device *pdev = (struct pwc_device *)urb->context;
271 int i, fst, flen;
272 unsigned char *iso_buf = NULL;
274 if (urb->status == -ENOENT || urb->status == -ECONNRESET ||
275 urb->status == -ESHUTDOWN) {
276 PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
277 return;
280 if (pdev->fill_buf == NULL)
281 pdev->fill_buf = pwc_get_next_fill_buf(pdev);
283 if (urb->status != 0) {
284 const char *errmsg;
286 errmsg = "Unknown";
287 switch(urb->status) {
288 case -ENOSR: errmsg = "Buffer error (overrun)"; break;
289 case -EPIPE: errmsg = "Stalled (device not responding)"; break;
290 case -EOVERFLOW: errmsg = "Babble (bad cable?)"; break;
291 case -EPROTO: errmsg = "Bit-stuff error (bad cable?)"; break;
292 case -EILSEQ: errmsg = "CRC/Timeout (could be anything)"; break;
293 case -ETIME: errmsg = "Device does not respond"; break;
295 PWC_ERROR("pwc_isoc_handler() called with status %d [%s].\n",
296 urb->status, errmsg);
297 /* Give up after a number of contiguous errors */
298 if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
300 PWC_ERROR("Too many ISOC errors, bailing out.\n");
301 if (pdev->fill_buf) {
302 vb2_buffer_done(&pdev->fill_buf->vb,
303 VB2_BUF_STATE_ERROR);
304 pdev->fill_buf = NULL;
307 pdev->vsync = 0; /* Drop the current frame */
308 goto handler_end;
311 /* Reset ISOC error counter. We did get here, after all. */
312 pdev->visoc_errors = 0;
314 /* vsync: 0 = don't copy data
315 1 = sync-hunt
316 2 = synched
318 /* Compact data */
319 for (i = 0; i < urb->number_of_packets; i++) {
320 fst = urb->iso_frame_desc[i].status;
321 flen = urb->iso_frame_desc[i].actual_length;
322 iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
323 if (fst != 0) {
324 PWC_ERROR("Iso frame %d has error %d\n", i, fst);
325 continue;
327 if (flen > 0 && pdev->vsync) {
328 struct pwc_frame_buf *fbuf = pdev->fill_buf;
330 if (pdev->vsync == 1) {
331 do_gettimeofday(&fbuf->vb.v4l2_buf.timestamp);
332 pdev->vsync = 2;
335 if (flen + fbuf->filled > pdev->frame_total_size) {
336 PWC_ERROR("Frame overflow (%d > %d)\n",
337 flen + fbuf->filled,
338 pdev->frame_total_size);
339 pdev->vsync = 0; /* Let's wait for an EOF */
340 } else {
341 memcpy(fbuf->data + fbuf->filled, iso_buf,
342 flen);
343 fbuf->filled += flen;
346 if (flen < pdev->vlast_packet_size) {
347 /* Shorter packet... end of frame */
348 if (pdev->vsync == 2)
349 pwc_frame_complete(pdev);
350 if (pdev->fill_buf == NULL)
351 pdev->fill_buf = pwc_get_next_fill_buf(pdev);
352 if (pdev->fill_buf) {
353 pdev->fill_buf->filled = 0;
354 pdev->vsync = 1;
357 pdev->vlast_packet_size = flen;
360 handler_end:
361 i = usb_submit_urb(urb, GFP_ATOMIC);
362 if (i != 0)
363 PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
366 static int pwc_isoc_init(struct pwc_device *pdev)
368 struct usb_device *udev;
369 struct urb *urb;
370 int i, j, ret;
371 struct usb_interface *intf;
372 struct usb_host_interface *idesc = NULL;
373 int compression = 0; /* 0..3 = uncompressed..high */
375 if (pdev->iso_init)
376 return 0;
378 pdev->vsync = 0;
379 pdev->vlast_packet_size = 0;
380 pdev->fill_buf = NULL;
381 pdev->vframe_count = 0;
382 pdev->visoc_errors = 0;
383 udev = pdev->udev;
385 retry:
386 /* We first try with low compression and then retry with a higher
387 compression setting if there is not enough bandwidth. */
388 ret = pwc_set_video_mode(pdev, pdev->width, pdev->height, pdev->pixfmt,
389 pdev->vframes, &compression, 1);
391 /* Get the current alternate interface, adjust packet size */
392 intf = usb_ifnum_to_if(udev, 0);
393 if (intf)
394 idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
395 if (!idesc)
396 return -EIO;
398 /* Search video endpoint */
399 pdev->vmax_packet_size = -1;
400 for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
401 if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
402 pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
403 break;
407 if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
408 PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
409 return -ENFILE; /* Odd error, that should be noticeable */
412 /* Set alternate interface */
413 PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
414 ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
415 if (ret == -ENOSPC && compression < 3) {
416 compression++;
417 goto retry;
419 if (ret < 0)
420 return ret;
422 /* Allocate and init Isochronuous urbs */
423 for (i = 0; i < MAX_ISO_BUFS; i++) {
424 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
425 if (urb == NULL) {
426 PWC_ERROR("Failed to allocate urb %d\n", i);
427 pdev->iso_init = 1;
428 pwc_isoc_cleanup(pdev);
429 return -ENOMEM;
431 pdev->urbs[i] = urb;
432 PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
434 urb->interval = 1; // devik
435 urb->dev = udev;
436 urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
437 urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
438 urb->transfer_buffer = usb_alloc_coherent(udev,
439 ISO_BUFFER_SIZE,
440 GFP_KERNEL,
441 &urb->transfer_dma);
442 if (urb->transfer_buffer == NULL) {
443 PWC_ERROR("Failed to allocate urb buffer %d\n", i);
444 pdev->iso_init = 1;
445 pwc_isoc_cleanup(pdev);
446 return -ENOMEM;
448 urb->transfer_buffer_length = ISO_BUFFER_SIZE;
449 urb->complete = pwc_isoc_handler;
450 urb->context = pdev;
451 urb->start_frame = 0;
452 urb->number_of_packets = ISO_FRAMES_PER_DESC;
453 for (j = 0; j < ISO_FRAMES_PER_DESC; j++) {
454 urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE;
455 urb->iso_frame_desc[j].length = pdev->vmax_packet_size;
459 /* link */
460 for (i = 0; i < MAX_ISO_BUFS; i++) {
461 ret = usb_submit_urb(pdev->urbs[i], GFP_KERNEL);
462 if (ret == -ENOSPC && compression < 3) {
463 compression++;
464 pdev->iso_init = 1;
465 pwc_isoc_cleanup(pdev);
466 goto retry;
468 if (ret) {
469 PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
470 pdev->iso_init = 1;
471 pwc_isoc_cleanup(pdev);
472 return ret;
474 PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->urbs[i]);
477 /* All is done... */
478 pdev->iso_init = 1;
479 PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
480 return 0;
483 static void pwc_iso_stop(struct pwc_device *pdev)
485 int i;
487 /* Unlinking ISOC buffers one by one */
488 for (i = 0; i < MAX_ISO_BUFS; i++) {
489 if (pdev->urbs[i]) {
490 PWC_DEBUG_MEMORY("Unlinking URB %p\n", pdev->urbs[i]);
491 usb_kill_urb(pdev->urbs[i]);
496 static void pwc_iso_free(struct pwc_device *pdev)
498 int i;
500 /* Freeing ISOC buffers one by one */
501 for (i = 0; i < MAX_ISO_BUFS; i++) {
502 if (pdev->urbs[i]) {
503 PWC_DEBUG_MEMORY("Freeing URB\n");
504 if (pdev->urbs[i]->transfer_buffer) {
505 usb_free_coherent(pdev->udev,
506 pdev->urbs[i]->transfer_buffer_length,
507 pdev->urbs[i]->transfer_buffer,
508 pdev->urbs[i]->transfer_dma);
510 usb_free_urb(pdev->urbs[i]);
511 pdev->urbs[i] = NULL;
516 static void pwc_isoc_cleanup(struct pwc_device *pdev)
518 PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
520 if (pdev->iso_init == 0)
521 return;
523 pwc_iso_stop(pdev);
524 pwc_iso_free(pdev);
525 usb_set_interface(pdev->udev, 0, 0);
527 pdev->iso_init = 0;
528 PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
531 static void pwc_cleanup_queued_bufs(struct pwc_device *pdev)
533 unsigned long flags = 0;
535 spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
536 while (!list_empty(&pdev->queued_bufs)) {
537 struct pwc_frame_buf *buf;
539 buf = list_entry(pdev->queued_bufs.next, struct pwc_frame_buf,
540 list);
541 list_del(&buf->list);
542 vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR);
544 spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
547 #ifdef CONFIG_USB_PWC_DEBUG
548 static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
550 switch(sensor_type) {
551 case 0x00:
552 return "Hyundai CMOS sensor";
553 case 0x20:
554 return "Sony CCD sensor + TDA8787";
555 case 0x2E:
556 return "Sony CCD sensor + Exas 98L59";
557 case 0x2F:
558 return "Sony CCD sensor + ADI 9804";
559 case 0x30:
560 return "Sharp CCD sensor + TDA8787";
561 case 0x3E:
562 return "Sharp CCD sensor + Exas 98L59";
563 case 0x3F:
564 return "Sharp CCD sensor + ADI 9804";
565 case 0x40:
566 return "UPA 1021 sensor";
567 case 0x100:
568 return "VGA sensor";
569 case 0x101:
570 return "PAL MR sensor";
571 default:
572 return "unknown type of sensor";
575 #endif
577 /***************************************************************************/
578 /* Video4Linux functions */
580 int pwc_test_n_set_capt_file(struct pwc_device *pdev, struct file *file)
582 int r = 0;
584 mutex_lock(&pdev->capt_file_lock);
585 if (pdev->capt_file != NULL &&
586 pdev->capt_file != file) {
587 r = -EBUSY;
588 goto leave;
590 pdev->capt_file = file;
591 leave:
592 mutex_unlock(&pdev->capt_file_lock);
593 return r;
596 static void pwc_video_release(struct v4l2_device *v)
598 struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
599 int hint;
601 /* search device_hint[] table if we occupy a slot, by any chance */
602 for (hint = 0; hint < MAX_DEV_HINTS; hint++)
603 if (device_hint[hint].pdev == pdev)
604 device_hint[hint].pdev = NULL;
606 v4l2_ctrl_handler_free(&pdev->ctrl_handler);
608 kfree(pdev);
611 static int pwc_video_close(struct file *file)
613 struct pwc_device *pdev = video_drvdata(file);
615 if (pdev->capt_file == file) {
616 vb2_queue_release(&pdev->vb_queue);
617 pdev->capt_file = NULL;
619 return v4l2_fh_release(file);
622 static ssize_t pwc_video_read(struct file *file, char __user *buf,
623 size_t count, loff_t *ppos)
625 struct pwc_device *pdev = video_drvdata(file);
627 if (!pdev->udev)
628 return -ENODEV;
630 if (pwc_test_n_set_capt_file(pdev, file))
631 return -EBUSY;
633 return vb2_read(&pdev->vb_queue, buf, count, ppos,
634 file->f_flags & O_NONBLOCK);
637 static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
639 struct pwc_device *pdev = video_drvdata(file);
641 if (!pdev->udev)
642 return POLL_ERR;
644 return vb2_poll(&pdev->vb_queue, file, wait);
647 static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
649 struct pwc_device *pdev = video_drvdata(file);
651 if (pdev->capt_file != file)
652 return -EBUSY;
654 return vb2_mmap(&pdev->vb_queue, vma);
657 /***************************************************************************/
658 /* Videobuf2 operations */
660 static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt,
661 unsigned int *nbuffers, unsigned int *nplanes,
662 unsigned int sizes[], void *alloc_ctxs[])
664 struct pwc_device *pdev = vb2_get_drv_priv(vq);
665 int size;
667 if (*nbuffers < MIN_FRAMES)
668 *nbuffers = MIN_FRAMES;
669 else if (*nbuffers > MAX_FRAMES)
670 *nbuffers = MAX_FRAMES;
672 *nplanes = 1;
674 size = pwc_get_size(pdev, MAX_WIDTH, MAX_HEIGHT);
675 sizes[0] = PAGE_ALIGN(pwc_image_sizes[size][0] *
676 pwc_image_sizes[size][1] * 3 / 2);
678 return 0;
681 static int buffer_init(struct vb2_buffer *vb)
683 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
685 /* need vmalloc since frame buffer > 128K */
686 buf->data = vzalloc(PWC_FRAME_SIZE);
687 if (buf->data == NULL)
688 return -ENOMEM;
690 return 0;
693 static int buffer_prepare(struct vb2_buffer *vb)
695 struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
697 /* Don't allow queing new buffers after device disconnection */
698 if (!pdev->udev)
699 return -ENODEV;
701 return 0;
704 static int buffer_finish(struct vb2_buffer *vb)
706 struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
707 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
710 * Application has called dqbuf and is getting back a buffer we've
711 * filled, take the pwc data we've stored in buf->data and decompress
712 * it into a usable format, storing the result in the vb2_buffer
714 return pwc_decompress(pdev, buf);
717 static void buffer_cleanup(struct vb2_buffer *vb)
719 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
721 vfree(buf->data);
724 static void buffer_queue(struct vb2_buffer *vb)
726 struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
727 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
728 unsigned long flags = 0;
730 spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
731 /* Check the device has not disconnected between prep and queuing */
732 if (pdev->udev)
733 list_add_tail(&buf->list, &pdev->queued_bufs);
734 else
735 vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR);
736 spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
739 static int start_streaming(struct vb2_queue *vq, unsigned int count)
741 struct pwc_device *pdev = vb2_get_drv_priv(vq);
742 int r;
744 mutex_lock(&pdev->udevlock);
745 if (!pdev->udev) {
746 r = -ENODEV;
747 goto leave;
750 /* Turn on camera and set LEDS on */
751 pwc_camera_power(pdev, 1);
752 pwc_set_leds(pdev, led_on, led_off);
754 r = pwc_isoc_init(pdev);
755 if (r) {
756 /* If we failed turn camera and LEDS back off */
757 pwc_set_leds(pdev, 0, 0);
758 pwc_camera_power(pdev, 0);
759 /* And cleanup any queued bufs!! */
760 pwc_cleanup_queued_bufs(pdev);
762 leave:
763 mutex_unlock(&pdev->udevlock);
764 return r;
767 static int stop_streaming(struct vb2_queue *vq)
769 struct pwc_device *pdev = vb2_get_drv_priv(vq);
771 mutex_lock(&pdev->udevlock);
772 if (pdev->udev) {
773 pwc_set_leds(pdev, 0, 0);
774 pwc_camera_power(pdev, 0);
775 pwc_isoc_cleanup(pdev);
777 mutex_unlock(&pdev->udevlock);
779 pwc_cleanup_queued_bufs(pdev);
781 return 0;
784 static struct vb2_ops pwc_vb_queue_ops = {
785 .queue_setup = queue_setup,
786 .buf_init = buffer_init,
787 .buf_prepare = buffer_prepare,
788 .buf_finish = buffer_finish,
789 .buf_cleanup = buffer_cleanup,
790 .buf_queue = buffer_queue,
791 .start_streaming = start_streaming,
792 .stop_streaming = stop_streaming,
795 /***************************************************************************/
796 /* USB functions */
798 /* This function gets called when a new device is plugged in or the usb core
799 * is loaded.
802 static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
804 struct usb_device *udev = interface_to_usbdev(intf);
805 struct pwc_device *pdev = NULL;
806 int vendor_id, product_id, type_id;
807 int hint, rc;
808 int features = 0;
809 int compression = 0;
810 int video_nr = -1; /* default: use next available device */
811 int my_power_save = power_save;
812 char serial_number[30], *name;
814 vendor_id = le16_to_cpu(udev->descriptor.idVendor);
815 product_id = le16_to_cpu(udev->descriptor.idProduct);
817 /* Check if we can handle this device */
818 PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
819 vendor_id, product_id,
820 intf->altsetting->desc.bInterfaceNumber);
822 /* the interfaces are probed one by one. We are only interested in the
823 video interface (0) now.
824 Interface 1 is the Audio Control, and interface 2 Audio itself.
826 if (intf->altsetting->desc.bInterfaceNumber > 0)
827 return -ENODEV;
829 if (vendor_id == 0x0471) {
830 switch (product_id) {
831 case 0x0302:
832 PWC_INFO("Philips PCA645VC USB webcam detected.\n");
833 name = "Philips 645 webcam";
834 type_id = 645;
835 break;
836 case 0x0303:
837 PWC_INFO("Philips PCA646VC USB webcam detected.\n");
838 name = "Philips 646 webcam";
839 type_id = 646;
840 break;
841 case 0x0304:
842 PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
843 name = "Askey VC010 webcam";
844 type_id = 646;
845 break;
846 case 0x0307:
847 PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
848 name = "Philips 675 webcam";
849 type_id = 675;
850 break;
851 case 0x0308:
852 PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
853 name = "Philips 680 webcam";
854 type_id = 680;
855 break;
856 case 0x030C:
857 PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
858 name = "Philips 690 webcam";
859 type_id = 690;
860 break;
861 case 0x0310:
862 PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
863 name = "Philips 730 webcam";
864 type_id = 730;
865 break;
866 case 0x0311:
867 PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
868 name = "Philips 740 webcam";
869 type_id = 740;
870 break;
871 case 0x0312:
872 PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
873 name = "Philips 750 webcam";
874 type_id = 750;
875 break;
876 case 0x0313:
877 PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
878 name = "Philips 720K/40 webcam";
879 type_id = 720;
880 break;
881 case 0x0329:
882 PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
883 name = "Philips SPC 900NC webcam";
884 type_id = 740;
885 break;
886 default:
887 return -ENODEV;
888 break;
891 else if (vendor_id == 0x069A) {
892 switch(product_id) {
893 case 0x0001:
894 PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
895 name = "Askey VC010 webcam";
896 type_id = 645;
897 break;
898 default:
899 return -ENODEV;
900 break;
903 else if (vendor_id == 0x046d) {
904 switch(product_id) {
905 case 0x08b0:
906 PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
907 name = "Logitech QuickCam Pro 3000";
908 type_id = 740; /* CCD sensor */
909 break;
910 case 0x08b1:
911 PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
912 name = "Logitech QuickCam Notebook Pro";
913 type_id = 740; /* CCD sensor */
914 break;
915 case 0x08b2:
916 PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
917 name = "Logitech QuickCam Pro 4000";
918 type_id = 740; /* CCD sensor */
919 if (my_power_save == -1)
920 my_power_save = 1;
921 break;
922 case 0x08b3:
923 PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
924 name = "Logitech QuickCam Zoom";
925 type_id = 740; /* CCD sensor */
926 break;
927 case 0x08B4:
928 PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
929 name = "Logitech QuickCam Zoom";
930 type_id = 740; /* CCD sensor */
931 if (my_power_save == -1)
932 my_power_save = 1;
933 break;
934 case 0x08b5:
935 PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
936 name = "Logitech QuickCam Orbit";
937 type_id = 740; /* CCD sensor */
938 if (my_power_save == -1)
939 my_power_save = 1;
940 features |= FEATURE_MOTOR_PANTILT;
941 break;
942 case 0x08b6:
943 PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
944 name = "Cisco VT Camera";
945 type_id = 740; /* CCD sensor */
946 break;
947 case 0x08b7:
948 PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
949 name = "Logitech ViewPort AV 100";
950 type_id = 740; /* CCD sensor */
951 break;
952 case 0x08b8: /* Where this released? */
953 PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
954 name = "Logitech QuickCam (res.)";
955 type_id = 730; /* Assuming CMOS */
956 break;
957 default:
958 return -ENODEV;
959 break;
962 else if (vendor_id == 0x055d) {
963 /* I don't know the difference between the C10 and the C30;
964 I suppose the difference is the sensor, but both cameras
965 work equally well with a type_id of 675
967 switch(product_id) {
968 case 0x9000:
969 PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
970 name = "Samsung MPC-C10";
971 type_id = 675;
972 break;
973 case 0x9001:
974 PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
975 name = "Samsung MPC-C30";
976 type_id = 675;
977 break;
978 case 0x9002:
979 PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
980 name = "Samsung MPC-C30";
981 type_id = 740;
982 break;
983 default:
984 return -ENODEV;
985 break;
988 else if (vendor_id == 0x041e) {
989 switch(product_id) {
990 case 0x400c:
991 PWC_INFO("Creative Labs Webcam 5 detected.\n");
992 name = "Creative Labs Webcam 5";
993 type_id = 730;
994 if (my_power_save == -1)
995 my_power_save = 1;
996 break;
997 case 0x4011:
998 PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
999 name = "Creative Labs Webcam Pro Ex";
1000 type_id = 740;
1001 break;
1002 default:
1003 return -ENODEV;
1004 break;
1007 else if (vendor_id == 0x04cc) {
1008 switch(product_id) {
1009 case 0x8116:
1010 PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
1011 name = "Sotec Afina Eye";
1012 type_id = 730;
1013 break;
1014 default:
1015 return -ENODEV;
1016 break;
1019 else if (vendor_id == 0x06be) {
1020 switch(product_id) {
1021 case 0x8116:
1022 /* This is essentially the same cam as the Sotec Afina Eye */
1023 PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
1024 name = "AME Co. Afina Eye";
1025 type_id = 750;
1026 break;
1027 default:
1028 return -ENODEV;
1029 break;
1033 else if (vendor_id == 0x0d81) {
1034 switch(product_id) {
1035 case 0x1900:
1036 PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
1037 name = "Visionite VCS-UC300";
1038 type_id = 740; /* CCD sensor */
1039 break;
1040 case 0x1910:
1041 PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
1042 name = "Visionite VCS-UM100";
1043 type_id = 730; /* CMOS sensor */
1044 break;
1045 default:
1046 return -ENODEV;
1047 break;
1050 else
1051 return -ENODEV; /* Not any of the know types; but the list keeps growing. */
1053 if (my_power_save == -1)
1054 my_power_save = 0;
1056 memset(serial_number, 0, 30);
1057 usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
1058 PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
1060 if (udev->descriptor.bNumConfigurations > 1)
1061 PWC_WARNING("Warning: more than 1 configuration available.\n");
1063 /* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
1064 pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
1065 if (pdev == NULL) {
1066 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
1067 return -ENOMEM;
1069 pdev->type = type_id;
1070 pdev->features = features;
1071 pwc_construct(pdev); /* set min/max sizes correct */
1073 mutex_init(&pdev->capt_file_lock);
1074 mutex_init(&pdev->udevlock);
1075 spin_lock_init(&pdev->queued_bufs_lock);
1076 INIT_LIST_HEAD(&pdev->queued_bufs);
1078 pdev->udev = udev;
1079 pdev->power_save = my_power_save;
1081 /* Init videobuf2 queue structure */
1082 memset(&pdev->vb_queue, 0, sizeof(pdev->vb_queue));
1083 pdev->vb_queue.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1084 pdev->vb_queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_READ;
1085 pdev->vb_queue.drv_priv = pdev;
1086 pdev->vb_queue.buf_struct_size = sizeof(struct pwc_frame_buf);
1087 pdev->vb_queue.ops = &pwc_vb_queue_ops;
1088 pdev->vb_queue.mem_ops = &vb2_vmalloc_memops;
1089 vb2_queue_init(&pdev->vb_queue);
1091 /* Init video_device structure */
1092 memcpy(&pdev->vdev, &pwc_template, sizeof(pwc_template));
1093 strcpy(pdev->vdev.name, name);
1094 set_bit(V4L2_FL_USE_FH_PRIO, &pdev->vdev.flags);
1095 video_set_drvdata(&pdev->vdev, pdev);
1097 pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
1098 PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
1100 /* Now search device_hint[] table for a match, so we can hint a node number. */
1101 for (hint = 0; hint < MAX_DEV_HINTS; hint++) {
1102 if (((device_hint[hint].type == -1) || (device_hint[hint].type == pdev->type)) &&
1103 (device_hint[hint].pdev == NULL)) {
1104 /* so far, so good... try serial number */
1105 if ((device_hint[hint].serial_number[0] == '*') || !strcmp(device_hint[hint].serial_number, serial_number)) {
1106 /* match! */
1107 video_nr = device_hint[hint].device_node;
1108 PWC_DEBUG_PROBE("Found hint, will try to register as /dev/video%d\n", video_nr);
1109 break;
1114 /* occupy slot */
1115 if (hint < MAX_DEV_HINTS)
1116 device_hint[hint].pdev = pdev;
1118 #ifdef CONFIG_USB_PWC_DEBUG
1119 /* Query sensor type */
1120 if (pwc_get_cmos_sensor(pdev, &rc) >= 0) {
1121 PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
1122 pdev->vdev.name,
1123 pwc_sensor_type_to_string(rc), rc);
1125 #endif
1127 /* Set the leds off */
1128 pwc_set_leds(pdev, 0, 0);
1130 /* Setup intial videomode */
1131 rc = pwc_set_video_mode(pdev, MAX_WIDTH, MAX_HEIGHT,
1132 V4L2_PIX_FMT_YUV420, 30, &compression, 1);
1133 if (rc)
1134 goto err_free_mem;
1136 /* Register controls (and read default values from camera */
1137 rc = pwc_init_controls(pdev);
1138 if (rc) {
1139 PWC_ERROR("Failed to register v4l2 controls (%d).\n", rc);
1140 goto err_free_mem;
1143 /* And powerdown the camera until streaming starts */
1144 pwc_camera_power(pdev, 0);
1146 /* Register the v4l2_device structure */
1147 pdev->v4l2_dev.release = pwc_video_release;
1148 rc = v4l2_device_register(&intf->dev, &pdev->v4l2_dev);
1149 if (rc) {
1150 PWC_ERROR("Failed to register v4l2-device (%d).\n", rc);
1151 goto err_free_controls;
1154 pdev->v4l2_dev.ctrl_handler = &pdev->ctrl_handler;
1155 pdev->vdev.v4l2_dev = &pdev->v4l2_dev;
1157 rc = video_register_device(&pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1158 if (rc < 0) {
1159 PWC_ERROR("Failed to register as video device (%d).\n", rc);
1160 goto err_unregister_v4l2_dev;
1162 PWC_INFO("Registered as %s.\n", video_device_node_name(&pdev->vdev));
1164 #ifdef CONFIG_USB_PWC_INPUT_EVDEV
1165 /* register webcam snapshot button input device */
1166 pdev->button_dev = input_allocate_device();
1167 if (!pdev->button_dev) {
1168 PWC_ERROR("Err, insufficient memory for webcam snapshot button device.");
1169 rc = -ENOMEM;
1170 goto err_video_unreg;
1173 usb_make_path(udev, pdev->button_phys, sizeof(pdev->button_phys));
1174 strlcat(pdev->button_phys, "/input0", sizeof(pdev->button_phys));
1176 pdev->button_dev->name = "PWC snapshot button";
1177 pdev->button_dev->phys = pdev->button_phys;
1178 usb_to_input_id(pdev->udev, &pdev->button_dev->id);
1179 pdev->button_dev->dev.parent = &pdev->udev->dev;
1180 pdev->button_dev->evbit[0] = BIT_MASK(EV_KEY);
1181 pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
1183 rc = input_register_device(pdev->button_dev);
1184 if (rc) {
1185 input_free_device(pdev->button_dev);
1186 pdev->button_dev = NULL;
1187 goto err_video_unreg;
1189 #endif
1191 return 0;
1193 err_video_unreg:
1194 video_unregister_device(&pdev->vdev);
1195 err_unregister_v4l2_dev:
1196 v4l2_device_unregister(&pdev->v4l2_dev);
1197 err_free_controls:
1198 v4l2_ctrl_handler_free(&pdev->ctrl_handler);
1199 err_free_mem:
1200 if (hint < MAX_DEV_HINTS)
1201 device_hint[hint].pdev = NULL;
1202 kfree(pdev);
1203 return rc;
1206 /* The user yanked out the cable... */
1207 static void usb_pwc_disconnect(struct usb_interface *intf)
1209 struct v4l2_device *v = usb_get_intfdata(intf);
1210 struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
1212 mutex_lock(&pdev->udevlock);
1213 /* No need to keep the urbs around after disconnection */
1214 pwc_isoc_cleanup(pdev);
1215 pdev->udev = NULL;
1216 mutex_unlock(&pdev->udevlock);
1218 pwc_cleanup_queued_bufs(pdev);
1220 video_unregister_device(&pdev->vdev);
1221 v4l2_device_unregister(&pdev->v4l2_dev);
1223 #ifdef CONFIG_USB_PWC_INPUT_EVDEV
1224 if (pdev->button_dev)
1225 input_unregister_device(pdev->button_dev);
1226 #endif
1228 v4l2_device_put(&pdev->v4l2_dev);
1233 * Initialization code & module stuff
1236 static int leds[2] = { -1, -1 };
1237 static unsigned int leds_nargs;
1238 static char *dev_hint[MAX_DEV_HINTS];
1239 static unsigned int dev_hint_nargs;
1241 #ifdef CONFIG_USB_PWC_DEBUG
1242 module_param_named(trace, pwc_trace, int, 0644);
1243 #endif
1244 module_param(power_save, int, 0644);
1245 module_param_array(leds, int, &leds_nargs, 0444);
1246 module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
1248 #ifdef CONFIG_USB_PWC_DEBUG
1249 MODULE_PARM_DESC(trace, "For debugging purposes");
1250 #endif
1251 MODULE_PARM_DESC(power_save, "Turn power saving for new cameras on or off");
1252 MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
1253 MODULE_PARM_DESC(dev_hint, "Device node hints");
1255 MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
1256 MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
1257 MODULE_LICENSE("GPL");
1258 MODULE_ALIAS("pwcx");
1259 MODULE_VERSION( PWC_VERSION );
1261 static int __init usb_pwc_init(void)
1263 int i;
1265 #ifdef CONFIG_USB_PWC_DEBUG
1266 PWC_INFO("Philips webcam module version " PWC_VERSION " loaded.\n");
1267 PWC_INFO("Supports Philips PCA645/646, PCVC675/680/690, PCVC720[40]/730/740/750 & PCVC830/840.\n");
1268 PWC_INFO("Also supports the Askey VC010, various Logitech Quickcams, Samsung MPC-C10 and MPC-C30,\n");
1269 PWC_INFO("the Creative WebCam 5 & Pro Ex, SOTEC Afina Eye and Visionite VCS-UC300 and VCS-UM100.\n");
1271 if (pwc_trace >= 0) {
1272 PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
1274 #endif
1276 if (leds[0] >= 0)
1277 led_on = leds[0];
1278 if (leds[1] >= 0)
1279 led_off = leds[1];
1281 /* Big device node whoopla. Basically, it allows you to assign a
1282 device node (/dev/videoX) to a camera, based on its type
1283 & serial number. The format is [type[.serialnumber]:]node.
1285 Any camera that isn't matched by these rules gets the next
1286 available free device node.
1288 for (i = 0; i < MAX_DEV_HINTS; i++) {
1289 char *s, *colon, *dot;
1291 /* This loop also initializes the array */
1292 device_hint[i].pdev = NULL;
1293 s = dev_hint[i];
1294 if (s != NULL && *s != '\0') {
1295 device_hint[i].type = -1; /* wildcard */
1296 strcpy(device_hint[i].serial_number, "*");
1298 /* parse string: chop at ':' & '/' */
1299 colon = dot = s;
1300 while (*colon != '\0' && *colon != ':')
1301 colon++;
1302 while (*dot != '\0' && *dot != '.')
1303 dot++;
1304 /* Few sanity checks */
1305 if (*dot != '\0' && dot > colon) {
1306 PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
1307 return -EINVAL;
1310 if (*colon == '\0') {
1311 /* No colon */
1312 if (*dot != '\0') {
1313 PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
1314 return -EINVAL;
1316 else {
1317 /* No type or serial number specified, just a number. */
1318 device_hint[i].device_node =
1319 simple_strtol(s, NULL, 10);
1322 else {
1323 /* There's a colon, so we have at least a type and a device node */
1324 device_hint[i].type =
1325 simple_strtol(s, NULL, 10);
1326 device_hint[i].device_node =
1327 simple_strtol(colon + 1, NULL, 10);
1328 if (*dot != '\0') {
1329 /* There's a serial number as well */
1330 int k;
1332 dot++;
1333 k = 0;
1334 while (*dot != ':' && k < 29) {
1335 device_hint[i].serial_number[k++] = *dot;
1336 dot++;
1338 device_hint[i].serial_number[k] = '\0';
1341 PWC_TRACE("device_hint[%d]:\n", i);
1342 PWC_TRACE(" type : %d\n", device_hint[i].type);
1343 PWC_TRACE(" serial# : %s\n", device_hint[i].serial_number);
1344 PWC_TRACE(" node : %d\n", device_hint[i].device_node);
1346 else
1347 device_hint[i].type = 0; /* not filled */
1348 } /* ..for MAX_DEV_HINTS */
1350 PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
1351 return usb_register(&pwc_driver);
1354 static void __exit usb_pwc_exit(void)
1356 PWC_DEBUG_MODULE("Deregistering driver.\n");
1357 usb_deregister(&pwc_driver);
1358 PWC_INFO("Philips webcam module removed.\n");
1361 module_init(usb_pwc_init);
1362 module_exit(usb_pwc_exit);
1364 /* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */