pwc-if.c 41.5 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 82
#include "pwc-uncompress.h"

/* Function prototypes and driver templates */

/* hotplug device table support */
83
static const struct usb_device_id pwc_device_table [] = {
L
Linus Torvalds 已提交
84 85 86 87 88 89 90
	{ 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) },
91
	{ USB_DEVICE(0x0471, 0x0311) }, /* Philips ToUcam PRO II */
L
Linus Torvalds 已提交
92 93
	{ USB_DEVICE(0x0471, 0x0312) },
	{ USB_DEVICE(0x0471, 0x0313) }, /* the 'new' 720K */
94
	{ USB_DEVICE(0x0471, 0x0329) }, /* Philips SPC 900NC PC Camera */
L
Linus Torvalds 已提交
95 96 97 98 99 100 101
	{ 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 */
102 103
	{ USB_DEVICE(0x046D, 0x08B6) }, /* Cisco VT Camera */
	{ USB_DEVICE(0x046D, 0x08B7) }, /* Logitech ViewPort AV 100 */
L
Linus Torvalds 已提交
104
	{ USB_DEVICE(0x046D, 0x08B8) }, /* Logitech (reserved) */
105 106 107
	{ 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 已提交
108 109 110 111 112 113 114 115 116 117 118 119
	{ 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);
120
static void pwc_isoc_cleanup(struct pwc_device *pdev);
L
Linus Torvalds 已提交
121 122 123 124 125 126 127 128 129 130 131 132

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

/***/

148 149
static int pwc_video_open(struct file *file);
static int pwc_video_close(struct file *file);
150
static ssize_t pwc_video_read(struct file *file, char __user *buf,
L
Linus Torvalds 已提交
151 152 153
			  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);
154
static void pwc_video_release(struct video_device *vfd);
L
Linus Torvalds 已提交
155

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

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

175
struct pwc_frame_buf *pwc_get_next_fill_buf(struct pwc_device *pdev)
L
Linus Torvalds 已提交
176
{
177 178 179 180 181 182 183 184 185 186 187 188
	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;
189 190
}

191 192 193 194 195 196 197 198 199 200 201
static void pwc_snapshot_button(struct pwc_device *pdev, int down)
{
	if (down) {
		PWC_TRACE("Snapshot button pressed.\n");
		pdev->snapshot_button_status = 1;
	} else {
		PWC_TRACE("Snapshot button released.\n");
	}

#ifdef CONFIG_USB_PWC_INPUT_EVDEV
	if (pdev->button_dev) {
202
		input_report_key(pdev->button_dev, KEY_CAMERA, down);
203 204 205 206 207
		input_sync(pdev->button_dev);
	}
#endif
}

208
static void pwc_frame_complete(struct pwc_device *pdev)
209
{
210
	struct pwc_frame_buf *fbuf = pdev->fill_buf;
211 212 213 214 215 216 217 218 219 220 221 222 223

	/* 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) {
224
			pwc_snapshot_button(pdev, ptr[0] & 0x01);
225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243
		}
		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++;
244
	} else if (pdev->type == 740 || pdev->type == 720) {
245 246
		unsigned char *ptr = (unsigned char *)fbuf->data;
		if ((ptr[0] ^ pdev->vmirror) & 0x01) {
247
			pwc_snapshot_button(pdev, ptr[0] & 0x01);
248 249 250 251
		}
		pdev->vmirror = ptr[0] & 0x03;
	}

252 253
	/* In case we were instructed to drop the frame, do so silently. */
	if (pdev->drop_frames > 0) {
254
		pdev->drop_frames--;
255
	} else {
256 257 258 259
		/* Check for underflow first */
		if (fbuf->filled < pdev->frame_total_size) {
			PWC_DEBUG_FLOW("Frame buffer underflow (%d bytes);"
				       " discarded.\n", fbuf->filled);
260 261 262 263 264 265
		} 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;
266 267 268 269
		}
	} /* !drop_frames */
	pdev->vframe_count++;
}
L
Linus Torvalds 已提交
270 271 272 273

/* 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.
 */
274
static void pwc_isoc_handler(struct urb *urb)
L
Linus Torvalds 已提交
275
{
276
	struct pwc_device *pdev = (struct pwc_device *)urb->context;
L
Linus Torvalds 已提交
277
	int i, fst, flen;
278
	unsigned char *iso_buf = NULL;
L
Linus Torvalds 已提交
279

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

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

	if (urb->status != 0) {
L
Linus Torvalds 已提交
290 291 292 293 294 295 296 297 298
		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;
299
			case -ETIME:		errmsg = "Device does not respond"; break;
L
Linus Torvalds 已提交
300
		}
301 302 303
		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 已提交
304 305
		if (++pdev->visoc_errors > MAX_ISOC_ERRORS)
		{
306 307 308 309 310 311
			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 已提交
312
		}
313
		pdev->vsync = 0; /* Drop the current frame */
L
Linus Torvalds 已提交
314 315 316 317 318 319 320
		goto handler_end;
	}

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

	/* vsync: 0 = don't copy data
321 322
		  1 = sync-hunt
		  2 = synched
L
Linus Torvalds 已提交
323 324 325 326 327 328
	 */
	/* 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;
329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348
		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 已提交
349
				fbuf->filled += flen;
350 351 352 353 354 355 356 357 358 359
			}
		}
		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 已提交
360
				pdev->vsync = 1;
361
			}
L
Linus Torvalds 已提交
362
		}
363
		pdev->vlast_packet_size = flen;
L
Linus Torvalds 已提交
364 365 366 367 368
	}

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

372
static int pwc_isoc_init(struct pwc_device *pdev)
L
Linus Torvalds 已提交
373 374 375 376 377 378
{
	struct usb_device *udev;
	struct urb *urb;
	int i, j, ret;
	struct usb_interface *intf;
	struct usb_host_interface *idesc = NULL;
379
	void *kbuf;
L
Linus Torvalds 已提交
380 381 382

	if (pdev->iso_init)
		return 0;
383

L
Linus Torvalds 已提交
384
	pdev->vsync = 0;
385
	pdev->vlast_packet_size = 0;
386 387
	pdev->fill_buf = NULL;
	pdev->vframe_count = 0;
388
	pdev->visoc_errors = 0;
L
Linus Torvalds 已提交
389 390 391 392 393 394 395
	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)
396
		return -EIO;
L
Linus Torvalds 已提交
397 398 399

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

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

	/* Set alternate interface */
	ret = 0;
414
	PWC_DEBUG_OPEN("Setting alternate interface %d\n", pdev->valternate);
L
Linus Torvalds 已提交
415 416 417 418
	ret = usb_set_interface(pdev->udev, 0, pdev->valternate);
	if (ret < 0)
		return ret;

419 420 421 422 423 424 425 426 427 428 429 430 431 432
	/* Allocate Isochronuous pipe buffers */
	for (i = 0; i < MAX_ISO_BUFS; i++) {
		kbuf = kzalloc(ISO_BUFFER_SIZE, GFP_KERNEL);
		if (kbuf == NULL) {
			PWC_ERROR("Failed to allocate iso buffer %d.\n", i);
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return -ENOMEM;
		}
		PWC_DEBUG_MEMORY("Allocated iso buffer at %p.\n", kbuf);
		pdev->sbuf[i].data = kbuf;
	}

	/* Allocate Isochronuous urbs */
L
Linus Torvalds 已提交
433 434 435
	for (i = 0; i < MAX_ISO_BUFS; i++) {
		urb = usb_alloc_urb(ISO_FRAMES_PER_DESC, GFP_KERNEL);
		if (urb == NULL) {
436
			PWC_ERROR("Failed to allocate urb %d\n", i);
437 438 439
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return -ENOMEM;
L
Linus Torvalds 已提交
440 441
		}
		pdev->sbuf[i].urb = urb;
442
		PWC_DEBUG_MEMORY("Allocated URB at 0x%p\n", urb);
L
Linus Torvalds 已提交
443 444
	}

445
	/* init URB structure */
L
Linus Torvalds 已提交
446 447 448 449 450
	for (i = 0; i < MAX_ISO_BUFS; i++) {
		urb = pdev->sbuf[i].urb;

		urb->interval = 1; // devik
		urb->dev = udev;
451
		urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
L
Linus Torvalds 已提交
452
		urb->transfer_flags = URB_ISO_ASAP;
453 454 455 456
		urb->transfer_buffer = pdev->sbuf[i].data;
		urb->transfer_buffer_length = ISO_BUFFER_SIZE;
		urb->complete = pwc_isoc_handler;
		urb->context = pdev;
L
Linus Torvalds 已提交
457 458 459 460 461 462 463 464 465 466 467
		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++) {
		ret = usb_submit_urb(pdev->sbuf[i].urb, GFP_KERNEL);
468
		if (ret) {
469
			PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
470 471 472 473 474
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return ret;
		}
		PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->sbuf[i].urb);
L
Linus Torvalds 已提交
475 476 477 478
	}

	/* All is done... */
	pdev->iso_init = 1;
479
	PWC_DEBUG_OPEN("<< pwc_isoc_init()\n");
L
Linus Torvalds 已提交
480 481 482
	return 0;
}

483
static void pwc_iso_stop(struct pwc_device *pdev)
L
Linus Torvalds 已提交
484 485 486 487 488 489 490 491
{
	int i;

	/* Unlinking ISOC buffers one by one */
	for (i = 0; i < MAX_ISO_BUFS; i++) {
		struct urb *urb;

		urb = pdev->sbuf[i].urb;
A
Al Viro 已提交
492
		if (urb) {
493 494 495 496 497 498 499 500 501 502 503 504 505 506 507
			PWC_DEBUG_MEMORY("Unlinking URB %p\n", urb);
			usb_kill_urb(urb);
		}
	}
}

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++) {
		struct urb *urb;

		urb = pdev->sbuf[i].urb;
A
Al Viro 已提交
508
		if (urb) {
509
			PWC_DEBUG_MEMORY("Freeing URB\n");
L
Linus Torvalds 已提交
510 511 512 513
			usb_free_urb(urb);
			pdev->sbuf[i].urb = NULL;
		}
	}
514 515
}

516
static void pwc_isoc_cleanup(struct pwc_device *pdev)
517
{
518 519
	int i;

520
	PWC_DEBUG_OPEN(">> pwc_isoc_cleanup()\n");
521

522 523 524 525 526
	if (pdev->iso_init == 0)
		return;

	pwc_iso_stop(pdev);
	pwc_iso_free(pdev);
527
	usb_set_interface(pdev->udev, 0, 0);
L
Linus Torvalds 已提交
528

529 530 531 532 533 534 535 536 537 538
	/* Release Iso-pipe buffers */
	for (i = 0; i < MAX_ISO_BUFS; i++) {
		if (pdev->sbuf[i].data != NULL) {
			PWC_DEBUG_MEMORY("Freeing ISO buffer at %p.\n",
					 pdev->sbuf[i].data);
			kfree(pdev->sbuf[i].data);
			pdev->sbuf[i].data = NULL;
		}
	}

L
Linus Torvalds 已提交
539
	pdev->iso_init = 0;
540
	PWC_DEBUG_OPEN("<< pwc_isoc_cleanup()\n");
L
Linus Torvalds 已提交
541 542
}

543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558
/*
 * Release all queued buffers, no need to take queued_bufs_lock, since all
 * iso urbs have been killed when we're called so pwc_isoc_handler won't run.
 */
static void pwc_cleanup_queued_bufs(struct pwc_device *pdev)
{
	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);
	}
}

559 560 561
/*********
 * sysfs
 *********/
562
static struct pwc_device *cd_to_pwc(struct device *cd)
563 564 565 566 567
{
	struct video_device *vdev = to_video_device(cd);
	return video_get_drvdata(vdev);
}

568 569
static ssize_t show_pan_tilt(struct device *class_dev,
			     struct device_attribute *attr, char *buf)
570 571 572 573 574
{
	struct pwc_device *pdev = cd_to_pwc(class_dev);
	return sprintf(buf, "%d %d\n", pdev->pan_angle, pdev->tilt_angle);
}

575 576 577
static ssize_t store_pan_tilt(struct device *class_dev,
			      struct device_attribute *attr,
			      const char *buf, size_t count)
578 579 580 581 582 583 584 585 586 587 588 589 590 591 592
{
	struct pwc_device *pdev = cd_to_pwc(class_dev);
	int pan, tilt;
	int ret = -EINVAL;

	if (strncmp(buf, "reset", 5) == 0)
		ret = pwc_mpt_reset(pdev, 0x3);

	else if (sscanf(buf, "%d %d", &pan, &tilt) > 0)
		ret = pwc_mpt_set_angle(pdev, pan, tilt);

	if (ret < 0)
		return ret;
	return strlen(buf);
}
593 594
static DEVICE_ATTR(pan_tilt, S_IRUGO | S_IWUSR, show_pan_tilt,
		   store_pan_tilt);
595

596 597
static ssize_t show_snapshot_button_status(struct device *class_dev,
					   struct device_attribute *attr, char *buf)
598 599 600 601 602 603 604
{
	struct pwc_device *pdev = cd_to_pwc(class_dev);
	int status = pdev->snapshot_button_status;
	pdev->snapshot_button_status = 0;
	return sprintf(buf, "%d\n", status);
}

605 606
static DEVICE_ATTR(button, S_IRUGO | S_IWUSR, show_snapshot_button_status,
		   NULL);
607

608
static int pwc_create_sysfs_files(struct pwc_device *pdev)
609
{
610 611
	int rc;

612
	rc = device_create_file(&pdev->vdev.dev, &dev_attr_button);
613 614 615
	if (rc)
		goto err;
	if (pdev->features & FEATURE_MOTOR_PANTILT) {
616
		rc = device_create_file(&pdev->vdev.dev, &dev_attr_pan_tilt);
617 618
		if (rc)
			goto err_button;
619 620 621 622 623
	}

	return 0;

err_button:
624
	device_remove_file(&pdev->vdev.dev, &dev_attr_button);
625
err:
626
	PWC_ERROR("Could not create sysfs files.\n");
627
	return rc;
628 629
}

630
static void pwc_remove_sysfs_files(struct pwc_device *pdev)
631 632
{
	if (pdev->features & FEATURE_MOTOR_PANTILT)
633 634
		device_remove_file(&pdev->vdev.dev, &dev_attr_pan_tilt);
	device_remove_file(&pdev->vdev.dev, &dev_attr_button);
635 636
}

637
#ifdef CONFIG_USB_PWC_DEBUG
638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661
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:
662
			return "unknown type of sensor";
663 664 665
	}
}
#endif
L
Linus Torvalds 已提交
666 667 668 669

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

670
static int pwc_video_open(struct file *file)
L
Linus Torvalds 已提交
671 672 673 674
{
	struct video_device *vdev = video_devdata(file);
	struct pwc_device *pdev;

675
	PWC_DEBUG_OPEN(">> video_open called(vdev = 0x%p).\n", vdev);
676

677
	pdev = video_get_drvdata(vdev);
678 679 680
	if (!pdev->udev)
		return -ENODEV;

681 682
	if (pdev->vopen) {
		PWC_DEBUG_OPEN("I'm busy, someone is using the device.\n");
L
Linus Torvalds 已提交
683
		return -EBUSY;
684
	}
685

L
Linus Torvalds 已提交
686 687
	pdev->vopen++;
	file->private_data = vdev;
688
	PWC_DEBUG_OPEN("<< video_open() returns 0.\n");
L
Linus Torvalds 已提交
689 690 691
	return 0;
}

692
static void pwc_video_release(struct video_device *vfd)
693
{
694 695
	struct pwc_device *pdev = container_of(vfd, struct pwc_device, vdev);
	int hint;
696

697 698 699 700
	/* 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;
701

702 703 704 705 706 707 708 709
	/* 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;
	}

710
	kfree(pdev);
711 712
}

713
static int pwc_video_close(struct file *file)
L
Linus Torvalds 已提交
714 715 716 717
{
	struct video_device *vdev = file->private_data;
	struct pwc_device *pdev;

718
	PWC_DEBUG_OPEN(">> video_close called(vdev = 0x%p).\n", vdev);
L
Linus Torvalds 已提交
719

720
	pdev = video_get_drvdata(vdev);
721
	vb2_queue_release(&pdev->vb_queue);
722
	pdev->vopen--;
723

724
	PWC_DEBUG_OPEN("<< video_close() vopen=%d\n", pdev->vopen);
L
Linus Torvalds 已提交
725 726 727
	return 0;
}

728
static ssize_t pwc_video_read(struct file *file, char __user *buf,
729
			      size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
730 731
{
	struct video_device *vdev = file->private_data;
732
	struct pwc_device *pdev = video_get_drvdata(vdev);
L
Linus Torvalds 已提交
733

734 735
	if (!pdev->udev)
		return -ENODEV;
736

737 738 739
	return vb2_read(&pdev->vb_queue, buf, count, ppos,
			file->f_flags & O_NONBLOCK);
}
L
Linus Torvalds 已提交
740

741 742 743 744
static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
{
	struct video_device *vdev = file->private_data;
	struct pwc_device *pdev = video_get_drvdata(vdev);
745

746
	if (!pdev->udev)
747
		return POLL_ERR;
L
Linus Torvalds 已提交
748

749
	return vb2_poll(&pdev->vb_queue, file, wait);
L
Linus Torvalds 已提交
750 751
}

752
static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
L
Linus Torvalds 已提交
753 754
{
	struct video_device *vdev = file->private_data;
755
	struct pwc_device *pdev = video_get_drvdata(vdev);
L
Linus Torvalds 已提交
756

757 758
	return vb2_mmap(&pdev->vb_queue, vma);
}
L
Linus Torvalds 已提交
759

760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783
/***************************************************************************/
/* Videobuf2 operations */

static int queue_setup(struct vb2_queue *vq, unsigned int *nbuffers,
				unsigned int *nplanes, unsigned long sizes[],
				void *alloc_ctxs[])
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);

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

	*nplanes = 1;

	sizes[0] = PAGE_ALIGN((pdev->abs_max.x * pdev->abs_max.y * 3) / 2);

	return 0;
}

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

785 786 787 788 789 790 791 792 793 794 795 796 797
	/* 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 */
798 799
	if (!pdev->udev)
		return -ENODEV;
L
Linus Torvalds 已提交
800 801 802 803

	return 0;
}

804
static int buffer_finish(struct vb2_buffer *vb)
L
Linus Torvalds 已提交
805
{
806 807
	struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
	struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
808

809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838
	/*
	 * 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);
	list_add_tail(&buf->list, &pdev->queued_bufs);
	spin_unlock_irqrestore(&pdev->queued_bufs_lock, flags);
}

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

839 840 841
	if (!pdev->udev)
		return -ENODEV;

842 843 844 845 846 847 848 849 850 851
	/* Turn on camera and set LEDS on */
	pwc_camera_power(pdev, 1);
	if (pdev->power_save) {
		/* Restore video mode */
		pwc_set_video_mode(pdev, pdev->view.x, pdev->view.y,
				   pdev->vframes, pdev->vcompression,
				   pdev->vsnapshot);
	}
	pwc_set_leds(pdev, led_on, led_off);

852 853 854 855 856 857 858
	return pwc_isoc_init(pdev);
}

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

859 860 861
	if (pdev->udev) {
		pwc_set_leds(pdev, 0, 0);
		pwc_camera_power(pdev, 0);
862
		pwc_isoc_cleanup(pdev);
863
	}
864
	pwc_cleanup_queued_bufs(pdev);
865

L
Linus Torvalds 已提交
866 867 868
	return 0;
}

869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893
static void pwc_lock(struct vb2_queue *vq)
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);
	mutex_lock(&pdev->modlock);
}

static void pwc_unlock(struct vb2_queue *vq)
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);
	mutex_unlock(&pdev->modlock);
}

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,
	.wait_prepare		= pwc_unlock,
	.wait_finish		= pwc_lock,
};

L
Linus Torvalds 已提交
894 895 896 897 898 899 900 901 902 903 904 905
/***************************************************************************/
/* 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;
906
	int hint, rc;
L
Linus Torvalds 已提交
907 908
	int features = 0;
	int video_nr = -1; /* default: use next available device */
909
	int my_power_save = power_save;
L
Linus Torvalds 已提交
910 911
	char serial_number[30], *name;

912 913 914
	vendor_id = le16_to_cpu(udev->descriptor.idVendor);
	product_id = le16_to_cpu(udev->descriptor.idProduct);

L
Linus Torvalds 已提交
915
	/* Check if we can handle this device */
916 917
	PWC_DEBUG_PROBE("probe() called [%04X %04X], if %d\n",
		vendor_id, product_id,
L
Linus Torvalds 已提交
918 919 920 921 922 923 924 925 926 927 928 929
		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:
930
			PWC_INFO("Philips PCA645VC USB webcam detected.\n");
L
Linus Torvalds 已提交
931 932 933 934
			name = "Philips 645 webcam";
			type_id = 645;
			break;
		case 0x0303:
935
			PWC_INFO("Philips PCA646VC USB webcam detected.\n");
L
Linus Torvalds 已提交
936 937 938 939
			name = "Philips 646 webcam";
			type_id = 646;
			break;
		case 0x0304:
940
			PWC_INFO("Askey VC010 type 2 USB webcam detected.\n");
L
Linus Torvalds 已提交
941 942 943 944
			name = "Askey VC010 webcam";
			type_id = 646;
			break;
		case 0x0307:
945
			PWC_INFO("Philips PCVC675K (Vesta) USB webcam detected.\n");
L
Linus Torvalds 已提交
946 947 948 949
			name = "Philips 675 webcam";
			type_id = 675;
			break;
		case 0x0308:
950
			PWC_INFO("Philips PCVC680K (Vesta Pro) USB webcam detected.\n");
L
Linus Torvalds 已提交
951 952 953 954
			name = "Philips 680 webcam";
			type_id = 680;
			break;
		case 0x030C:
955
			PWC_INFO("Philips PCVC690K (Vesta Pro Scan) USB webcam detected.\n");
L
Linus Torvalds 已提交
956 957 958 959
			name = "Philips 690 webcam";
			type_id = 690;
			break;
		case 0x0310:
960
			PWC_INFO("Philips PCVC730K (ToUCam Fun)/PCVC830 (ToUCam II) USB webcam detected.\n");
L
Linus Torvalds 已提交
961 962 963 964
			name = "Philips 730 webcam";
			type_id = 730;
			break;
		case 0x0311:
965
			PWC_INFO("Philips PCVC740K (ToUCam Pro)/PCVC840 (ToUCam II) USB webcam detected.\n");
L
Linus Torvalds 已提交
966 967 968 969
			name = "Philips 740 webcam";
			type_id = 740;
			break;
		case 0x0312:
970
			PWC_INFO("Philips PCVC750K (ToUCam Pro Scan) USB webcam detected.\n");
L
Linus Torvalds 已提交
971 972 973 974
			name = "Philips 750 webcam";
			type_id = 750;
			break;
		case 0x0313:
975
			PWC_INFO("Philips PCVC720K/40 (ToUCam XS) USB webcam detected.\n");
L
Linus Torvalds 已提交
976 977 978
			name = "Philips 720K/40 webcam";
			type_id = 720;
			break;
979 980 981
		case 0x0329:
			PWC_INFO("Philips SPC 900NC USB webcam detected.\n");
			name = "Philips SPC 900NC webcam";
982
			type_id = 740;
983
			break;
L
Linus Torvalds 已提交
984 985 986 987 988 989 990 991
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x069A) {
		switch(product_id) {
		case 0x0001:
992
			PWC_INFO("Askey VC010 type 1 USB webcam detected.\n");
L
Linus Torvalds 已提交
993 994 995 996 997 998 999 1000 1001 1002 1003
			name = "Askey VC010 webcam";
			type_id = 645;
			break;
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x046d) {
		switch(product_id) {
		case 0x08b0:
1004
			PWC_INFO("Logitech QuickCam Pro 3000 USB webcam detected.\n");
L
Linus Torvalds 已提交
1005 1006 1007 1008
			name = "Logitech QuickCam Pro 3000";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08b1:
1009
			PWC_INFO("Logitech QuickCam Notebook Pro USB webcam detected.\n");
L
Linus Torvalds 已提交
1010 1011 1012 1013
			name = "Logitech QuickCam Notebook Pro";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08b2:
1014
			PWC_INFO("Logitech QuickCam 4000 Pro USB webcam detected.\n");
L
Linus Torvalds 已提交
1015 1016 1017 1018
			name = "Logitech QuickCam Pro 4000";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08b3:
1019
			PWC_INFO("Logitech QuickCam Zoom USB webcam detected.\n");
L
Linus Torvalds 已提交
1020 1021 1022 1023
			name = "Logitech QuickCam Zoom";
			type_id = 740; /* CCD sensor */
			break;
		case 0x08B4:
1024
			PWC_INFO("Logitech QuickCam Zoom (new model) USB webcam detected.\n");
L
Linus Torvalds 已提交
1025 1026
			name = "Logitech QuickCam Zoom";
			type_id = 740; /* CCD sensor */
1027 1028
			if (my_power_save == -1)
				my_power_save = 1;
L
Linus Torvalds 已提交
1029 1030
			break;
		case 0x08b5:
1031
			PWC_INFO("Logitech QuickCam Orbit/Sphere USB webcam detected.\n");
L
Linus Torvalds 已提交
1032 1033 1034 1035 1036
			name = "Logitech QuickCam Orbit";
			type_id = 740; /* CCD sensor */
			features |= FEATURE_MOTOR_PANTILT;
			break;
		case 0x08b6:
1037 1038 1039 1040
			PWC_INFO("Logitech/Cisco VT Camera webcam detected.\n");
			name = "Cisco VT Camera";
			type_id = 740; /* CCD sensor */
			break;
L
Linus Torvalds 已提交
1041
		case 0x08b7:
1042 1043 1044 1045 1046
			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? */
1047
			PWC_INFO("Logitech QuickCam detected (reserved ID).\n");
L
Linus Torvalds 已提交
1048 1049 1050
			name = "Logitech QuickCam (res.)";
			type_id = 730; /* Assuming CMOS */
			break;
1051
		default:
L
Linus Torvalds 已提交
1052
			return -ENODEV;
1053 1054 1055
			break;
		}
	}
L
Linus Torvalds 已提交
1056 1057 1058 1059 1060 1061 1062
	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:
1063
			PWC_INFO("Samsung MPC-C10 USB webcam detected.\n");
L
Linus Torvalds 已提交
1064 1065 1066 1067
			name = "Samsung MPC-C10";
			type_id = 675;
			break;
		case 0x9001:
1068
			PWC_INFO("Samsung MPC-C30 USB webcam detected.\n");
L
Linus Torvalds 已提交
1069 1070 1071
			name = "Samsung MPC-C30";
			type_id = 675;
			break;
1072 1073 1074 1075 1076
		case 0x9002:
			PWC_INFO("Samsung SNC-35E (v3.0) USB webcam detected.\n");
			name = "Samsung MPC-C30";
			type_id = 740;
			break;
L
Linus Torvalds 已提交
1077 1078 1079 1080 1081 1082 1083 1084
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x041e) {
		switch(product_id) {
		case 0x400c:
1085
			PWC_INFO("Creative Labs Webcam 5 detected.\n");
L
Linus Torvalds 已提交
1086 1087 1088 1089
			name = "Creative Labs Webcam 5";
			type_id = 730;
			break;
		case 0x4011:
1090
			PWC_INFO("Creative Labs Webcam Pro Ex detected.\n");
L
Linus Torvalds 已提交
1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101
			name = "Creative Labs Webcam Pro Ex";
			type_id = 740;
			break;
		default:
			return -ENODEV;
			break;
		}
	}
	else if (vendor_id == 0x04cc) {
		switch(product_id) {
		case 0x8116:
1102
			PWC_INFO("Sotec Afina Eye USB webcam detected.\n");
L
Linus Torvalds 已提交
1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
			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 */
1115
			PWC_INFO("AME Co. Afina Eye USB webcam detected.\n");
L
Linus Torvalds 已提交
1116 1117 1118 1119 1120 1121 1122
			name = "AME Co. Afina Eye";
			type_id = 750;
			break;
		default:
			return -ENODEV;
			break;
		}
1123

L
Linus Torvalds 已提交
1124 1125 1126 1127
	}
	else if (vendor_id == 0x0d81) {
		switch(product_id) {
		case 0x1900:
1128
			PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
L
Linus Torvalds 已提交
1129 1130 1131 1132
			name = "Visionite VCS-UC300";
			type_id = 740; /* CCD sensor */
			break;
		case 0x1910:
1133
			PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
L
Linus Torvalds 已提交
1134 1135 1136 1137 1138 1139 1140 1141
			name = "Visionite VCS-UM100";
			type_id = 730; /* CMOS sensor */
			break;
		default:
			return -ENODEV;
			break;
		}
	}
1142
	else
L
Linus Torvalds 已提交
1143 1144
		return -ENODEV; /* Not any of the know types; but the list keeps growing. */

1145 1146 1147
	if (my_power_save == -1)
		my_power_save = 0;

L
Linus Torvalds 已提交
1148 1149
	memset(serial_number, 0, 30);
	usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
1150
	PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
L
Linus Torvalds 已提交
1151 1152

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

	/* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
1156
	pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1157
	if (pdev == NULL) {
1158
		PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
L
Linus Torvalds 已提交
1159 1160 1161 1162 1163 1164
		return -ENOMEM;
	}
	pdev->type = type_id;
	pdev->vframes = default_fps;
	strcpy(pdev->serial, serial_number);
	pdev->features = features;
1165
	if (vendor_id == 0x046D && product_id == 0x08B5) {
L
Linus Torvalds 已提交
1166
		/* Logitech QuickCam Orbit
1167 1168 1169
		   The ranges have been determined experimentally; they may differ from cam to cam.
		   Also, the exact ranges left-right and up-down are different for my cam
		  */
L
Linus Torvalds 已提交
1170 1171 1172 1173 1174
		pdev->angle_range.pan_min  = -7000;
		pdev->angle_range.pan_max  =  7000;
		pdev->angle_range.tilt_min = -3000;
		pdev->angle_range.tilt_max =  2500;
	}
1175
	pwc_construct(pdev); /* set min/max sizes correct */
L
Linus Torvalds 已提交
1176

1177
	mutex_init(&pdev->modlock);
1178 1179
	spin_lock_init(&pdev->queued_bufs_lock);
	INIT_LIST_HEAD(&pdev->queued_bufs);
L
Linus Torvalds 已提交
1180 1181 1182

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

1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
	/* 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);

1195 1196 1197 1198 1199 1200
	/* Init video_device structure */
	memcpy(&pdev->vdev, &pwc_template, sizeof(pwc_template));
	pdev->vdev.parent = &intf->dev;
	pdev->vdev.lock = &pdev->modlock;
	strcpy(pdev->vdev.name, name);
	video_set_drvdata(&pdev->vdev, pdev);
L
Linus Torvalds 已提交
1201 1202

	pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
1203
	PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
L
Linus Torvalds 已提交
1204 1205 1206 1207 1208 1209 1210

	/* 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)) {
1211 1212 1213 1214
				/* 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 已提交
1215 1216 1217 1218 1219
			}
		}
	}

	/* occupy slot */
1220
	if (hint < MAX_DEV_HINTS)
L
Linus Torvalds 已提交
1221 1222
		device_hint[hint].pdev = pdev;

1223
	PWC_DEBUG_PROBE("probe() function returning struct at 0x%p.\n", pdev);
1224
	usb_set_intfdata(intf, pdev);
1225

1226 1227 1228 1229 1230 1231 1232 1233 1234
#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

1235 1236
	/* Set the leds off */
	pwc_set_leds(pdev, 0, 0);
1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248

	/* Setup intial videomode */
	rc = pwc_set_video_mode(pdev, pdev->view_max.x, pdev->view_max.y,
				pdev->vframes, pdev->vcompression, 0);
	if (rc)
		goto err_free_mem;

	/* Initialize the webcam to sane values */
	pwc_set_brightness(pdev, 0x7fff);
	pwc_set_agc(pdev, 1, 0);

	/* And powerdown the camera until streaming starts */
1249 1250
	pwc_camera_power(pdev, 0);

1251
	rc = video_register_device(&pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1252 1253
	if (rc < 0) {
		PWC_ERROR("Failed to register as video device (%d).\n", rc);
1254
		goto err_free_mem;
1255
	}
1256
	rc = pwc_create_sysfs_files(pdev);
1257 1258 1259
	if (rc)
		goto err_video_unreg;

1260
	PWC_INFO("Registered as %s.\n", video_device_node_name(&pdev->vdev));
1261

1262 1263 1264 1265 1266
#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.");
1267
		rc = -ENOMEM;
1268
		pwc_remove_sysfs_files(pdev);
1269
		goto err_video_unreg;
1270 1271
	}

1272 1273 1274
	usb_make_path(udev, pdev->button_phys, sizeof(pdev->button_phys));
	strlcat(pdev->button_phys, "/input0", sizeof(pdev->button_phys));

1275
	pdev->button_dev->name = "PWC snapshot button";
1276
	pdev->button_dev->phys = pdev->button_phys;
1277 1278 1279
	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);
1280
	pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
1281 1282 1283 1284 1285

	rc = input_register_device(pdev->button_dev);
	if (rc) {
		input_free_device(pdev->button_dev);
		pdev->button_dev = NULL;
1286
		pwc_remove_sysfs_files(pdev);
1287
		goto err_video_unreg;
1288 1289 1290
	}
#endif

L
Linus Torvalds 已提交
1291
	return 0;
1292

1293
err_video_unreg:
1294 1295
	if (hint < MAX_DEV_HINTS)
		device_hint[hint].pdev = NULL;
1296
	video_unregister_device(&pdev->vdev);
1297 1298
err_free_mem:
	kfree(pdev);
1299
	return rc;
L
Linus Torvalds 已提交
1300 1301
}

1302
/* The user yanked out the cable... */
L
Linus Torvalds 已提交
1303 1304
static void usb_pwc_disconnect(struct usb_interface *intf)
{
1305
	struct pwc_device *pdev  = usb_get_intfdata(intf);
L
Linus Torvalds 已提交
1306

H
Hans Verkuil 已提交
1307
	mutex_lock(&pdev->modlock);
L
Linus Torvalds 已提交
1308

1309
	usb_set_intfdata(intf, NULL);
1310 1311
	/* No need to keep the urbs around after disconnection */
	pwc_isoc_cleanup(pdev);
1312
	pwc_cleanup_queued_bufs(pdev);
1313
	pdev->udev = NULL;
L
Linus Torvalds 已提交
1314

H
Hans Verkuil 已提交
1315
	mutex_unlock(&pdev->modlock);
1316 1317 1318 1319 1320 1321 1322 1323

	pwc_remove_sysfs_files(pdev);
	video_unregister_device(&pdev->vdev);

#ifdef CONFIG_USB_PWC_INPUT_EVDEV
	if (pdev->button_dev)
		input_unregister_device(pdev->button_dev);
#endif
L
Linus Torvalds 已提交
1324 1325 1326
}


1327 1328
/*
 * Initialization code & module stuff
L
Linus Torvalds 已提交
1329 1330
 */

1331
static int fps;
L
Linus Torvalds 已提交
1332 1333
static int compression = -1;
static int leds[2] = { -1, -1 };
1334
static unsigned int leds_nargs;
1335
static char *dev_hint[MAX_DEV_HINTS];
1336
static unsigned int dev_hint_nargs;
1337 1338

module_param(fps, int, 0444);
1339
#ifdef CONFIG_USB_PWC_DEBUG
1340 1341
module_param_named(trace, pwc_trace, int, 0644);
#endif
1342
module_param(power_save, int, 0644);
1343 1344 1345
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 已提交
1346 1347

MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
1348
#ifdef CONFIG_USB_PWC_DEBUG
L
Linus Torvalds 已提交
1349
MODULE_PARM_DESC(trace, "For debugging purposes");
1350
#endif
1351
MODULE_PARM_DESC(power_save, "Turn power saving for new cameras on or off");
L
Linus Torvalds 已提交
1352 1353 1354 1355 1356 1357 1358
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");
1359 1360
MODULE_ALIAS("pwcx");
MODULE_VERSION( PWC_VERSION );
L
Linus Torvalds 已提交
1361 1362 1363

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

1366
#ifdef CONFIG_USB_PWC_DEBUG
1367 1368 1369 1370
	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 已提交
1371

1372 1373 1374 1375 1376
	if (pwc_trace >= 0) {
		PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
	}
#endif

L
Linus Torvalds 已提交
1377 1378
	if (fps) {
		if (fps < 4 || fps > 30) {
1379
			PWC_ERROR("Framerate out of bounds (4-30).\n");
L
Linus Torvalds 已提交
1380 1381 1382
			return -EINVAL;
		}
		default_fps = fps;
1383
		PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
L
Linus Torvalds 已提交
1384 1385 1386 1387
	}

	if (compression >= 0) {
		if (compression > 3) {
1388
			PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
L
Linus Torvalds 已提交
1389 1390 1391
			return -EINVAL;
		}
		pwc_preferred_compression = compression;
1392
		PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
L
Linus Torvalds 已提交
1393 1394 1395 1396 1397 1398
	}
	if (leds[0] >= 0)
		led_on = leds[0];
	if (leds[1] >= 0)
		led_off = leds[1];

1399
	/* Big device node whoopla. Basically, it allows you to assign a
L
Linus Torvalds 已提交
1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
	   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) {
1424
				PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
L
Linus Torvalds 已提交
1425 1426 1427 1428 1429 1430
				return -EINVAL;
			}

			if (*colon == '\0') {
				/* No colon */
				if (*dot != '\0') {
1431
					PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
L
Linus Torvalds 已提交
1432 1433 1434 1435
					return -EINVAL;
				}
				else {
					/* No type or serial number specified, just a number. */
1436 1437
					device_hint[i].device_node =
						simple_strtol(s, NULL, 10);
L
Linus Torvalds 已提交
1438 1439 1440 1441
				}
			}
			else {
				/* There's a colon, so we have at least a type and a device node */
1442 1443 1444 1445
				device_hint[i].type =
					simple_strtol(s, NULL, 10);
				device_hint[i].device_node =
					simple_strtol(colon + 1, NULL, 10);
L
Linus Torvalds 已提交
1446 1447 1448
				if (*dot != '\0') {
					/* There's a serial number as well */
					int k;
1449

L
Linus Torvalds 已提交
1450 1451 1452 1453 1454 1455 1456 1457 1458
					dot++;
					k = 0;
					while (*dot != ':' && k < 29) {
						device_hint[i].serial_number[k++] = *dot;
						dot++;
					}
					device_hint[i].serial_number[k] = '\0';
				}
			}
1459 1460 1461 1462
			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 已提交
1463 1464 1465 1466 1467
		}
		else
			device_hint[i].type = 0; /* not filled */
	} /* ..for MAX_DEV_HINTS */

1468
	PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
L
Linus Torvalds 已提交
1469 1470 1471 1472 1473
	return usb_register(&pwc_driver);
}

static void __exit usb_pwc_exit(void)
{
1474
	PWC_DEBUG_MODULE("Deregistering driver.\n");
L
Linus Torvalds 已提交
1475
	usb_deregister(&pwc_driver);
1476
	PWC_INFO("Philips webcam module removed.\n");
L
Linus Torvalds 已提交
1477 1478 1479 1480 1481
}

module_init(usb_pwc_init);
module_exit(usb_pwc_exit);

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