blob: a07df4e4aa04238b1923c78fe174fbfe743538b2 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* Linux driver for Philips webcam
2 USB and Video4Linux interface part.
3 (C) 1999-2004 Nemosoft Unv.
Luc Saillard2b455db2006-04-24 10:29:46 -03004 (C) 2004-2006 Luc Saillard (luc@saillard.org)
Hans de Goede6eba9352011-06-26 06:49:59 -03005 (C) 2011 Hans de Goede <hdegoede@redhat.com>
Linus Torvalds1da177e2005-04-16 15:20:36 -07006
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.
12
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.
17
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.
22
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
26
27*/
28
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030029/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070030 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
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030033 is thus not distributed in source form. The binary pwcx.o module
Linus Torvalds1da177e2005-04-16 15:20:36 -070034 contains the code that falls under the NDA.
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030035
36 In case you're wondering: 'pwc' stands for "Philips WebCam", but
Linus Torvalds1da177e2005-04-16 15:20:36 -070037 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).
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -030040
Linus Torvalds1da177e2005-04-16 15:20:36 -070041 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 *
Hans de Goede9a7b2d12011-06-06 14:43:39 -030044 vdev: struct video_device (member of pwc_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -070045 pdev: struct pwc_devive *
46*/
47
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
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -030057 - Pham Thanh Nam: webcam snapshot button as an event input device
Linus Torvalds1da177e2005-04-16 15:20:36 -070058*/
59
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>
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -030066#ifdef CONFIG_USB_PWC_INPUT_EVDEV
67#include <linux/usb/input.h>
68#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -070069#include <linux/vmalloc.h>
70#include <asm/io.h>
Andy Shevchenko2d8d7762009-09-24 07:58:09 -030071#include <linux/kernel.h> /* simple_strtol() */
Linus Torvalds1da177e2005-04-16 15:20:36 -070072
73#include "pwc.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070074#include "pwc-kiara.h"
75#include "pwc-timon.h"
Luc Saillard2b455db2006-04-24 10:29:46 -030076#include "pwc-dec23.h"
77#include "pwc-dec1.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070078
79/* Function prototypes and driver templates */
80
81/* hotplug device table support */
Luc Saillard2b455db2006-04-24 10:29:46 -030082static const struct usb_device_id pwc_device_table [] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -070083 { USB_DEVICE(0x0471, 0x0302) }, /* Philips models */
84 { USB_DEVICE(0x0471, 0x0303) },
85 { USB_DEVICE(0x0471, 0x0304) },
86 { USB_DEVICE(0x0471, 0x0307) },
87 { USB_DEVICE(0x0471, 0x0308) },
88 { USB_DEVICE(0x0471, 0x030C) },
89 { USB_DEVICE(0x0471, 0x0310) },
Luc Saillard2b455db2006-04-24 10:29:46 -030090 { USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
Linus Torvalds1da177e2005-04-16 15:20:36 -070091 { USB_DEVICE(0x0471, 0x0312) },
92 { USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
Luc Saillard2b455db2006-04-24 10:29:46 -030093 { USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 { USB_DEVICE(0x069A, 0x0001) }, /* Askey */
95 { USB_DEVICE(0x046D, 0x08B0) }, /* Logitech QuickCam Pro 3000 */
96 { USB_DEVICE(0x046D, 0x08B1) }, /* Logitech QuickCam Notebook Pro */
97 { USB_DEVICE(0x046D, 0x08B2) }, /* Logitech QuickCam Pro 4000 */
98 { USB_DEVICE(0x046D, 0x08B3) }, /* Logitech QuickCam Zoom (old model) */
99 { USB_DEVICE(0x046D, 0x08B4) }, /* Logitech QuickCam Zoom (new model) */
100 { USB_DEVICE(0x046D, 0x08B5) }, /* Logitech QuickCam Orbit/Sphere */
Mauro Carvalho Chehab6b1ce3c2007-03-21 16:35:28 -0300101 { USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
102 { USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 { USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
Luc Saillard2b455db2006-04-24 10:29:46 -0300104 { USB_DEVICE(0x055D, 0x9000) }, /* Samsung MPC-C10 */
105 { USB_DEVICE(0x055D, 0x9001) }, /* Samsung MPC-C30 */
106 { USB_DEVICE(0x055D, 0x9002) }, /* Samsung SNC-35E (Ver3.0) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 { USB_DEVICE(0x041E, 0x400C) }, /* Creative Webcam 5 */
108 { USB_DEVICE(0x041E, 0x4011) }, /* Creative Webcam Pro Ex */
109 { USB_DEVICE(0x04CC, 0x8116) }, /* Afina Eye */
110 { USB_DEVICE(0x06BE, 0x8116) }, /* new Afina Eye */
111 { USB_DEVICE(0x0d81, 0x1910) }, /* Visionite */
112 { USB_DEVICE(0x0d81, 0x1900) },
113 { }
114};
115MODULE_DEVICE_TABLE(usb, pwc_device_table);
116
117static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
118static void usb_pwc_disconnect(struct usb_interface *intf);
Hans de Goede885fe182011-06-06 15:33:44 -0300119static void pwc_isoc_cleanup(struct pwc_device *pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120
121static struct usb_driver pwc_driver = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 .name = "Philips webcam", /* name */
123 .id_table = pwc_device_table,
124 .probe = usb_pwc_probe, /* probe() */
125 .disconnect = usb_pwc_disconnect, /* disconnect() */
126};
127
128#define MAX_DEV_HINTS 20
129#define MAX_ISOC_ERRORS 20
130
Trent Piepho05ad3902007-01-30 23:26:01 -0300131#ifdef CONFIG_USB_PWC_DEBUG
Michael Krufkyb930e1d2007-08-27 18:16:54 -0300132 int pwc_trace = PWC_DEBUG_LEVEL;
Luc Saillard2b455db2006-04-24 10:29:46 -0300133#endif
Hans de Goede3b4d0ec2011-06-26 03:51:19 -0300134static int power_save = -1;
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -0300135static int led_on = 100, led_off; /* defaults to LED that is on while in use */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136static struct {
137 int type;
138 char serial_number[30];
139 int device_node;
140 struct pwc_device *pdev;
141} device_hint[MAX_DEV_HINTS];
142
143/***/
144
Hans Verkuilbec43662008-12-30 06:58:20 -0300145static int pwc_video_close(struct file *file);
Luc Saillard2b455db2006-04-24 10:29:46 -0300146static ssize_t pwc_video_read(struct file *file, char __user *buf,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147 size_t count, loff_t *ppos);
148static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma);
150
Hans Verkuilbec43662008-12-30 06:58:20 -0300151static const struct v4l2_file_operations pwc_fops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 .owner = THIS_MODULE,
Hans de Goede76ae8532011-07-19 07:14:22 -0300153 .open = v4l2_fh_open,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154 .release = pwc_video_close,
155 .read = pwc_video_read,
156 .poll = pwc_video_poll,
157 .mmap = pwc_video_mmap,
Hans Verkuilafa38522011-01-22 06:34:55 -0300158 .unlocked_ioctl = video_ioctl2,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159};
160static struct video_device pwc_template = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161 .name = "Philips Webcam", /* Filled in later */
Hans de Goede76ae8532011-07-19 07:14:22 -0300162 .release = video_device_release_empty,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163 .fops = &pwc_fops,
Hans de Goede9a7b2d12011-06-06 14:43:39 -0300164 .ioctl_ops = &pwc_ioctl_ops,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165};
166
167/***************************************************************************/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168/* Private functions */
169
Hans de Goede885fe182011-06-06 15:33:44 -0300170struct pwc_frame_buf *pwc_get_next_fill_buf(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171{
Hans de Goede885fe182011-06-06 15:33:44 -0300172 unsigned long flags = 0;
173 struct pwc_frame_buf *buf = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174
Hans de Goede885fe182011-06-06 15:33:44 -0300175 spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
176 if (list_empty(&pdev->queued_bufs))
177 goto leave;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700178
Hans de Goede885fe182011-06-06 15:33:44 -0300179 buf = list_entry(pdev->queued_bufs.next, struct pwc_frame_buf, list);
180 list_del(&buf->list);
181leave:
182 spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
183 return buf;
Luc Saillard2b455db2006-04-24 10:29:46 -0300184}
185
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300186static void pwc_snapshot_button(struct pwc_device *pdev, int down)
187{
188 if (down) {
189 PWC_TRACE("Snapshot button pressed.\n");
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300190 } else {
191 PWC_TRACE("Snapshot button released.\n");
192 }
193
194#ifdef CONFIG_USB_PWC_INPUT_EVDEV
195 if (pdev->button_dev) {
Lennart Poetteringbcd3e4b2009-06-11 11:19:33 -0300196 input_report_key(pdev->button_dev, KEY_CAMERA, down);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300197 input_sync(pdev->button_dev);
198 }
199#endif
200}
201
Hans de Goede885fe182011-06-06 15:33:44 -0300202static void pwc_frame_complete(struct pwc_device *pdev)
Luc Saillard2b455db2006-04-24 10:29:46 -0300203{
Hans de Goede885fe182011-06-06 15:33:44 -0300204 struct pwc_frame_buf *fbuf = pdev->fill_buf;
Luc Saillard2b455db2006-04-24 10:29:46 -0300205
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.
209 */
210 if (pdev->type == 730) {
211 unsigned char *ptr = (unsigned char *)fbuf->data;
212
213 if (ptr[1] == 1 && ptr[0] & 0x10) {
214 PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
215 pdev->drop_frames += 2;
Luc Saillard2b455db2006-04-24 10:29:46 -0300216 }
217 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300218 pwc_snapshot_button(pdev, ptr[0] & 0x01);
Luc Saillard2b455db2006-04-24 10:29:46 -0300219 }
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");
225 }
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!
235 */
236 if (fbuf->filled == 4)
237 pdev->drop_frames++;
Hans de Goede885fe182011-06-06 15:33:44 -0300238 } else if (pdev->type == 740 || pdev->type == 720) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300239 unsigned char *ptr = (unsigned char *)fbuf->data;
240 if ((ptr[0] ^ pdev->vmirror) & 0x01) {
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300241 pwc_snapshot_button(pdev, ptr[0] & 0x01);
Luc Saillard2b455db2006-04-24 10:29:46 -0300242 }
243 pdev->vmirror = ptr[0] & 0x03;
244 }
245
Hans de Goede885fe182011-06-06 15:33:44 -0300246 /* In case we were instructed to drop the frame, do so silently. */
247 if (pdev->drop_frames > 0) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300248 pdev->drop_frames--;
Hans de Goede885fe182011-06-06 15:33:44 -0300249 } else {
Luc Saillard2b455db2006-04-24 10:29:46 -0300250 /* 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);
Hans de Goede885fe182011-06-06 15:33:44 -0300254 } 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;
Luc Saillard2b455db2006-04-24 10:29:46 -0300260 }
261 } /* !drop_frames */
262 pdev->vframe_count++;
Luc Saillard2b455db2006-04-24 10:29:46 -0300263}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264
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.
267 */
David Howells7d12e782006-10-05 14:55:46 +0100268static void pwc_isoc_handler(struct urb *urb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269{
Hans de Goede885fe182011-06-06 15:33:44 -0300270 struct pwc_device *pdev = (struct pwc_device *)urb->context;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 int i, fst, flen;
Hans de Goede885fe182011-06-06 15:33:44 -0300272 unsigned char *iso_buf = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273
Hans de Goede885fe182011-06-06 15:33:44 -0300274 if (urb->status == -ENOENT || urb->status == -ECONNRESET ||
275 urb->status == -ESHUTDOWN) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300276 PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277 return;
278 }
Hans de Goede885fe182011-06-06 15:33:44 -0300279
280 if (pdev->fill_buf == NULL)
281 pdev->fill_buf = pwc_get_next_fill_buf(pdev);
282
283 if (urb->status != 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284 const char *errmsg;
285
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;
Pete Zaitcev38e2bfc2006-09-18 22:49:02 -0700293 case -ETIME: errmsg = "Device does not respond"; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294 }
Hans de Goede885fe182011-06-06 15:33:44 -0300295 PWC_ERROR("pwc_isoc_handler() called with status %d [%s].\n",
296 urb->status, errmsg);
297 /* Give up after a number of contiguous errors */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
299 {
Hans de Goede885fe182011-06-06 15:33:44 -0300300 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;
305 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 }
Hans de Goede885fe182011-06-06 15:33:44 -0300307 pdev->vsync = 0; /* Drop the current frame */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308 goto handler_end;
309 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310
311 /* Reset ISOC error counter. We did get here, after all. */
312 pdev->visoc_errors = 0;
313
314 /* vsync: 0 = don't copy data
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300315 1 = sync-hunt
316 2 = synched
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317 */
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;
Hans de Goede885fe182011-06-06 15:33:44 -0300323 if (fst != 0) {
324 PWC_ERROR("Iso frame %d has error %d\n", i, fst);
325 continue;
326 }
327 if (flen > 0 && pdev->vsync) {
328 struct pwc_frame_buf *fbuf = pdev->fill_buf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329
Hans de Goede885fe182011-06-06 15:33:44 -0300330 if (pdev->vsync == 1) {
331 do_gettimeofday(&fbuf->vb.v4l2_buf.timestamp);
332 pdev->vsync = 2;
Luc Saillard2b455db2006-04-24 10:29:46 -0300333 }
334
Hans de Goede885fe182011-06-06 15:33:44 -0300335 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;
344 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 }
Hans de Goede885fe182011-06-06 15:33:44 -0300346 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;
355 }
356 }
357 pdev->vlast_packet_size = flen;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358 }
359
360handler_end:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 i = usb_submit_urb(urb, GFP_ATOMIC);
362 if (i != 0)
Luc Saillard2b455db2006-04-24 10:29:46 -0300363 PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364}
365
Hans de Goede885fe182011-06-06 15:33:44 -0300366static int pwc_isoc_init(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367{
368 struct usb_device *udev;
369 struct urb *urb;
370 int i, j, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 struct usb_interface *intf;
372 struct usb_host_interface *idesc = NULL;
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300373 int compression = 0; /* 0..3 = uncompressed..high */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375 if (pdev->iso_init)
376 return 0;
Hans de Goede6eba9352011-06-26 06:49:59 -0300377
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378 pdev->vsync = 0;
Hans de Goede6eba9352011-06-26 06:49:59 -0300379 pdev->vlast_packet_size = 0;
Hans de Goede885fe182011-06-06 15:33:44 -0300380 pdev->fill_buf = NULL;
381 pdev->vframe_count = 0;
Hans de Goede6eba9352011-06-26 06:49:59 -0300382 pdev->visoc_errors = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383 udev = pdev->udev;
384
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300385retry:
386 /* We first try with low compression and then retry with a higher
387 compression setting if there is not enough bandwidth. */
Hans de Goede938d5b92012-01-10 13:14:46 -0300388 ret = pwc_set_video_mode(pdev, pdev->width, pdev->height, pdev->pixfmt,
389 pdev->vframes, &compression, 1);
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300390
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 /* Get the current alternate interface, adjust packet size */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 intf = usb_ifnum_to_if(udev, 0);
393 if (intf)
394 idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 if (!idesc)
Hans de Goedec2464122011-06-06 15:25:18 -0300396 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397
398 /* Search video endpoint */
399 pdev->vmax_packet_size = -1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300400 for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
402 pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
403 break;
404 }
Luc Saillard2b455db2006-04-24 10:29:46 -0300405 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300406
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407 if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300408 PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
Steven Cole093cf722005-05-03 19:07:24 -0600409 return -ENFILE; /* Odd error, that should be noticeable */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 }
411
412 /* Set alternate interface */
Luc Saillard2b455db2006-04-24 10:29:46 -0300413 PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414 ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300415 if (ret == -ENOSPC && compression < 3) {
416 compression++;
417 goto retry;
418 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 if (ret < 0)
420 return ret;
421
Hans de Goede04613c52011-06-26 13:57:15 -0300422 /* Allocate and init Isochronuous urbs */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423 for (i = 0; i < MAX_ISO_BUFS; i++) {
424 urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
425 if (urb == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300426 PWC_ERROR("Failed to allocate urb %d\n", i);
Hans de Goede6eba9352011-06-26 06:49:59 -0300427 pdev->iso_init = 1;
428 pwc_isoc_cleanup(pdev);
429 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700430 }
Hans de Goede04613c52011-06-26 13:57:15 -0300431 pdev->urbs[i] = urb;
Luc Saillard2b455db2006-04-24 10:29:46 -0300432 PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433
434 urb->interval = 1; // devik
435 urb->dev = udev;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300436 urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
Hans de Goede04613c52011-06-26 13:57:15 -0300437 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;
447 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300448 urb->transfer_buffer_length = ISO_BUFFER_SIZE;
449 urb->complete = pwc_isoc_handler;
450 urb->context = pdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 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;
456 }
457 }
458
459 /* link */
460 for (i = 0; i < MAX_ISO_BUFS; i++) {
Hans de Goede04613c52011-06-26 13:57:15 -0300461 ret = usb_submit_urb(pdev->urbs[i], GFP_KERNEL);
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300462 if (ret == -ENOSPC && compression < 3) {
463 compression++;
464 pdev->iso_init = 1;
465 pwc_isoc_cleanup(pdev);
466 goto retry;
467 }
Hans de Goede622d9f52010-11-16 12:32:09 -0300468 if (ret) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300469 PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
Hans de Goede622d9f52010-11-16 12:32:09 -0300470 pdev->iso_init = 1;
471 pwc_isoc_cleanup(pdev);
472 return ret;
473 }
Hans de Goede04613c52011-06-26 13:57:15 -0300474 PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->urbs[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 }
476
477 /* All is done... */
478 pdev->iso_init = 1;
Luc Saillard2b455db2006-04-24 10:29:46 -0300479 PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480 return 0;
481}
482
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300483static void pwc_iso_stop(struct pwc_device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484{
485 int i;
486
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487 /* Unlinking ISOC buffers one by one */
488 for (i = 0; i < MAX_ISO_BUFS; i++) {
Hans de Goede04613c52011-06-26 13:57:15 -0300489 if (pdev->urbs[i]) {
490 PWC_DEBUG_MEMORY("Unlinking URB %p\n", pdev->urbs[i]);
491 usb_kill_urb(pdev->urbs[i]);
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300492 }
493 }
494}
495
496static void pwc_iso_free(struct pwc_device *pdev)
497{
498 int i;
499
500 /* Freeing ISOC buffers one by one */
501 for (i = 0; i < MAX_ISO_BUFS; i++) {
Hans de Goede04613c52011-06-26 13:57:15 -0300502 if (pdev->urbs[i]) {
Luc Saillard2b455db2006-04-24 10:29:46 -0300503 PWC_DEBUG_MEMORY("Freeing URB\n");
Hans de Goede04613c52011-06-26 13:57:15 -0300504 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);
509 }
510 usb_free_urb(pdev->urbs[i]);
511 pdev->urbs[i] = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512 }
513 }
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300514}
515
Hans de Goede885fe182011-06-06 15:33:44 -0300516static void pwc_isoc_cleanup(struct pwc_device *pdev)
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300517{
518 PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
Hans de Goedec2464122011-06-06 15:25:18 -0300519
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300520 if (pdev->iso_init == 0)
521 return;
522
523 pwc_iso_stop(pdev);
524 pwc_iso_free(pdev);
Hans de Goedeb824bb42011-06-25 17:39:19 -0300525 usb_set_interface(pdev->udev, 0, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526
527 pdev->iso_init = 0;
Luc Saillard2b455db2006-04-24 10:29:46 -0300528 PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529}
530
Hans de Goede885fe182011-06-06 15:33:44 -0300531static void pwc_cleanup_queued_bufs(struct pwc_device *pdev)
532{
Hans de Goedec20d78c2011-10-09 09:16:46 -0300533 unsigned long flags = 0;
534
535 spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
Hans de Goede885fe182011-06-06 15:33:44 -0300536 while (!list_empty(&pdev->queued_bufs)) {
537 struct pwc_frame_buf *buf;
538
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);
543 }
Hans de Goedec20d78c2011-10-09 09:16:46 -0300544 spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
Hans de Goede885fe182011-06-06 15:33:44 -0300545}
546
Trent Piepho05ad3902007-01-30 23:26:01 -0300547#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -0300548static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
549{
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:
Trent Piepho657de3c2006-06-20 00:30:57 -0300572 return "unknown type of sensor";
Luc Saillard2b455db2006-04-24 10:29:46 -0300573 }
574}
575#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576
577/***************************************************************************/
578/* Video4Linux functions */
579
Hans de Goedec20d78c2011-10-09 09:16:46 -0300580int pwc_test_n_set_capt_file(struct pwc_device *pdev, struct file *file)
581{
582 int r = 0;
583
584 mutex_lock(&pdev->capt_file_lock);
585 if (pdev->capt_file != NULL &&
586 pdev->capt_file != file) {
587 r = -EBUSY;
588 goto leave;
589 }
590 pdev->capt_file = file;
591leave:
592 mutex_unlock(&pdev->capt_file_lock);
593 return r;
594}
595
Hans de Goede76ae8532011-07-19 07:14:22 -0300596static void pwc_video_release(struct v4l2_device *v)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597{
Hans de Goede76ae8532011-07-19 07:14:22 -0300598 struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
Hans de Goede9a7b2d12011-06-06 14:43:39 -0300599 int hint;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -0300600
Hans de Goede9a7b2d12011-06-06 14:43:39 -0300601 /* 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;
Dmitry Torokhov89dec012009-08-14 02:22:52 -0300605
Hans de Goede6c9cac82011-06-26 12:52:01 -0300606 v4l2_ctrl_handler_free(&pdev->ctrl_handler);
607
Hans de Goede24be6892012-01-10 17:02:04 -0300608 kfree(pdev->ctrl_buf);
Dmitry Torokhov89dec012009-08-14 02:22:52 -0300609 kfree(pdev);
Oliver Neukum85237f22007-08-21 07:10:42 +0200610}
611
Hans Verkuilbec43662008-12-30 06:58:20 -0300612static int pwc_video_close(struct file *file)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613{
Hans de Goede76ae8532011-07-19 07:14:22 -0300614 struct pwc_device *pdev = video_drvdata(file);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615
Hans de Goede4fba4712011-06-26 12:13:44 -0300616 if (pdev->capt_file == file) {
617 vb2_queue_release(&pdev->vb_queue);
618 pdev->capt_file = NULL;
619 }
Hans de Goede76ae8532011-07-19 07:14:22 -0300620 return v4l2_fh_release(file);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621}
622
Luc Saillard2b455db2006-04-24 10:29:46 -0300623static ssize_t pwc_video_read(struct file *file, char __user *buf,
Hans de Goede885fe182011-06-06 15:33:44 -0300624 size_t count, loff_t *ppos)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625{
Hans de Goede76ae8532011-07-19 07:14:22 -0300626 struct pwc_device *pdev = video_drvdata(file);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627
Hans de Goedeb824bb42011-06-25 17:39:19 -0300628 if (!pdev->udev)
629 return -ENODEV;
Oliver Neukum0b67f5c2007-09-26 10:19:01 -0300630
Hans de Goedec20d78c2011-10-09 09:16:46 -0300631 if (pwc_test_n_set_capt_file(pdev, file))
Hans de Goede4fba4712011-06-26 12:13:44 -0300632 return -EBUSY;
633
Hans de Goede885fe182011-06-06 15:33:44 -0300634 return vb2_read(&pdev->vb_queue, buf, count, ppos,
635 file->f_flags & O_NONBLOCK);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636}
637
638static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
639{
Hans de Goede76ae8532011-07-19 07:14:22 -0300640 struct pwc_device *pdev = video_drvdata(file);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641
Hans de Goedeb824bb42011-06-25 17:39:19 -0300642 if (!pdev->udev)
Hans de Goede885fe182011-06-06 15:33:44 -0300643 return POLL_ERR;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644
Hans de Goede885fe182011-06-06 15:33:44 -0300645 return vb2_poll(&pdev->vb_queue, file, wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646}
647
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
649{
Hans de Goede76ae8532011-07-19 07:14:22 -0300650 struct pwc_device *pdev = video_drvdata(file);
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300651
Hans de Goede4fba4712011-06-26 12:13:44 -0300652 if (pdev->capt_file != file)
653 return -EBUSY;
654
Hans de Goede885fe182011-06-06 15:33:44 -0300655 return vb2_mmap(&pdev->vb_queue, vma);
656}
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300657
Hans de Goede885fe182011-06-06 15:33:44 -0300658/***************************************************************************/
659/* Videobuf2 operations */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660
Guennadi Liakhovetskifc714e702011-08-24 10:30:21 -0300661static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt,
662 unsigned int *nbuffers, unsigned int *nplanes,
663 unsigned int sizes[], void *alloc_ctxs[])
Hans de Goede885fe182011-06-06 15:33:44 -0300664{
665 struct pwc_device *pdev = vb2_get_drv_priv(vq);
Hans de Goede795e6eb2012-01-04 16:58:44 -0300666 int size;
Luc Saillard2b455db2006-04-24 10:29:46 -0300667
Hans de Goede885fe182011-06-06 15:33:44 -0300668 if (*nbuffers < MIN_FRAMES)
669 *nbuffers = MIN_FRAMES;
670 else if (*nbuffers > MAX_FRAMES)
671 *nbuffers = MAX_FRAMES;
672
673 *nplanes = 1;
674
Hans de Goede795e6eb2012-01-04 16:58:44 -0300675 size = pwc_get_size(pdev, MAX_WIDTH, MAX_HEIGHT);
676 sizes[0] = PAGE_ALIGN(pwc_image_sizes[size][0] *
677 pwc_image_sizes[size][1] * 3 / 2);
Hans de Goede885fe182011-06-06 15:33:44 -0300678
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 return 0;
680}
681
Hans de Goede885fe182011-06-06 15:33:44 -0300682static int buffer_init(struct vb2_buffer *vb)
683{
684 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
685
686 /* need vmalloc since frame buffer > 128K */
687 buf->data = vzalloc(PWC_FRAME_SIZE);
688 if (buf->data == NULL)
689 return -ENOMEM;
690
691 return 0;
692}
693
694static int buffer_prepare(struct vb2_buffer *vb)
695{
696 struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
697
698 /* Don't allow queing new buffers after device disconnection */
Hans de Goedeb824bb42011-06-25 17:39:19 -0300699 if (!pdev->udev)
700 return -ENODEV;
Hans de Goede885fe182011-06-06 15:33:44 -0300701
702 return 0;
703}
704
705static int buffer_finish(struct vb2_buffer *vb)
706{
707 struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
708 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
709
710 /*
711 * Application has called dqbuf and is getting back a buffer we've
712 * filled, take the pwc data we've stored in buf->data and decompress
713 * it into a usable format, storing the result in the vb2_buffer
714 */
715 return pwc_decompress(pdev, buf);
716}
717
718static void buffer_cleanup(struct vb2_buffer *vb)
719{
720 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
721
722 vfree(buf->data);
723}
724
725static void buffer_queue(struct vb2_buffer *vb)
726{
727 struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
728 struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
729 unsigned long flags = 0;
730
731 spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
Hans de Goedec20d78c2011-10-09 09:16:46 -0300732 /* Check the device has not disconnected between prep and queuing */
733 if (pdev->udev)
734 list_add_tail(&buf->list, &pdev->queued_bufs);
735 else
736 vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR);
Hans de Goede885fe182011-06-06 15:33:44 -0300737 spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
738}
739
Marek Szyprowskibd323e22011-08-29 08:51:49 -0300740static int start_streaming(struct vb2_queue *vq, unsigned int count)
Hans de Goede885fe182011-06-06 15:33:44 -0300741{
742 struct pwc_device *pdev = vb2_get_drv_priv(vq);
Hans de Goedec20d78c2011-10-09 09:16:46 -0300743 int r;
Hans de Goede885fe182011-06-06 15:33:44 -0300744
Hans de Goedec20d78c2011-10-09 09:16:46 -0300745 mutex_lock(&pdev->udevlock);
746 if (!pdev->udev) {
747 r = -ENODEV;
748 goto leave;
749 }
Hans de Goedeb824bb42011-06-25 17:39:19 -0300750
Hans de Goede6eba9352011-06-26 06:49:59 -0300751 /* Turn on camera and set LEDS on */
752 pwc_camera_power(pdev, 1);
Hans de Goede6eba9352011-06-26 06:49:59 -0300753 pwc_set_leds(pdev, led_on, led_off);
754
Hans de Goedec20d78c2011-10-09 09:16:46 -0300755 r = pwc_isoc_init(pdev);
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300756 if (r) {
757 /* If we failed turn camera and LEDS back off */
758 pwc_set_leds(pdev, 0, 0);
759 pwc_camera_power(pdev, 0);
760 /* And cleanup any queued bufs!! */
761 pwc_cleanup_queued_bufs(pdev);
762 }
Hans de Goedec20d78c2011-10-09 09:16:46 -0300763leave:
764 mutex_unlock(&pdev->udevlock);
765 return r;
Hans de Goede885fe182011-06-06 15:33:44 -0300766}
767
768static int stop_streaming(struct vb2_queue *vq)
769{
770 struct pwc_device *pdev = vb2_get_drv_priv(vq);
771
Hans de Goedec20d78c2011-10-09 09:16:46 -0300772 mutex_lock(&pdev->udevlock);
Hans de Goede6eba9352011-06-26 06:49:59 -0300773 if (pdev->udev) {
774 pwc_set_leds(pdev, 0, 0);
775 pwc_camera_power(pdev, 0);
Hans de Goedeb824bb42011-06-25 17:39:19 -0300776 pwc_isoc_cleanup(pdev);
Hans de Goede6eba9352011-06-26 06:49:59 -0300777 }
Hans de Goedec20d78c2011-10-09 09:16:46 -0300778 mutex_unlock(&pdev->udevlock);
779
Hans de Goede885fe182011-06-06 15:33:44 -0300780 pwc_cleanup_queued_bufs(pdev);
781
782 return 0;
783}
784
Hans de Goede885fe182011-06-06 15:33:44 -0300785static struct vb2_ops pwc_vb_queue_ops = {
786 .queue_setup = queue_setup,
787 .buf_init = buffer_init,
788 .buf_prepare = buffer_prepare,
789 .buf_finish = buffer_finish,
790 .buf_cleanup = buffer_cleanup,
791 .buf_queue = buffer_queue,
792 .start_streaming = start_streaming,
793 .stop_streaming = stop_streaming,
Hans de Goede885fe182011-06-06 15:33:44 -0300794};
795
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796/***************************************************************************/
797/* USB functions */
798
799/* This function gets called when a new device is plugged in or the usb core
800 * is loaded.
801 */
802
803static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
804{
805 struct usb_device *udev = interface_to_usbdev(intf);
806 struct pwc_device *pdev = NULL;
807 int vendor_id, product_id, type_id;
Dmitry Torokhov89dec012009-08-14 02:22:52 -0300808 int hint, rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 int features = 0;
Hans de Goede5bbe18d2012-01-04 18:48:05 -0300810 int compression = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 int video_nr = -1; /* default: use next available device */
Hans de Goede3b4d0ec2011-06-26 03:51:19 -0300812 int my_power_save = power_save;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813 char serial_number[30], *name;
814
Luc Saillard2b455db2006-04-24 10:29:46 -0300815 vendor_id = le16_to_cpu(udev->descriptor.idVendor);
816 product_id = le16_to_cpu(udev->descriptor.idProduct);
817
Linus Torvalds1da177e2005-04-16 15:20:36 -0700818 /* Check if we can handle this device */
Luc Saillard2b455db2006-04-24 10:29:46 -0300819 PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
820 vendor_id, product_id,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 intf->altsetting->desc.bInterfaceNumber);
822
823 /* the interfaces are probed one by one. We are only interested in the
824 video interface (0) now.
825 Interface 1 is the Audio Control, and interface 2 Audio itself.
826 */
827 if (intf->altsetting->desc.bInterfaceNumber > 0)
828 return -ENODEV;
829
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830 if (vendor_id == 0x0471) {
831 switch (product_id) {
832 case 0x0302:
Luc Saillard2b455db2006-04-24 10:29:46 -0300833 PWC_INFO("Philips PCA645VC USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834 name = "Philips 645 webcam";
835 type_id = 645;
836 break;
837 case 0x0303:
Luc Saillard2b455db2006-04-24 10:29:46 -0300838 PWC_INFO("Philips PCA646VC USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839 name = "Philips 646 webcam";
840 type_id = 646;
841 break;
842 case 0x0304:
Luc Saillard2b455db2006-04-24 10:29:46 -0300843 PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 name = "Askey VC010 webcam";
845 type_id = 646;
846 break;
847 case 0x0307:
Luc Saillard2b455db2006-04-24 10:29:46 -0300848 PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849 name = "Philips 675 webcam";
850 type_id = 675;
851 break;
852 case 0x0308:
Luc Saillard2b455db2006-04-24 10:29:46 -0300853 PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854 name = "Philips 680 webcam";
855 type_id = 680;
856 break;
857 case 0x030C:
Luc Saillard2b455db2006-04-24 10:29:46 -0300858 PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700859 name = "Philips 690 webcam";
860 type_id = 690;
861 break;
862 case 0x0310:
Luc Saillard2b455db2006-04-24 10:29:46 -0300863 PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864 name = "Philips 730 webcam";
865 type_id = 730;
866 break;
867 case 0x0311:
Luc Saillard2b455db2006-04-24 10:29:46 -0300868 PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700869 name = "Philips 740 webcam";
870 type_id = 740;
871 break;
872 case 0x0312:
Luc Saillard2b455db2006-04-24 10:29:46 -0300873 PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874 name = "Philips 750 webcam";
875 type_id = 750;
876 break;
877 case 0x0313:
Luc Saillard2b455db2006-04-24 10:29:46 -0300878 PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879 name = "Philips 720K/40 webcam";
880 type_id = 720;
881 break;
Luc Saillard2b455db2006-04-24 10:29:46 -0300882 case 0x0329:
883 PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
884 name = "Philips SPC 900NC webcam";
Luc Saillard9ee6d782007-04-22 23:54:36 -0300885 type_id = 740;
Luc Saillard2b455db2006-04-24 10:29:46 -0300886 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700887 default:
888 return -ENODEV;
889 break;
890 }
891 }
892 else if (vendor_id == 0x069A) {
893 switch(product_id) {
894 case 0x0001:
Luc Saillard2b455db2006-04-24 10:29:46 -0300895 PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896 name = "Askey VC010 webcam";
897 type_id = 645;
898 break;
899 default:
900 return -ENODEV;
901 break;
902 }
903 }
904 else if (vendor_id == 0x046d) {
905 switch(product_id) {
906 case 0x08b0:
Luc Saillard2b455db2006-04-24 10:29:46 -0300907 PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700908 name = "Logitech QuickCam Pro 3000";
909 type_id = 740; /* CCD sensor */
910 break;
911 case 0x08b1:
Luc Saillard2b455db2006-04-24 10:29:46 -0300912 PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913 name = "Logitech QuickCam Notebook Pro";
914 type_id = 740; /* CCD sensor */
915 break;
916 case 0x08b2:
Luc Saillard2b455db2006-04-24 10:29:46 -0300917 PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700918 name = "Logitech QuickCam Pro 4000";
919 type_id = 740; /* CCD sensor */
Hans de Goede51886df2011-07-03 15:52:54 -0300920 if (my_power_save == -1)
921 my_power_save = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922 break;
923 case 0x08b3:
Luc Saillard2b455db2006-04-24 10:29:46 -0300924 PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700925 name = "Logitech QuickCam Zoom";
926 type_id = 740; /* CCD sensor */
927 break;
928 case 0x08B4:
Luc Saillard2b455db2006-04-24 10:29:46 -0300929 PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700930 name = "Logitech QuickCam Zoom";
931 type_id = 740; /* CCD sensor */
Hans de Goede3b4d0ec2011-06-26 03:51:19 -0300932 if (my_power_save == -1)
933 my_power_save = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700934 break;
935 case 0x08b5:
Luc Saillard2b455db2006-04-24 10:29:46 -0300936 PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 name = "Logitech QuickCam Orbit";
938 type_id = 740; /* CCD sensor */
Hans de Goede51886df2011-07-03 15:52:54 -0300939 if (my_power_save == -1)
940 my_power_save = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941 features |= FEATURE_MOTOR_PANTILT;
942 break;
943 case 0x08b6:
Jean Tourrilhesa63e1572007-03-21 16:29:16 -0300944 PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
945 name = "Cisco VT Camera";
946 type_id = 740; /* CCD sensor */
947 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700948 case 0x08b7:
Mauro Carvalho Chehab6b1ce3c2007-03-21 16:35:28 -0300949 PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
950 name = "Logitech ViewPort AV 100";
951 type_id = 740; /* CCD sensor */
952 break;
953 case 0x08b8: /* Where this released? */
Luc Saillard2b455db2006-04-24 10:29:46 -0300954 PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955 name = "Logitech QuickCam (res.)";
956 type_id = 730; /* Assuming CMOS */
957 break;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300958 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 return -ENODEV;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300960 break;
961 }
962 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700963 else if (vendor_id == 0x055d) {
964 /* I don't know the difference between the C10 and the C30;
965 I suppose the difference is the sensor, but both cameras
966 work equally well with a type_id of 675
967 */
968 switch(product_id) {
969 case 0x9000:
Luc Saillard2b455db2006-04-24 10:29:46 -0300970 PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 name = "Samsung MPC-C10";
972 type_id = 675;
973 break;
974 case 0x9001:
Luc Saillard2b455db2006-04-24 10:29:46 -0300975 PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700976 name = "Samsung MPC-C30";
977 type_id = 675;
978 break;
Luc Saillard2b455db2006-04-24 10:29:46 -0300979 case 0x9002:
980 PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
981 name = "Samsung MPC-C30";
982 type_id = 740;
983 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700984 default:
985 return -ENODEV;
986 break;
987 }
988 }
989 else if (vendor_id == 0x041e) {
990 switch(product_id) {
991 case 0x400c:
Luc Saillard2b455db2006-04-24 10:29:46 -0300992 PWC_INFO("Creative Labs Webcam 5 detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 name = "Creative Labs Webcam 5";
994 type_id = 730;
Hans de Goede51886df2011-07-03 15:52:54 -0300995 if (my_power_save == -1)
996 my_power_save = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997 break;
998 case 0x4011:
Luc Saillard2b455db2006-04-24 10:29:46 -0300999 PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000 name = "Creative Labs Webcam Pro Ex";
1001 type_id = 740;
1002 break;
1003 default:
1004 return -ENODEV;
1005 break;
1006 }
1007 }
1008 else if (vendor_id == 0x04cc) {
1009 switch(product_id) {
1010 case 0x8116:
Luc Saillard2b455db2006-04-24 10:29:46 -03001011 PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012 name = "Sotec Afina Eye";
1013 type_id = 730;
1014 break;
1015 default:
1016 return -ENODEV;
1017 break;
1018 }
1019 }
1020 else if (vendor_id == 0x06be) {
1021 switch(product_id) {
1022 case 0x8116:
1023 /* This is essentially the same cam as the Sotec Afina Eye */
Luc Saillard2b455db2006-04-24 10:29:46 -03001024 PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025 name = "AME Co. Afina Eye";
1026 type_id = 750;
1027 break;
1028 default:
1029 return -ENODEV;
1030 break;
1031 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001032
Linus Torvalds1da177e2005-04-16 15:20:36 -07001033 }
1034 else if (vendor_id == 0x0d81) {
1035 switch(product_id) {
1036 case 0x1900:
Luc Saillard2b455db2006-04-24 10:29:46 -03001037 PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001038 name = "Visionite VCS-UC300";
1039 type_id = 740; /* CCD sensor */
1040 break;
1041 case 0x1910:
Luc Saillard2b455db2006-04-24 10:29:46 -03001042 PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043 name = "Visionite VCS-UM100";
1044 type_id = 730; /* CMOS sensor */
1045 break;
1046 default:
1047 return -ENODEV;
1048 break;
1049 }
1050 }
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001051 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001052 return -ENODEV; /* Not any of the know types; but the list keeps growing. */
1053
Hans de Goede3b4d0ec2011-06-26 03:51:19 -03001054 if (my_power_save == -1)
1055 my_power_save = 0;
1056
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 memset(serial_number, 0, 30);
1058 usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
Luc Saillard2b455db2006-04-24 10:29:46 -03001059 PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001060
1061 if (udev->descriptor.bNumConfigurations > 1)
Luc Saillard2b455db2006-04-24 10:29:46 -03001062 PWC_WARNING("Warning: more than 1 configuration available.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001063
1064 /* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
Eric Sesterhenn80b6ca42006-02-27 21:29:43 +01001065 pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066 if (pdev == NULL) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001067 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 return -ENOMEM;
1069 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 pdev->type = type_id;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071 pdev->features = features;
Hans de Goede3b4d0ec2011-06-26 03:51:19 -03001072 pwc_construct(pdev); /* set min/max sizes correct */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073
Hans de Goedec20d78c2011-10-09 09:16:46 -03001074 mutex_init(&pdev->capt_file_lock);
Hans de Goedec1127132011-07-03 11:50:51 -03001075 mutex_init(&pdev->udevlock);
Hans de Goede885fe182011-06-06 15:33:44 -03001076 spin_lock_init(&pdev->queued_bufs_lock);
1077 INIT_LIST_HEAD(&pdev->queued_bufs);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001078
1079 pdev->udev = udev;
Hans de Goede3b4d0ec2011-06-26 03:51:19 -03001080 pdev->power_save = my_power_save;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001081
Hans de Goede885fe182011-06-06 15:33:44 -03001082 /* Init videobuf2 queue structure */
1083 memset(&pdev->vb_queue, 0, sizeof(pdev->vb_queue));
1084 pdev->vb_queue.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1085 pdev->vb_queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_READ;
1086 pdev->vb_queue.drv_priv = pdev;
1087 pdev->vb_queue.buf_struct_size = sizeof(struct pwc_frame_buf);
1088 pdev->vb_queue.ops = &pwc_vb_queue_ops;
1089 pdev->vb_queue.mem_ops = &vb2_vmalloc_memops;
1090 vb2_queue_init(&pdev->vb_queue);
1091
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001092 /* Init video_device structure */
1093 memcpy(&pdev->vdev, &pwc_template, sizeof(pwc_template));
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001094 strcpy(pdev->vdev.name, name);
Hans de Goede76ae8532011-07-19 07:14:22 -03001095 set_bit(V4L2_FL_USE_FH_PRIO, &pdev->vdev.flags);
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001096 video_set_drvdata(&pdev->vdev, pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001097
1098 pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
Luc Saillard2b455db2006-04-24 10:29:46 -03001099 PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001100
1101 /* Now search device_hint[] table for a match, so we can hint a node number. */
1102 for (hint = 0; hint < MAX_DEV_HINTS; hint++) {
1103 if (((device_hint[hint].type == -1) || (device_hint[hint].type == pdev->type)) &&
1104 (device_hint[hint].pdev == NULL)) {
1105 /* so far, so good... try serial number */
1106 if ((device_hint[hint].serial_number[0] == '*') || !strcmp(device_hint[hint].serial_number, serial_number)) {
Trent Piepho657de3c2006-06-20 00:30:57 -03001107 /* match! */
1108 video_nr = device_hint[hint].device_node;
1109 PWC_DEBUG_PROBE("Found hint, will try to register as /dev/video%d\n", video_nr);
1110 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111 }
1112 }
1113 }
1114
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115 /* occupy slot */
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001116 if (hint < MAX_DEV_HINTS)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117 device_hint[hint].pdev = pdev;
1118
Hans de Goede24be6892012-01-10 17:02:04 -03001119 /* Allocate USB command buffers */
1120 pdev->ctrl_buf = kmalloc(sizeof(pdev->cmd_buf), GFP_KERNEL);
1121 if (!pdev->ctrl_buf) {
1122 PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
1123 rc = -ENOMEM;
1124 goto err_free_mem;
1125 }
1126
Hans de Goede6eba9352011-06-26 06:49:59 -03001127#ifdef CONFIG_USB_PWC_DEBUG
1128 /* Query sensor type */
1129 if (pwc_get_cmos_sensor(pdev, &rc) >= 0) {
1130 PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
1131 pdev->vdev.name,
1132 pwc_sensor_type_to_string(rc), rc);
1133 }
1134#endif
1135
Luc Saillard2b455db2006-04-24 10:29:46 -03001136 /* Set the leds off */
1137 pwc_set_leds(pdev, 0, 0);
Hans de Goede6eba9352011-06-26 06:49:59 -03001138
1139 /* Setup intial videomode */
Hans de Goeded167a852012-01-10 13:01:41 -03001140 rc = pwc_set_video_mode(pdev, MAX_WIDTH, MAX_HEIGHT,
Hans de Goede938d5b92012-01-10 13:14:46 -03001141 V4L2_PIX_FMT_YUV420, 30, &compression, 1);
Hans de Goede6eba9352011-06-26 06:49:59 -03001142 if (rc)
1143 goto err_free_mem;
1144
Hans de Goede6c9cac82011-06-26 12:52:01 -03001145 /* Register controls (and read default values from camera */
1146 rc = pwc_init_controls(pdev);
1147 if (rc) {
1148 PWC_ERROR("Failed to register v4l2 controls (%d).\n", rc);
1149 goto err_free_mem;
1150 }
1151
Hans de Goede6eba9352011-06-26 06:49:59 -03001152 /* And powerdown the camera until streaming starts */
Luc Saillard2b455db2006-04-24 10:29:46 -03001153 pwc_camera_power(pdev, 0);
1154
Hans de Goede76ae8532011-07-19 07:14:22 -03001155 /* Register the v4l2_device structure */
1156 pdev->v4l2_dev.release = pwc_video_release;
1157 rc = v4l2_device_register(&intf->dev, &pdev->v4l2_dev);
1158 if (rc) {
1159 PWC_ERROR("Failed to register v4l2-device (%d).\n", rc);
1160 goto err_free_controls;
1161 }
1162
1163 pdev->v4l2_dev.ctrl_handler = &pdev->ctrl_handler;
1164 pdev->vdev.v4l2_dev = &pdev->v4l2_dev;
1165
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001166 rc = video_register_device(&pdev->vdev, VFL_TYPE_GRABBER, video_nr);
Hans Verkuil479567c2010-09-12 17:05:11 -03001167 if (rc < 0) {
1168 PWC_ERROR("Failed to register as video device (%d).\n", rc);
Hans de Goede76ae8532011-07-19 07:14:22 -03001169 goto err_unregister_v4l2_dev;
Hans Verkuil479567c2010-09-12 17:05:11 -03001170 }
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001171 PWC_INFO("Registered as %s.\n", video_device_node_name(&pdev->vdev));
Hans Verkuil479567c2010-09-12 17:05:11 -03001172
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001173#ifdef CONFIG_USB_PWC_INPUT_EVDEV
1174 /* register webcam snapshot button input device */
1175 pdev->button_dev = input_allocate_device();
1176 if (!pdev->button_dev) {
1177 PWC_ERROR("Err, insufficient memory for webcam snapshot button device.");
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001178 rc = -ENOMEM;
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001179 goto err_video_unreg;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001180 }
1181
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001182 usb_make_path(udev, pdev->button_phys, sizeof(pdev->button_phys));
1183 strlcat(pdev->button_phys, "/input0", sizeof(pdev->button_phys));
1184
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001185 pdev->button_dev->name = "PWC snapshot button";
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001186 pdev->button_dev->phys = pdev->button_phys;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001187 usb_to_input_id(pdev->udev, &pdev->button_dev->id);
1188 pdev->button_dev->dev.parent = &pdev->udev->dev;
1189 pdev->button_dev->evbit[0] = BIT_MASK(EV_KEY);
Lennart Poetteringbcd3e4b2009-06-11 11:19:33 -03001190 pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001191
1192 rc = input_register_device(pdev->button_dev);
1193 if (rc) {
1194 input_free_device(pdev->button_dev);
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001195 pdev->button_dev = NULL;
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001196 goto err_video_unreg;
Nam Phạm Thànhe32a7ecc2009-01-12 02:50:17 -03001197 }
1198#endif
1199
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 return 0;
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001201
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001202err_video_unreg:
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001203 video_unregister_device(&pdev->vdev);
Hans de Goede76ae8532011-07-19 07:14:22 -03001204err_unregister_v4l2_dev:
1205 v4l2_device_unregister(&pdev->v4l2_dev);
Hans de Goede6c9cac82011-06-26 12:52:01 -03001206err_free_controls:
1207 v4l2_ctrl_handler_free(&pdev->ctrl_handler);
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001208err_free_mem:
Hans de Goede32c67ec2011-07-19 09:05:49 -03001209 if (hint < MAX_DEV_HINTS)
1210 device_hint[hint].pdev = NULL;
Hans de Goede24be6892012-01-10 17:02:04 -03001211 kfree(pdev->ctrl_buf);
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001212 kfree(pdev);
Jeff Garzikc12e3be2006-10-13 07:17:32 -03001213 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001214}
1215
Dmitry Torokhov89dec012009-08-14 02:22:52 -03001216/* The user yanked out the cable... */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001217static void usb_pwc_disconnect(struct usb_interface *intf)
1218{
Hans de Goede76ae8532011-07-19 07:14:22 -03001219 struct v4l2_device *v = usb_get_intfdata(intf);
1220 struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001221
Hans de Goedec1127132011-07-03 11:50:51 -03001222 mutex_lock(&pdev->udevlock);
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001223 /* No need to keep the urbs around after disconnection */
1224 pwc_isoc_cleanup(pdev);
Hans de Goedeb824bb42011-06-25 17:39:19 -03001225 pdev->udev = NULL;
Hans de Goedec1127132011-07-03 11:50:51 -03001226 mutex_unlock(&pdev->udevlock);
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001227
Hans de Goedec20d78c2011-10-09 09:16:46 -03001228 pwc_cleanup_queued_bufs(pdev);
1229
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001230 video_unregister_device(&pdev->vdev);
Hans de Goede76ae8532011-07-19 07:14:22 -03001231 v4l2_device_unregister(&pdev->v4l2_dev);
Hans de Goede9a7b2d12011-06-06 14:43:39 -03001232
1233#ifdef CONFIG_USB_PWC_INPUT_EVDEV
1234 if (pdev->button_dev)
1235 input_unregister_device(pdev->button_dev);
1236#endif
Hans de Goede76ae8532011-07-19 07:14:22 -03001237
1238 v4l2_device_put(&pdev->v4l2_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001239}
1240
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001242/*
1243 * Initialization code & module stuff
Linus Torvalds1da177e2005-04-16 15:20:36 -07001244 */
1245
Linus Torvalds1da177e2005-04-16 15:20:36 -07001246static int leds[2] = { -1, -1 };
Al Viro64a6f952007-10-14 19:35:30 +01001247static unsigned int leds_nargs;
Luc Saillard2b455db2006-04-24 10:29:46 -03001248static char *dev_hint[MAX_DEV_HINTS];
Al Viro64a6f952007-10-14 19:35:30 +01001249static unsigned int dev_hint_nargs;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001250
Trent Piepho05ad3902007-01-30 23:26:01 -03001251#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001252module_param_named(trace, pwc_trace, int, 0644);
1253#endif
Hans de Goede3b4d0ec2011-06-26 03:51:19 -03001254module_param(power_save, int, 0644);
Luc Saillard2b455db2006-04-24 10:29:46 -03001255module_param_array(leds, int, &leds_nargs, 0444);
1256module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
1257
Andrea Odetti4315c412009-12-10 16:26:10 -03001258#ifdef CONFIG_USB_PWC_DEBUG
Linus Torvalds1da177e2005-04-16 15:20:36 -07001259MODULE_PARM_DESC(trace, "For debugging purposes");
Andrea Odetti4315c412009-12-10 16:26:10 -03001260#endif
Hans de Goede3b4d0ec2011-06-26 03:51:19 -03001261MODULE_PARM_DESC(power_save, "Turn power saving for new cameras on or off");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001262MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001263MODULE_PARM_DESC(dev_hint, "Device node hints");
1264
1265MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
1266MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
1267MODULE_LICENSE("GPL");
Luc Saillard2b455db2006-04-24 10:29:46 -03001268MODULE_ALIAS("pwcx");
1269MODULE_VERSION( PWC_VERSION );
Linus Torvalds1da177e2005-04-16 15:20:36 -07001270
1271static int __init usb_pwc_init(void)
1272{
Hans de Goede6eba9352011-06-26 06:49:59 -03001273 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001274
Hans de Goede6eba9352011-06-26 06:49:59 -03001275#ifdef CONFIG_USB_PWC_DEBUG
Luc Saillard2b455db2006-04-24 10:29:46 -03001276 PWC_INFO("Philips webcam module version " PWC_VERSION " loaded.\n");
1277 PWC_INFO("Supports Philips PCA645/646, PCVC675/680/690, PCVC720[40]/730/740/750 & PCVC830/840.\n");
1278 PWC_INFO("Also supports the Askey VC010, various Logitech Quickcams, Samsung MPC-C10 and MPC-C30,\n");
1279 PWC_INFO("the Creative WebCam 5 & Pro Ex, SOTEC Afina Eye and Visionite VCS-UC300 and VCS-UM100.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001280
Hans de Goede6eba9352011-06-26 06:49:59 -03001281 if (pwc_trace >= 0) {
1282 PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
1283 }
1284#endif
1285
Linus Torvalds1da177e2005-04-16 15:20:36 -07001286 if (leds[0] >= 0)
1287 led_on = leds[0];
1288 if (leds[1] >= 0)
1289 led_off = leds[1];
1290
Steven Cole093cf722005-05-03 19:07:24 -06001291 /* Big device node whoopla. Basically, it allows you to assign a
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292 device node (/dev/videoX) to a camera, based on its type
1293 & serial number. The format is [type[.serialnumber]:]node.
1294
1295 Any camera that isn't matched by these rules gets the next
1296 available free device node.
1297 */
1298 for (i = 0; i < MAX_DEV_HINTS; i++) {
1299 char *s, *colon, *dot;
1300
1301 /* This loop also initializes the array */
1302 device_hint[i].pdev = NULL;
1303 s = dev_hint[i];
1304 if (s != NULL && *s != '\0') {
1305 device_hint[i].type = -1; /* wildcard */
1306 strcpy(device_hint[i].serial_number, "*");
1307
1308 /* parse string: chop at ':' & '/' */
1309 colon = dot = s;
1310 while (*colon != '\0' && *colon != ':')
1311 colon++;
1312 while (*dot != '\0' && *dot != '.')
1313 dot++;
1314 /* Few sanity checks */
1315 if (*dot != '\0' && dot > colon) {
Luc Saillard2b455db2006-04-24 10:29:46 -03001316 PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 return -EINVAL;
1318 }
1319
1320 if (*colon == '\0') {
1321 /* No colon */
1322 if (*dot != '\0') {
Luc Saillard2b455db2006-04-24 10:29:46 -03001323 PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001324 return -EINVAL;
1325 }
1326 else {
1327 /* No type or serial number specified, just a number. */
Andy Shevchenko2d8d7762009-09-24 07:58:09 -03001328 device_hint[i].device_node =
1329 simple_strtol(s, NULL, 10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330 }
1331 }
1332 else {
1333 /* There's a colon, so we have at least a type and a device node */
Andy Shevchenko2d8d7762009-09-24 07:58:09 -03001334 device_hint[i].type =
1335 simple_strtol(s, NULL, 10);
1336 device_hint[i].device_node =
1337 simple_strtol(colon + 1, NULL, 10);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 if (*dot != '\0') {
1339 /* There's a serial number as well */
1340 int k;
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001341
Linus Torvalds1da177e2005-04-16 15:20:36 -07001342 dot++;
1343 k = 0;
1344 while (*dot != ':' && k < 29) {
1345 device_hint[i].serial_number[k++] = *dot;
1346 dot++;
1347 }
1348 device_hint[i].serial_number[k] = '\0';
1349 }
1350 }
Luc Saillard2b455db2006-04-24 10:29:46 -03001351 PWC_TRACE("device_hint[%d]:\n", i);
1352 PWC_TRACE(" type : %d\n", device_hint[i].type);
1353 PWC_TRACE(" serial# : %s\n", device_hint[i].serial_number);
1354 PWC_TRACE(" node : %d\n", device_hint[i].device_node);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355 }
1356 else
1357 device_hint[i].type = 0; /* not filled */
1358 } /* ..for MAX_DEV_HINTS */
1359
Luc Saillard2b455db2006-04-24 10:29:46 -03001360 PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001361 return usb_register(&pwc_driver);
1362}
1363
1364static void __exit usb_pwc_exit(void)
1365{
Luc Saillard2b455db2006-04-24 10:29:46 -03001366 PWC_DEBUG_MODULE("Deregistering driver.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001367 usb_deregister(&pwc_driver);
Luc Saillard2b455db2006-04-24 10:29:46 -03001368 PWC_INFO("Philips webcam module removed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001369}
1370
1371module_init(usb_pwc_init);
1372module_exit(usb_pwc_exit);
1373
Luc Saillard2b455db2006-04-24 10:29:46 -03001374/* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */