pwc-if.c 39.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/* Linux driver for Philips webcam
   USB and Video4Linux interface part.
   (C) 1999-2004 Nemosoft Unv.
4
   (C) 2004-2006 Luc Saillard (luc@saillard.org)
5
   (C) 2011 Hans de Goede <hdegoede@redhat.com>
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28

   NOTE: this version of pwc is an unofficial (modified) release of pwc & pcwx
   driver and thus may have bugs that are not present in the original version.
   Please send bug reports and support requests to <luc@saillard.org>.
   The decompression routines have been implemented by reverse-engineering the
   Nemosoft binary pwcx module. Caveat emptor.

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2 of the License, or
   (at your option) any later version.

   This program is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU General Public License for more details.

   You should have received a copy of the GNU General Public License
   along with this program; if not, write to the Free Software
   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

*/

29
/*
L
Linus Torvalds 已提交
30 31 32
   This code forms the interface between the USB layers and the Philips
   specific stuff. Some adanved stuff of the driver falls under an
   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
L
Linus Torvalds 已提交
34
   contains the code that falls under the NDA.
35 36

   In case you're wondering: 'pwc' stands for "Philips WebCam", but
L
Linus Torvalds 已提交
37 38 39
   I really didn't want to type 'philips_web_cam' every time (I'm lazy as
   any Linux kernel hacker, but I don't like uncomprehensible abbreviations
   without explanation).
40

L
Linus Torvalds 已提交
41 42 43
   Oh yes, convention: to disctinguish between all the various pointers to
   device-structures, I use these names for the pointer variables:
   udev: struct usb_device *
44
   vdev: struct video_device (member of pwc_dev)
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52 53 54 55 56
   pdev: struct pwc_devive *
*/

/* Contributors:
   - Alvarado: adding whitebalance code
   - Alistar Moire: QuickCam 3000 Pro device/product ID
   - Tony Hoyle: Creative Labs Webcam 5 device/product ID
   - Mark Burazin: solving hang in VIDIOCSYNC when camera gets unplugged
   - Jk Fang: Sotec Afina Eye ID
   - Xavier Roche: QuickCam Pro 4000 ID
   - Jens Knudsen: QuickCam Zoom ID
   - J. Debert: QuickCam for Notebooks ID
57
   - Pham Thanh Nam: webcam snapshot button as an event input device
L
Linus Torvalds 已提交
58 59 60 61 62 63 64 65
*/

#include <linux/errno.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/poll.h>
#include <linux/slab.h>
66 67 68
#ifdef CONFIG_USB_PWC_INPUT_EVDEV
#include <linux/usb/input.h>
#endif
L
Linus Torvalds 已提交
69 70
#include <linux/vmalloc.h>
#include <asm/io.h>
71
#include <linux/kernel.h>		/* simple_strtol() */
L
Linus Torvalds 已提交
72 73 74 75

#include "pwc.h"
#include "pwc-kiara.h"
#include "pwc-timon.h"
76 77
#include "pwc-dec23.h"
#include "pwc-dec1.h"
L
Linus Torvalds 已提交
78 79 80 81

/* Function prototypes and driver templates */

/* hotplug device table support */
82
static const struct usb_device_id pwc_device_table [] = {
L
Linus Torvalds 已提交
83 84 85 86 87 88 89
	{ USB_DEVICE(0x0471, 0x0302) }, /* Philips models */
	{ USB_DEVICE(0x0471, 0x0303) },
	{ USB_DEVICE(0x0471, 0x0304) },
	{ USB_DEVICE(0x0471, 0x0307) },
	{ USB_DEVICE(0x0471, 0x0308) },
	{ USB_DEVICE(0x0471, 0x030C) },
	{ USB_DEVICE(0x0471, 0x0310) },
90
	{ USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
L
Linus Torvalds 已提交
91 92
	{ USB_DEVICE(0x0471, 0x0312) },
	{ USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
93
	{ USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
L
Linus Torvalds 已提交
94 95 96 97 98 99 100
	{ USB_DEVICE(0x069A, 0x0001) }, /* Askey */
	{ USB_DEVICE(0x046D, 0x08B0) }, /* Logitech QuickCam Pro 3000 */
	{ USB_DEVICE(0x046D, 0x08B1) }, /* Logitech QuickCam Notebook Pro */
	{ USB_DEVICE(0x046D, 0x08B2) }, /* Logitech QuickCam Pro 4000 */
	{ USB_DEVICE(0x046D, 0x08B3) }, /* Logitech QuickCam Zoom (old model) */
	{ USB_DEVICE(0x046D, 0x08B4) }, /* Logitech QuickCam Zoom (new model) */
	{ USB_DEVICE(0x046D, 0x08B5) }, /* Logitech QuickCam Orbit/Sphere */
101 102
	{ USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
	{ USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
L
Linus Torvalds 已提交
103
	{ USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
104 105 106
	{ USB_DEVICE(0x055D, 0x9000) }, /* Samsung MPC-C10 */
	{ USB_DEVICE(0x055D, 0x9001) }, /* Samsung MPC-C30 */
	{ USB_DEVICE(0x055D, 0x9002) },	/* Samsung SNC-35E (Ver3.0) */
L
Linus Torvalds 已提交
107 108 109 110 111 112 113 114 115 116 117 118
	{ USB_DEVICE(0x041E, 0x400C) }, /* Creative Webcam 5 */
	{ USB_DEVICE(0x041E, 0x4011) }, /* Creative Webcam Pro Ex */
	{ USB_DEVICE(0x04CC, 0x8116) }, /* Afina Eye */
	{ USB_DEVICE(0x06BE, 0x8116) }, /* new Afina Eye */
	{ USB_DEVICE(0x0d81, 0x1910) }, /* Visionite */
	{ USB_DEVICE(0x0d81, 0x1900) },
	{ }
};
MODULE_DEVICE_TABLE(usb, pwc_device_table);

static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id);
static void usb_pwc_disconnect(struct usb_interface *intf);
119
static void pwc_isoc_cleanup(struct pwc_device *pdev);
L
Linus Torvalds 已提交
120 121 122 123 124 125 126 127 128 129 130 131

static struct usb_driver pwc_driver = {
	.name =			"Philips webcam",	/* name */
	.id_table =		pwc_device_table,
	.probe =		usb_pwc_probe,		/* probe() */
	.disconnect =		usb_pwc_disconnect,	/* disconnect() */
};

#define MAX_DEV_HINTS	20
#define MAX_ISOC_ERRORS	20

static int default_fps = 10;
132
#ifdef CONFIG_USB_PWC_DEBUG
133
	int pwc_trace = PWC_DEBUG_LEVEL;
134
#endif
135
static int power_save = -1;
136
static int led_on = 100, led_off; /* defaults to LED that is on while in use */
137
static int pwc_preferred_compression = 1; /* 0..3 = uncompressed..high */
L
Linus Torvalds 已提交
138 139 140 141 142 143 144 145 146
static struct {
	int type;
	char serial_number[30];
	int device_node;
	struct pwc_device *pdev;
} device_hint[MAX_DEV_HINTS];

/***/

147
static int pwc_video_close(struct file *file);
148
static ssize_t pwc_video_read(struct file *file, char __user *buf,
L
Linus Torvalds 已提交
149 150 151 152
			  size_t count, loff_t *ppos);
static unsigned int pwc_video_poll(struct file *file, poll_table *wait);
static int  pwc_video_mmap(struct file *file, struct vm_area_struct *vma);

153
static const struct v4l2_file_operations pwc_fops = {
L
Linus Torvalds 已提交
154
	.owner =	THIS_MODULE,
155
	.open =		v4l2_fh_open,
L
Linus Torvalds 已提交
156 157 158 159
	.release =     	pwc_video_close,
	.read =		pwc_video_read,
	.poll =		pwc_video_poll,
	.mmap =		pwc_video_mmap,
160
	.unlocked_ioctl = video_ioctl2,
L
Linus Torvalds 已提交
161 162 163
};
static struct video_device pwc_template = {
	.name =		"Philips Webcam",	/* Filled in later */
164
	.release =	video_device_release_empty,
L
Linus Torvalds 已提交
165
	.fops =         &pwc_fops,
166
	.ioctl_ops =	&pwc_ioctl_ops,
L
Linus Torvalds 已提交
167 168 169 170 171
};

/***************************************************************************/
/* Private functions */

172
struct pwc_frame_buf *pwc_get_next_fill_buf(struct pwc_device *pdev)
L
Linus Torvalds 已提交
173
{
174 175 176 177 178 179 180 181 182 183 184 185
	unsigned long flags = 0;
	struct pwc_frame_buf *buf = NULL;

	spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
	if (list_empty(&pdev->queued_bufs))
		goto leave;

	buf = list_entry(pdev->queued_bufs.next, struct pwc_frame_buf, list);
	list_del(&buf->list);
leave:
	spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
	return buf;
186 187
}

188 189 190 191 192 193 194 195 196 197
static void pwc_snapshot_button(struct pwc_device *pdev, int down)
{
	if (down) {
		PWC_TRACE("Snapshot button pressed.\n");
	} else {
		PWC_TRACE("Snapshot button released.\n");
	}

#ifdef CONFIG_USB_PWC_INPUT_EVDEV
	if (pdev->button_dev) {
198
		input_report_key(pdev->button_dev, KEY_CAMERA, down);
199 200 201 202 203
		input_sync(pdev->button_dev);
	}
#endif
}

204
static void pwc_frame_complete(struct pwc_device *pdev)
205
{
206
	struct pwc_frame_buf *fbuf = pdev->fill_buf;
207 208 209 210 211 212 213 214 215 216 217 218 219

	/* The ToUCam Fun CMOS sensor causes the firmware to send 2 or 3 bogus
	   frames on the USB wire after an exposure change. This conditition is
	   however detected  in the cam and a bit is set in the header.
	   */
	if (pdev->type == 730) {
		unsigned char *ptr = (unsigned char *)fbuf->data;

		if (ptr[1] == 1 && ptr[0] & 0x10) {
			PWC_TRACE("Hyundai CMOS sensor bug. Dropping frame.\n");
			pdev->drop_frames += 2;
		}
		if ((ptr[0] ^ pdev->vmirror) & 0x01) {
220
			pwc_snapshot_button(pdev, ptr[0] & 0x01);
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
		}
		if ((ptr[0] ^ pdev->vmirror) & 0x02) {
			if (ptr[0] & 0x02)
				PWC_TRACE("Image is mirrored.\n");
			else
				PWC_TRACE("Image is normal.\n");
		}
		pdev->vmirror = ptr[0] & 0x03;
		/* Sometimes the trailer of the 730 is still sent as a 4 byte packet
		   after a short frame; this condition is filtered out specifically. A 4 byte
		   frame doesn't make sense anyway.
		   So we get either this sequence:
		   drop_bit set -> 4 byte frame -> short frame -> good frame
		   Or this one:
		   drop_bit set -> short frame -> good frame
		   So we drop either 3 or 2 frames in all!
		   */
		if (fbuf->filled == 4)
			pdev->drop_frames++;
240
	} else if (pdev->type == 740 || pdev->type == 720) {
241 242
		unsigned char *ptr = (unsigned char *)fbuf->data;
		if ((ptr[0] ^ pdev->vmirror) & 0x01) {
243
			pwc_snapshot_button(pdev, ptr[0] & 0x01);
244 245 246 247
		}
		pdev->vmirror = ptr[0] & 0x03;
	}

248 249
	/* In case we were instructed to drop the frame, do so silently. */
	if (pdev->drop_frames > 0) {
250
		pdev->drop_frames--;
251
	} else {
252 253 254 255
		/* Check for underflow first */
		if (fbuf->filled < pdev->frame_total_size) {
			PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
				       " discarded.\n", fbuf->filled);
256 257 258 259 260 261
		} else {
			fbuf->vb.v4l2_buf.field = V4L2_FIELD_NONE;
			fbuf->vb.v4l2_buf.sequence = pdev->vframe_count;
			vb2_buffer_done(&fbuf->vb, VB2_BUF_STATE_DONE);
			pdev->fill_buf = NULL;
			pdev->vsync = 0;
262 263 264 265
		}
	} /* !drop_frames */
	pdev->vframe_count++;
}
L
Linus Torvalds 已提交
266 267 268 269

/* This gets called for the Isochronous pipe (video). This is done in
 * interrupt time, so it has to be fast, not crash, and not stall. Neat.
 */
270
static void pwc_isoc_handler(struct urb *urb)
L
Linus Torvalds 已提交
271
{
272
	struct pwc_device *pdev = (struct pwc_device *)urb->context;
L
Linus Torvalds 已提交
273
	int i, fst, flen;
274
	unsigned char *iso_buf = NULL;
L
Linus Torvalds 已提交
275

276 277
	if (urb->status == -ENOENT || urb->status == -ECONNRESET ||
	    urb->status == -ESHUTDOWN) {
278
		PWC_DEBUG_OPEN("URB (%p) unlinked %ssynchronuously.\n", urb, urb->status == -ENOENT ? "" : "a");
L
Linus Torvalds 已提交
279 280
		return;
	}
281 282 283 284 285

	if (pdev->fill_buf == NULL)
		pdev->fill_buf = pwc_get_next_fill_buf(pdev);

	if (urb->status != 0) {
L
Linus Torvalds 已提交
286 287 288 289 290 291 292 293 294
		const char *errmsg;

		errmsg = "Unknown";
		switch(urb->status) {
			case -ENOSR:		errmsg = "Buffer error (overrun)"; break;
			case -EPIPE:		errmsg = "Stalled (device not responding)"; break;
			case -EOVERFLOW:	errmsg = "Babble (bad cable?)"; break;
			case -EPROTO:		errmsg = "Bit-stuff error (bad cable?)"; break;
			case -EILSEQ:		errmsg = "CRC/Timeout (could be anything)"; break;
295
			case -ETIME:		errmsg = "Device does not respond"; break;
L
Linus Torvalds 已提交
296
		}
297 298 299
		PWC_ERROR("pwc_isoc_handler() called with status %d [%s].\n",
			  urb->status, errmsg);
		/* Give up after a number of contiguous errors */
L
Linus Torvalds 已提交
300 301
		if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
		{
302 303 304 305 306 307
			PWC_ERROR("Too many ISOC errors, bailing out.\n");
			if (pdev->fill_buf) {
				vb2_buffer_done(&pdev->fill_buf->vb,
						VB2_BUF_STATE_ERROR);
				pdev->fill_buf = NULL;
			}
L
Linus Torvalds 已提交
308
		}
309
		pdev->vsync = 0; /* Drop the current frame */
L
Linus Torvalds 已提交
310 311 312 313 314 315 316
		goto handler_end;
	}

	/* Reset ISOC error counter. We did get here, after all. */
	pdev->visoc_errors = 0;

	/* vsync: 0 = don't copy data
317 318
		  1 = sync-hunt
		  2 = synched
L
Linus Torvalds 已提交
319 320 321 322 323 324
	 */
	/* Compact data */
	for (i = 0; i < urb->number_of_packets; i++) {
		fst  = urb->iso_frame_desc[i].status;
		flen = urb->iso_frame_desc[i].actual_length;
		iso_buf = urb->transfer_buffer + urb->iso_frame_desc[i].offset;
325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344
		if (fst != 0) {
			PWC_ERROR("Iso frame %d has error %d\n", i, fst);
			continue;
		}
		if (flen > 0 && pdev->vsync) {
			struct pwc_frame_buf *fbuf = pdev->fill_buf;

			if (pdev->vsync == 1) {
				do_gettimeofday(&fbuf->vb.v4l2_buf.timestamp);
				pdev->vsync = 2;
			}

			if (flen + fbuf->filled > pdev->frame_total_size) {
				PWC_ERROR("Frame overflow (%d > %d)\n",
					  flen + fbuf->filled,
					  pdev->frame_total_size);
				pdev->vsync = 0; /* Let's wait for an EOF */
			} else {
				memcpy(fbuf->data + fbuf->filled, iso_buf,
				       flen);
L
Linus Torvalds 已提交
345
				fbuf->filled += flen;
346 347 348 349 350 351 352 353 354 355
			}
		}
		if (flen < pdev->vlast_packet_size) {
			/* Shorter packet... end of frame */
			if (pdev->vsync == 2)
				pwc_frame_complete(pdev);
			if (pdev->fill_buf == NULL)
				pdev->fill_buf = pwc_get_next_fill_buf(pdev);
			if (pdev->fill_buf) {
				pdev->fill_buf->filled = 0;
L
Linus Torvalds 已提交
356
				pdev->vsync = 1;
357
			}
L
Linus Torvalds 已提交
358
		}
359
		pdev->vlast_packet_size = flen;
L
Linus Torvalds 已提交
360 361 362 363 364
	}

handler_end:
	i = usb_submit_urb(urb, GFP_ATOMIC);
	if (i != 0)
365
		PWC_ERROR("Error (%d) re-submitting urb in pwc_isoc_handler.\n", i);
L
Linus Torvalds 已提交
366 367
}

368
static int pwc_isoc_init(struct pwc_device *pdev)
L
Linus Torvalds 已提交
369 370 371 372 373 374 375 376 377
{
	struct usb_device *udev;
	struct urb *urb;
	int i, j, ret;
	struct usb_interface *intf;
	struct usb_host_interface *idesc = NULL;

	if (pdev->iso_init)
		return 0;
378

L
Linus Torvalds 已提交
379
	pdev->vsync = 0;
380
	pdev->vlast_packet_size = 0;
381 382
	pdev->fill_buf = NULL;
	pdev->vframe_count = 0;
383
	pdev->visoc_errors = 0;
L
Linus Torvalds 已提交
384 385 386 387 388 389 390
	udev = pdev->udev;

	/* Get the current alternate interface, adjust packet size */
	intf = usb_ifnum_to_if(udev, 0);
	if (intf)
		idesc = usb_altnum_to_altsetting(intf, pdev->valternate);
	if (!idesc)
391
		return -EIO;
L
Linus Torvalds 已提交
392 393 394

	/* Search video endpoint */
	pdev->vmax_packet_size = -1;
395
	for (i = 0; i < idesc->desc.bNumEndpoints; i++) {
L
Linus Torvalds 已提交
396 397 398 399
		if ((idesc->endpoint[i].desc.bEndpointAddress & 0xF) == pdev->vendpoint) {
			pdev->vmax_packet_size = le16_to_cpu(idesc->endpoint[i].desc.wMaxPacketSize);
			break;
		}
400
	}
401

L
Linus Torvalds 已提交
402
	if (pdev->vmax_packet_size < 0 || pdev->vmax_packet_size > ISO_MAX_FRAME_SIZE) {
403
		PWC_ERROR("Failed to find packet size for video endpoint in current alternate setting.\n");
404
		return -ENFILE; /* Odd error, that should be noticeable */
L
Linus Torvalds 已提交
405 406 407 408
	}

	/* Set alternate interface */
	ret = 0;
409
	PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
L
Linus Torvalds 已提交
410 411 412 413
	ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
	if (ret < 0)
		return ret;

414
	/* Allocate and init Isochronuous urbs */
L
Linus Torvalds 已提交
415 416 417
	for (i = 0; i < MAX_ISO_BUFS; i++) {
		urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
		if (urb == NULL) {
418
			PWC_ERROR("Failed to allocate urb %d\n", i);
419 420 421
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return -ENOMEM;
L
Linus Torvalds 已提交
422
		}
423
		pdev->urbs[i] = urb;
424
		PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
L
Linus Torvalds 已提交
425 426 427

		urb->interval = 1; // devik
		urb->dev = udev;
428
		urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
429 430 431 432 433 434 435 436 437 438 439
		urb->transfer_flags = URB_ISO_ASAP | URB_NO_TRANSFER_DMA_MAP;
		urb->transfer_buffer = usb_alloc_coherent(udev,
							  ISO_BUFFER_SIZE,
							  GFP_KERNEL,
							  &urb->transfer_dma);
		if (urb->transfer_buffer == NULL) {
			PWC_ERROR("Failed to allocate urb buffer %d\n", i);
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return -ENOMEM;
		}
440 441 442
		urb->transfer_buffer_length = ISO_BUFFER_SIZE;
		urb->complete = pwc_isoc_handler;
		urb->context = pdev;
L
Linus Torvalds 已提交
443 444 445 446 447 448 449 450 451 452
		urb->start_frame = 0;
		urb->number_of_packets = ISO_FRAMES_PER_DESC;
		for (j = 0; j < ISO_FRAMES_PER_DESC; j++) {
			urb->iso_frame_desc[j].offset = j * ISO_MAX_FRAME_SIZE;
			urb->iso_frame_desc[j].length = pdev->vmax_packet_size;
		}
	}

	/* link */
	for (i = 0; i < MAX_ISO_BUFS; i++) {
453
		ret = usb_submit_urb(pdev->urbs[i], GFP_KERNEL);
454
		if (ret) {
455
			PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
456 457 458 459
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return ret;
		}
460
		PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->urbs[i]);
L
Linus Torvalds 已提交
461 462 463 464
	}

	/* All is done... */
	pdev->iso_init = 1;
465
	PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
L
Linus Torvalds 已提交
466 467 468
	return 0;
}

469
static void pwc_iso_stop(struct pwc_device *pdev)
L
Linus Torvalds 已提交
470 471 472 473 474
{
	int i;

	/* Unlinking ISOC buffers one by one */
	for (i = 0; i < MAX_ISO_BUFS; i++) {
475 476 477
		if (pdev->urbs[i]) {
			PWC_DEBUG_MEMORY("Unlinking URB %p\n", pdev->urbs[i]);
			usb_kill_urb(pdev->urbs[i]);
478 479 480 481 482 483 484 485 486 487
		}
	}
}

static void pwc_iso_free(struct pwc_device *pdev)
{
	int i;

	/* Freeing ISOC buffers one by one */
	for (i = 0; i < MAX_ISO_BUFS; i++) {
488
		if (pdev->urbs[i]) {
489
			PWC_DEBUG_MEMORY("Freeing URB\n");
490 491 492 493 494 495 496 497
			if (pdev->urbs[i]->transfer_buffer) {
				usb_free_coherent(pdev->udev,
					pdev->urbs[i]->transfer_buffer_length,
					pdev->urbs[i]->transfer_buffer,
					pdev->urbs[i]->transfer_dma);
			}
			usb_free_urb(pdev->urbs[i]);
			pdev->urbs[i] = NULL;
L
Linus Torvalds 已提交
498 499
		}
	}
500 501
}

502
static void pwc_isoc_cleanup(struct pwc_device *pdev)
503 504
{
	PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
505

506 507 508 509 510
	if (pdev->iso_init == 0)
		return;

	pwc_iso_stop(pdev);
	pwc_iso_free(pdev);
511
	usb_set_interface(pdev->udev, 0, 0);
L
Linus Torvalds 已提交
512 513

	pdev->iso_init = 0;
514
	PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
L
Linus Torvalds 已提交
515 516
}

517 518
static void pwc_cleanup_queued_bufs(struct pwc_device *pdev)
{
H
Hans de Goede 已提交
519 520 521
	unsigned long flags = 0;

	spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
522 523 524 525 526 527 528 529
	while (!list_empty(&pdev->queued_bufs)) {
		struct pwc_frame_buf *buf;

		buf = list_entry(pdev->queued_bufs.next, struct pwc_frame_buf,
				 list);
		list_del(&buf->list);
		vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR);
	}
H
Hans de Goede 已提交
530
	spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
531 532
}

533
#ifdef CONFIG_USB_PWC_DEBUG
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557
static const char *pwc_sensor_type_to_string(unsigned int sensor_type)
{
	switch(sensor_type) {
		case 0x00:
			return "Hyundai CMOS sensor";
		case 0x20:
			return "Sony CCD sensor + TDA8787";
		case 0x2E:
			return "Sony CCD sensor + Exas 98L59";
		case 0x2F:
			return "Sony CCD sensor + ADI 9804";
		case 0x30:
			return "Sharp CCD sensor + TDA8787";
		case 0x3E:
			return "Sharp CCD sensor + Exas 98L59";
		case 0x3F:
			return "Sharp CCD sensor + ADI 9804";
		case 0x40:
			return "UPA 1021 sensor";
		case 0x100:
			return "VGA sensor";
		case 0x101:
			return "PAL MR sensor";
		default:
558
			return "unknown type of sensor";
559 560 561
	}
}
#endif
L
Linus Torvalds 已提交
562 563 564 565

/***************************************************************************/
/* Video4Linux functions */

H
Hans de Goede 已提交
566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581
int pwc_test_n_set_capt_file(struct pwc_device *pdev, struct file *file)
{
	int r = 0;

	mutex_lock(&pdev->capt_file_lock);
	if (pdev->capt_file != NULL &&
	    pdev->capt_file != file) {
		r = -EBUSY;
		goto leave;
	}
	pdev->capt_file = file;
leave:
	mutex_unlock(&pdev->capt_file_lock);
	return r;
}

582
static void pwc_video_release(struct v4l2_device *v)
L
Linus Torvalds 已提交
583
{
584
	struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
585
	int hint;
586

587 588 589 590
	/* search device_hint[] table if we occupy a slot, by any chance */
	for (hint = 0; hint < MAX_DEV_HINTS; hint++)
		if (device_hint[hint].pdev == pdev)
			device_hint[hint].pdev = NULL;
591

592 593 594 595 596 597 598 599
	/* Free intermediate decompression buffer & tables */
	if (pdev->decompress_data != NULL) {
		PWC_DEBUG_MEMORY("Freeing decompression buffer at %p.\n",
				 pdev->decompress_data);
		kfree(pdev->decompress_data);
		pdev->decompress_data = NULL;
	}

600 601
	v4l2_ctrl_handler_free(&pdev->ctrl_handler);

602
	kfree(pdev);
603 604
}

605
static int pwc_video_close(struct file *file)
L
Linus Torvalds 已提交
606
{
607
	struct pwc_device *pdev = video_drvdata(file);
L
Linus Torvalds 已提交
608

609 610 611 612
	if (pdev->capt_file == file) {
		vb2_queue_release(&pdev->vb_queue);
		pdev->capt_file = NULL;
	}
613
	return v4l2_fh_release(file);
L
Linus Torvalds 已提交
614 615
}

616
static ssize_t pwc_video_read(struct file *file, char __user *buf,
617
			      size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
618
{
619
	struct pwc_device *pdev = video_drvdata(file);
L
Linus Torvalds 已提交
620

621 622
	if (!pdev->udev)
		return -ENODEV;
623

H
Hans de Goede 已提交
624
	if (pwc_test_n_set_capt_file(pdev, file))
625 626
		return -EBUSY;

627 628 629
	return vb2_read(&pdev->vb_queue, buf, count, ppos,
			file->f_flags & O_NONBLOCK);
}
L
Linus Torvalds 已提交
630

631 632
static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
{
633
	struct pwc_device *pdev = video_drvdata(file);
634

635
	if (!pdev->udev)
636
		return POLL_ERR;
L
Linus Torvalds 已提交
637

638
	return vb2_poll(&pdev->vb_queue, file, wait);
L
Linus Torvalds 已提交
639 640
}

641
static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
L
Linus Torvalds 已提交
642
{
643
	struct pwc_device *pdev = video_drvdata(file);
L
Linus Torvalds 已提交
644

645 646 647
	if (pdev->capt_file != file)
		return -EBUSY;

648 649
	return vb2_mmap(&pdev->vb_queue, vma);
}
L
Linus Torvalds 已提交
650

651 652 653
/***************************************************************************/
/* Videobuf2 operations */

654 655 656
static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt,
				unsigned int *nbuffers, unsigned int *nplanes,
				unsigned int sizes[], void *alloc_ctxs[])
657 658
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);
659
	int size;
660 661 662 663 664 665 666 667

	if (*nbuffers < MIN_FRAMES)
		*nbuffers = MIN_FRAMES;
	else if (*nbuffers > MAX_FRAMES)
		*nbuffers = MAX_FRAMES;

	*nplanes = 1;

668 669 670
	size = pwc_get_size(pdev, MAX_WIDTH, MAX_HEIGHT);
	sizes[0] = PAGE_ALIGN(pwc_image_sizes[size][0] *
			      pwc_image_sizes[size][1] * 3 / 2);
671 672 673 674 675 676 677

	return 0;
}

static int buffer_init(struct vb2_buffer *vb)
{
	struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
678

679 680 681 682 683 684 685 686 687 688 689 690 691
	/* need vmalloc since frame buffer > 128K */
	buf->data = vzalloc(PWC_FRAME_SIZE);
	if (buf->data == NULL)
		return -ENOMEM;

	return 0;
}

static int buffer_prepare(struct vb2_buffer *vb)
{
	struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);

	/* Don't allow queing new buffers after device disconnection */
692 693
	if (!pdev->udev)
		return -ENODEV;
L
Linus Torvalds 已提交
694 695 696 697

	return 0;
}

698
static int buffer_finish(struct vb2_buffer *vb)
L
Linus Torvalds 已提交
699
{
700 701
	struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
	struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
702

703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724
	/*
	 * Application has called dqbuf and is getting back a buffer we've
	 * filled, take the pwc data we've stored in buf->data and decompress
	 * it into a usable format, storing the result in the vb2_buffer
	 */
	return pwc_decompress(pdev, buf);
}

static void buffer_cleanup(struct vb2_buffer *vb)
{
	struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);

	vfree(buf->data);
}

static void buffer_queue(struct vb2_buffer *vb)
{
	struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
	struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
	unsigned long flags = 0;

	spin_lock_irqsave(&pdev->queued_bufs_lock, flags);
H
Hans de Goede 已提交
725 726 727 728 729
	/* Check the device has not disconnected between prep and queuing */
	if (pdev->udev)
		list_add_tail(&buf->list, &pdev->queued_bufs);
	else
		vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR);
730 731 732
	spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
}

733
static int start_streaming(struct vb2_queue *vq, unsigned int count)
734 735
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);
H
Hans de Goede 已提交
736
	int r;
737

H
Hans de Goede 已提交
738 739 740 741 742
	mutex_lock(&pdev->udevlock);
	if (!pdev->udev) {
		r = -ENODEV;
		goto leave;
	}
743

744 745 746 747
	/* Turn on camera and set LEDS on */
	pwc_camera_power(pdev, 1);
	if (pdev->power_save) {
		/* Restore video mode */
748
		pwc_set_video_mode(pdev, pdev->width, pdev->height,
749
				   pdev->vframes, pdev->vcompression);
750 751 752
	}
	pwc_set_leds(pdev, led_on, led_off);

H
Hans de Goede 已提交
753 754 755 756
	r = pwc_isoc_init(pdev);
leave:
	mutex_unlock(&pdev->udevlock);
	return r;
757 758 759 760 761 762
}

static int stop_streaming(struct vb2_queue *vq)
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);

H
Hans de Goede 已提交
763
	mutex_lock(&pdev->udevlock);
764 765 766
	if (pdev->udev) {
		pwc_set_leds(pdev, 0, 0);
		pwc_camera_power(pdev, 0);
767
		pwc_isoc_cleanup(pdev);
768
	}
H
Hans de Goede 已提交
769 770
	mutex_unlock(&pdev->udevlock);

771
	pwc_cleanup_queued_bufs(pdev);
772

L
Linus Torvalds 已提交
773 774 775
	return 0;
}

776 777 778 779 780 781 782 783 784 785 786
static struct vb2_ops pwc_vb_queue_ops = {
	.queue_setup		= queue_setup,
	.buf_init		= buffer_init,
	.buf_prepare		= buffer_prepare,
	.buf_finish		= buffer_finish,
	.buf_cleanup		= buffer_cleanup,
	.buf_queue		= buffer_queue,
	.start_streaming	= start_streaming,
	.stop_streaming		= stop_streaming,
};

L
Linus Torvalds 已提交
787 788 789 790 791 792 793 794 795 796 797 798
/***************************************************************************/
/* USB functions */

/* This function gets called when a new device is plugged in or the usb core
 * is loaded.
 */

static int usb_pwc_probe(struct usb_interface *intf, const struct usb_device_id *id)
{
	struct usb_device *udev = interface_to_usbdev(intf);
	struct pwc_device *pdev = NULL;
	int vendor_id, product_id, type_id;
799
	int hint, rc;
L
Linus Torvalds 已提交
800 801
	int features = 0;
	int video_nr = -1; /* default: use next available device */
802
	int my_power_save = power_save;
L
Linus Torvalds 已提交
803 804
	char serial_number[30], *name;

805 806 807
	vendor_id = le16_to_cpu(udev->descriptor.idVendor);
	product_id = le16_to_cpu(udev->descriptor.idProduct);

L
Linus Torvalds 已提交
808
	/* Check if we can handle this device */
809 810
	PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
		vendor_id, product_id,
L
Linus Torvalds 已提交
811 812 813 814 815 816 817 818 819 820 821 822
		intf->altsetting->desc.bInterfaceNumber);

	/* the interfaces are probed one by one. We are only interested in the
	   video interface (0) now.
	   Interface 1 is the Audio Control, and interface 2 Audio itself.
	 */
	if (intf->altsetting->desc.bInterfaceNumber > 0)
		return -ENODEV;

	if (vendor_id == 0x0471) {
		switch (product_id) {
		case 0x0302:
823
			PWC_INFO("Philips PCA645VC USB webcam detected.\n");
L
Linus Torvalds 已提交
824 825 826 827
			name = "Philips 645 webcam";
			type_id = 645;
			break;
		case 0x0303:
828
			PWC_INFO("Philips PCA646VC USB webcam detected.\n");
L
Linus Torvalds 已提交
829 830 831 832
			name = "Philips 646 webcam";
			type_id = 646;
			break;
		case 0x0304:
833
			PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
L
Linus Torvalds 已提交
834 835 836 837
			name = "Askey VC010 webcam";
			type_id = 646;
			break;
		case 0x0307:
838
			PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
L
Linus Torvalds 已提交
839 840 841 842
			name = "Philips 675 webcam";
			type_id = 675;
			break;
		case 0x0308:
843
			PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
L
Linus Torvalds 已提交
844 845 846 847
			name = "Philips 680 webcam";
			type_id = 680;
			break;
		case 0x030C:
848
			PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
L
Linus Torvalds 已提交
849 850 851 852
			name = "Philips 690 webcam";
			type_id = 690;
			break;
		case 0x0310:
853
			PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
L
Linus Torvalds 已提交
854 855 856 857
			name = "Philips 730 webcam";
			type_id = 730;
			break;
		case 0x0311:
858
			PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
L
Linus Torvalds 已提交
859 860 861 862
			name = "Philips 740 webcam";
			type_id = 740;
			break;
		case 0x0312:
863
			PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
L
Linus Torvalds 已提交
864 865 866 867
			name = "Philips 750 webcam";
			type_id = 750;
			break;
		case 0x0313:
868
			PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
L
Linus Torvalds 已提交
869 870 871
			name = "Philips 720K/40 webcam";
			type_id = 720;
			break;
872 873 874
		case 0x0329:
			PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
			name = "Philips SPC 900NC webcam";
875
			type_id = 740;
876
			break;
L
Linus Torvalds 已提交
877 878 879 880 881 882 883 884
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x069A) {
		switch(product_id) {
		case 0x0001:
885
			PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
L
Linus Torvalds 已提交
886 887 888 889 890 891 892 893 894 895 896
			name = "Askey VC010 webcam";
			type_id = 645;
			break;
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x046d) {
		switch(product_id) {
		case 0x08b0:
897
			PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
L
Linus Torvalds 已提交
898 899 900 901
			name = "Logitech QuickCam Pro 3000";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08b1:
902
			PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
L
Linus Torvalds 已提交
903 904 905 906
			name = "Logitech QuickCam Notebook Pro";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08b2:
907
			PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
L
Linus Torvalds 已提交
908 909
			name = "Logitech QuickCam Pro 4000";
			type_id = 740; /* CCD sensor */
910 911
			if (my_power_save == -1)
				my_power_save = 1;
L
Linus Torvalds 已提交
912 913
			break;
		case 0x08b3:
914
			PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
L
Linus Torvalds 已提交
915 916 917 918
			name = "Logitech QuickCam Zoom";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08B4:
919
			PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
L
Linus Torvalds 已提交
920 921
			name = "Logitech QuickCam Zoom";
			type_id = 740; /* CCD sensor */
922 923
			if (my_power_save == -1)
				my_power_save = 1;
L
Linus Torvalds 已提交
924 925
			break;
		case 0x08b5:
926
			PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
L
Linus Torvalds 已提交
927 928
			name = "Logitech QuickCam Orbit";
			type_id = 740; /* CCD sensor */
929 930
			if (my_power_save == -1)
				my_power_save = 1;
L
Linus Torvalds 已提交
931 932 933
			features |= FEATURE_MOTOR_PANTILT;
			break;
		case 0x08b6:
934 935 936 937
			PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
			name = "Cisco VT Camera";
			type_id = 740; /* CCD sensor */
			break;
L
Linus Torvalds 已提交
938
		case 0x08b7:
939 940 941 942 943
			PWC_INFO("Logitech ViewPort AV 100 webcam detected.\n");
			name = "Logitech ViewPort AV 100";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08b8: /* Where this released? */
944
			PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
L
Linus Torvalds 已提交
945 946 947
			name = "Logitech QuickCam (res.)";
			type_id = 730; /* Assuming CMOS */
			break;
948
		default:
L
Linus Torvalds 已提交
949
			return -ENODEV;
950 951 952
			break;
		}
	}
L
Linus Torvalds 已提交
953 954 955 956 957 958 959
	else if (vendor_id == 0x055d) {
		/* I don't know the difference between the C10 and the C30;
		   I suppose the difference is the sensor, but both cameras
		   work equally well with a type_id of 675
		 */
		switch(product_id) {
		case 0x9000:
960
			PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
L
Linus Torvalds 已提交
961 962 963 964
			name = "Samsung MPC-C10";
			type_id = 675;
			break;
		case 0x9001:
965
			PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
L
Linus Torvalds 已提交
966 967 968
			name = "Samsung MPC-C30";
			type_id = 675;
			break;
969 970 971 972 973
		case 0x9002:
			PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
			name = "Samsung MPC-C30";
			type_id = 740;
			break;
L
Linus Torvalds 已提交
974 975 976 977 978 979 980 981
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x041e) {
		switch(product_id) {
		case 0x400c:
982
			PWC_INFO("Creative Labs Webcam 5 detected.\n");
L
Linus Torvalds 已提交
983 984
			name = "Creative Labs Webcam 5";
			type_id = 730;
985 986
			if (my_power_save == -1)
				my_power_save = 1;
L
Linus Torvalds 已提交
987 988
			break;
		case 0x4011:
989
			PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
L
Linus Torvalds 已提交
990 991 992 993 994 995 996 997 998 999 1000
			name = "Creative Labs Webcam Pro Ex";
			type_id = 740;
			break;
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x04cc) {
		switch(product_id) {
		case 0x8116:
1001
			PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
L
Linus Torvalds 已提交
1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013
			name = "Sotec Afina Eye";
			type_id = 730;
			break;
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x06be) {
		switch(product_id) {
		case 0x8116:
			/* This is essentially the same cam as the Sotec Afina Eye */
1014
			PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
L
Linus Torvalds 已提交
1015 1016 1017 1018 1019 1020 1021
			name = "AME Co. Afina Eye";
			type_id = 750;
			break;
		default:
			return -ENODEV;
			break;
		}
1022

L
Linus Torvalds 已提交
1023 1024 1025 1026
	}
	else if (vendor_id == 0x0d81) {
		switch(product_id) {
		case 0x1900:
1027
			PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
L
Linus Torvalds 已提交
1028 1029 1030 1031
			name = "Visionite VCS-UC300";
			type_id = 740; /* CCD sensor */
			break;
		case 0x1910:
1032
			PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
L
Linus Torvalds 已提交
1033 1034 1035 1036 1037 1038 1039 1040
			name = "Visionite VCS-UM100";
			type_id = 730; /* CMOS sensor */
			break;
		default:
			return -ENODEV;
			break;
		}
	}
1041
	else
L
Linus Torvalds 已提交
1042 1043
		return -ENODEV; /* Not any of the know types; but the list keeps growing. */

1044 1045 1046
	if (my_power_save == -1)
		my_power_save = 0;

L
Linus Torvalds 已提交
1047 1048
	memset(serial_number, 0, 30);
	usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
1049
	PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
L
Linus Torvalds 已提交
1050 1051

	if (udev->descriptor.bNumConfigurations > 1)
1052
		PWC_WARNING("Warning: more than 1 configuration available.\n");
L
Linus Torvalds 已提交
1053 1054

	/* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
1055
	pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1056
	if (pdev == NULL) {
1057
		PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
L
Linus Torvalds 已提交
1058 1059 1060 1061 1062
		return -ENOMEM;
	}
	pdev->type = type_id;
	pdev->vframes = default_fps;
	pdev->features = features;
1063
	pwc_construct(pdev); /* set min/max sizes correct */
L
Linus Torvalds 已提交
1064

H
Hans de Goede 已提交
1065
	mutex_init(&pdev->capt_file_lock);
1066
	mutex_init(&pdev->udevlock);
1067 1068
	spin_lock_init(&pdev->queued_bufs_lock);
	INIT_LIST_HEAD(&pdev->queued_bufs);
L
Linus Torvalds 已提交
1069 1070 1071

	pdev->udev = udev;
	pdev->vcompression = pwc_preferred_compression;
1072
	pdev->power_save = my_power_save;
L
Linus Torvalds 已提交
1073

1074 1075 1076 1077 1078 1079 1080 1081 1082 1083
	/* Init videobuf2 queue structure */
	memset(&pdev->vb_queue, 0, sizeof(pdev->vb_queue));
	pdev->vb_queue.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
	pdev->vb_queue.io_modes = VB2_MMAP | VB2_USERPTR | VB2_READ;
	pdev->vb_queue.drv_priv = pdev;
	pdev->vb_queue.buf_struct_size = sizeof(struct pwc_frame_buf);
	pdev->vb_queue.ops = &pwc_vb_queue_ops;
	pdev->vb_queue.mem_ops = &vb2_vmalloc_memops;
	vb2_queue_init(&pdev->vb_queue);

1084 1085 1086
	/* Init video_device structure */
	memcpy(&pdev->vdev, &pwc_template, sizeof(pwc_template));
	strcpy(pdev->vdev.name, name);
1087
	set_bit(V4L2_FL_USE_FH_PRIO, &pdev->vdev.flags);
1088
	video_set_drvdata(&pdev->vdev, pdev);
L
Linus Torvalds 已提交
1089 1090

	pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
1091
	PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
L
Linus Torvalds 已提交
1092 1093 1094 1095 1096 1097 1098

	/* Now search device_hint[] table for a match, so we can hint a node number. */
	for (hint = 0; hint < MAX_DEV_HINTS; hint++) {
		if (((device_hint[hint].type == -1) || (device_hint[hint].type == pdev->type)) &&
		     (device_hint[hint].pdev == NULL)) {
			/* so far, so good... try serial number */
			if ((device_hint[hint].serial_number[0] == '*') || !strcmp(device_hint[hint].serial_number, serial_number)) {
1099 1100 1101 1102
				/* match! */
				video_nr = device_hint[hint].device_node;
				PWC_DEBUG_PROBE("Found hint, will try to register as /dev/video%d\n", video_nr);
				break;
L
Linus Torvalds 已提交
1103 1104 1105 1106 1107
			}
		}
	}

	/* occupy slot */
1108
	if (hint < MAX_DEV_HINTS)
L
Linus Torvalds 已提交
1109 1110
		device_hint[hint].pdev = pdev;

1111 1112 1113 1114 1115 1116 1117 1118 1119
#ifdef CONFIG_USB_PWC_DEBUG
	/* Query sensor type */
	if (pwc_get_cmos_sensor(pdev, &rc) >= 0) {
		PWC_DEBUG_OPEN("This %s camera is equipped with a %s (%d).\n",
				pdev->vdev.name,
				pwc_sensor_type_to_string(rc), rc);
	}
#endif

1120 1121
	/* Set the leds off */
	pwc_set_leds(pdev, 0, 0);
1122 1123

	/* Setup intial videomode */
1124
	rc = pwc_set_video_mode(pdev, MAX_WIDTH, MAX_HEIGHT,
1125
				pdev->vframes, pdev->vcompression);
1126 1127 1128
	if (rc)
		goto err_free_mem;

1129 1130 1131 1132 1133 1134 1135
	/* Register controls (and read default values from camera */
	rc = pwc_init_controls(pdev);
	if (rc) {
		PWC_ERROR("Failed to register v4l2 controls (%d).\n", rc);
		goto err_free_mem;
	}

1136
	/* And powerdown the camera until streaming starts */
1137 1138
	pwc_camera_power(pdev, 0);

1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149
	/* Register the v4l2_device structure */
	pdev->v4l2_dev.release = pwc_video_release;
	rc = v4l2_device_register(&intf->dev, &pdev->v4l2_dev);
	if (rc) {
		PWC_ERROR("Failed to register v4l2-device (%d).\n", rc);
		goto err_free_controls;
	}

	pdev->v4l2_dev.ctrl_handler = &pdev->ctrl_handler;
	pdev->vdev.v4l2_dev = &pdev->v4l2_dev;

1150
	rc = video_register_device(&pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1151 1152
	if (rc < 0) {
		PWC_ERROR("Failed to register as video device (%d).\n", rc);
1153
		goto err_unregister_v4l2_dev;
1154
	}
1155
	PWC_INFO("Registered as %s.\n", video_device_node_name(&pdev->vdev));
1156

1157 1158 1159 1160 1161
#ifdef CONFIG_USB_PWC_INPUT_EVDEV
	/* register webcam snapshot button input device */
	pdev->button_dev = input_allocate_device();
	if (!pdev->button_dev) {
		PWC_ERROR("Err, insufficient memory for webcam snapshot button device.");
1162 1163
		rc = -ENOMEM;
		goto err_video_unreg;
1164 1165
	}

1166 1167 1168
	usb_make_path(udev, pdev->button_phys, sizeof(pdev->button_phys));
	strlcat(pdev->button_phys, "/input0", sizeof(pdev->button_phys));

1169
	pdev->button_dev->name = "PWC snapshot button";
1170
	pdev->button_dev->phys = pdev->button_phys;
1171 1172 1173
	usb_to_input_id(pdev->udev, &pdev->button_dev->id);
	pdev->button_dev->dev.parent = &pdev->udev->dev;
	pdev->button_dev->evbit[0] = BIT_MASK(EV_KEY);
1174
	pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
1175 1176 1177 1178 1179

	rc = input_register_device(pdev->button_dev);
	if (rc) {
		input_free_device(pdev->button_dev);
		pdev->button_dev = NULL;
1180
		goto err_video_unreg;
1181 1182 1183
	}
#endif

L
Linus Torvalds 已提交
1184
	return 0;
1185

1186
err_video_unreg:
1187
	video_unregister_device(&pdev->vdev);
1188 1189
err_unregister_v4l2_dev:
	v4l2_device_unregister(&pdev->v4l2_dev);
1190 1191
err_free_controls:
	v4l2_ctrl_handler_free(&pdev->ctrl_handler);
1192
err_free_mem:
1193 1194
	if (hint < MAX_DEV_HINTS)
		device_hint[hint].pdev = NULL;
1195
	kfree(pdev);
1196
	return rc;
L
Linus Torvalds 已提交
1197 1198
}

1199
/* The user yanked out the cable... */
L
Linus Torvalds 已提交
1200 1201
static void usb_pwc_disconnect(struct usb_interface *intf)
{
1202 1203
	struct v4l2_device *v = usb_get_intfdata(intf);
	struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
L
Linus Torvalds 已提交
1204

1205
	mutex_lock(&pdev->udevlock);
1206 1207
	/* No need to keep the urbs around after disconnection */
	pwc_isoc_cleanup(pdev);
1208
	pdev->udev = NULL;
1209
	mutex_unlock(&pdev->udevlock);
1210

H
Hans de Goede 已提交
1211 1212
	pwc_cleanup_queued_bufs(pdev);

1213
	video_unregister_device(&pdev->vdev);
1214
	v4l2_device_unregister(&pdev->v4l2_dev);
1215 1216 1217 1218 1219

#ifdef CONFIG_USB_PWC_INPUT_EVDEV
	if (pdev->button_dev)
		input_unregister_device(pdev->button_dev);
#endif
1220 1221

	v4l2_device_put(&pdev->v4l2_dev);
L
Linus Torvalds 已提交
1222 1223 1224
}


1225 1226
/*
 * Initialization code & module stuff
L
Linus Torvalds 已提交
1227 1228
 */

1229
static int fps;
L
Linus Torvalds 已提交
1230 1231
static int compression = -1;
static int leds[2] = { -1, -1 };
1232
static unsigned int leds_nargs;
1233
static char *dev_hint[MAX_DEV_HINTS];
1234
static unsigned int dev_hint_nargs;
1235 1236

module_param(fps, int, 0444);
1237
#ifdef CONFIG_USB_PWC_DEBUG
1238 1239
module_param_named(trace, pwc_trace, int, 0644);
#endif
1240
module_param(power_save, int, 0644);
1241 1242 1243
module_param(compression, int, 0444);
module_param_array(leds, int, &leds_nargs, 0444);
module_param_array(dev_hint, charp, &dev_hint_nargs, 0444);
L
Linus Torvalds 已提交
1244 1245

MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
1246
#ifdef CONFIG_USB_PWC_DEBUG
L
Linus Torvalds 已提交
1247
MODULE_PARM_DESC(trace, "For debugging purposes");
1248
#endif
1249
MODULE_PARM_DESC(power_save, "Turn power saving for new cameras on or off");
L
Linus Torvalds 已提交
1250 1251 1252 1253 1254 1255 1256
MODULE_PARM_DESC(compression, "Preferred compression quality. Range 0 (uncompressed) to 3 (high compression)");
MODULE_PARM_DESC(leds, "LED on,off time in milliseconds");
MODULE_PARM_DESC(dev_hint, "Device node hints");

MODULE_DESCRIPTION("Philips & OEM USB webcam driver");
MODULE_AUTHOR("Luc Saillard <luc@saillard.org>");
MODULE_LICENSE("GPL");
1257 1258
MODULE_ALIAS("pwcx");
MODULE_VERSION( PWC_VERSION );
L
Linus Torvalds 已提交
1259 1260 1261

static int __init usb_pwc_init(void)
{
1262
	int i;
L
Linus Torvalds 已提交
1263

1264
#ifdef CONFIG_USB_PWC_DEBUG
1265 1266 1267 1268
	PWC_INFO("Philips webcam module version " PWC_VERSION " loaded.\n");
	PWC_INFO("Supports Philips PCA645/646, PCVC675/680/690, PCVC720[40]/730/740/750 & PCVC830/840.\n");
	PWC_INFO("Also supports the Askey VC010, various Logitech Quickcams, Samsung MPC-C10 and MPC-C30,\n");
	PWC_INFO("the Creative WebCam 5 & Pro Ex, SOTEC Afina Eye and Visionite VCS-UC300 and VCS-UM100.\n");
L
Linus Torvalds 已提交
1269

1270 1271 1272 1273 1274
	if (pwc_trace >= 0) {
		PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
	}
#endif

L
Linus Torvalds 已提交
1275 1276
	if (fps) {
		if (fps < 4 || fps > 30) {
1277
			PWC_ERROR("Framerate out of bounds (4-30).\n");
L
Linus Torvalds 已提交
1278 1279 1280
			return -EINVAL;
		}
		default_fps = fps;
1281
		PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
L
Linus Torvalds 已提交
1282 1283 1284 1285
	}

	if (compression >= 0) {
		if (compression > 3) {
1286
			PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
L
Linus Torvalds 已提交
1287 1288 1289
			return -EINVAL;
		}
		pwc_preferred_compression = compression;
1290
		PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
L
Linus Torvalds 已提交
1291 1292 1293 1294 1295 1296
	}
	if (leds[0] >= 0)
		led_on = leds[0];
	if (leds[1] >= 0)
		led_off = leds[1];

1297
	/* Big device node whoopla. Basically, it allows you to assign a
L
Linus Torvalds 已提交
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
	   device node (/dev/videoX) to a camera, based on its type
	   & serial number. The format is [type[.serialnumber]:]node.

	   Any camera that isn't matched by these rules gets the next
	   available free device node.
	 */
	for (i = 0; i < MAX_DEV_HINTS; i++) {
		char *s, *colon, *dot;

		/* This loop also initializes the array */
		device_hint[i].pdev = NULL;
		s = dev_hint[i];
		if (s != NULL && *s != '\0') {
			device_hint[i].type = -1; /* wildcard */
			strcpy(device_hint[i].serial_number, "*");

			/* parse string: chop at ':' & '/' */
			colon = dot = s;
			while (*colon != '\0' && *colon != ':')
				colon++;
			while (*dot != '\0' && *dot != '.')
				dot++;
			/* Few sanity checks */
			if (*dot != '\0' && dot > colon) {
1322
				PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
L
Linus Torvalds 已提交
1323 1324 1325 1326 1327 1328
				return -EINVAL;
			}

			if (*colon == '\0') {
				/* No colon */
				if (*dot != '\0') {
1329
					PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
L
Linus Torvalds 已提交
1330 1331 1332 1333
					return -EINVAL;
				}
				else {
					/* No type or serial number specified, just a number. */
1334 1335
					device_hint[i].device_node =
						simple_strtol(s, NULL, 10);
L
Linus Torvalds 已提交
1336 1337 1338 1339
				}
			}
			else {
				/* There's a colon, so we have at least a type and a device node */
1340 1341 1342 1343
				device_hint[i].type =
					simple_strtol(s, NULL, 10);
				device_hint[i].device_node =
					simple_strtol(colon + 1, NULL, 10);
L
Linus Torvalds 已提交
1344 1345 1346
				if (*dot != '\0') {
					/* There's a serial number as well */
					int k;
1347

L
Linus Torvalds 已提交
1348 1349 1350 1351 1352 1353 1354 1355 1356
					dot++;
					k = 0;
					while (*dot != ':' && k < 29) {
						device_hint[i].serial_number[k++] = *dot;
						dot++;
					}
					device_hint[i].serial_number[k] = '\0';
				}
			}
1357 1358 1359 1360
			PWC_TRACE("device_hint[%d]:\n", i);
			PWC_TRACE("  type    : %d\n", device_hint[i].type);
			PWC_TRACE("  serial# : %s\n", device_hint[i].serial_number);
			PWC_TRACE("  node    : %d\n", device_hint[i].device_node);
L
Linus Torvalds 已提交
1361 1362 1363 1364 1365
		}
		else
			device_hint[i].type = 0; /* not filled */
	} /* ..for MAX_DEV_HINTS */

1366
	PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
L
Linus Torvalds 已提交
1367 1368 1369 1370 1371
	return usb_register(&pwc_driver);
}

static void __exit usb_pwc_exit(void)
{
1372
	PWC_DEBUG_MODULE("Deregistering driver.\n");
L
Linus Torvalds 已提交
1373
	usb_deregister(&pwc_driver);
1374
	PWC_INFO("Philips webcam module removed.\n");
L
Linus Torvalds 已提交
1375 1376 1377 1378 1379
}

module_init(usb_pwc_init);
module_exit(usb_pwc_exit);

1380
/* vim: set cino= formatoptions=croql cindent shiftwidth=8 tabstop=8: */