pwc-if.c 41.4 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 198
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) {
199
		input_report_key(pdev->button_dev, KEY_CAMERA, down);
200 201 202 203 204
		input_sync(pdev->button_dev);
	}
#endif
}

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

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

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

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

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

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

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

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

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

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

369
static int pwc_isoc_init(struct pwc_device *pdev)
L
Linus Torvalds 已提交
370 371 372 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;

	if (pdev->iso_init)
		return 0;
379

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

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

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

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

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

		urb->interval = 1; // devik
		urb->dev = udev;
429
		urb->pipe = usb_rcvisocpipe(udev, pdev->vendpoint);
430 431 432 433 434 435 436 437 438 439 440
		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;
		}
441 442 443
		urb->transfer_buffer_length = ISO_BUFFER_SIZE;
		urb->complete = pwc_isoc_handler;
		urb->context = pdev;
L
Linus Torvalds 已提交
444 445 446 447 448 449 450 451 452 453
		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++) {
454
		ret = usb_submit_urb(pdev->urbs[i], GFP_KERNEL);
455
		if (ret) {
456
			PWC_ERROR("isoc_init() submit_urb %d failed with error %d\n", i, ret);
457 458 459 460
			pdev->iso_init = 1;
			pwc_isoc_cleanup(pdev);
			return ret;
		}
461
		PWC_DEBUG_MEMORY("URB 0x%p submitted.\n", pdev->urbs[i]);
L
Linus Torvalds 已提交
462 463 464 465
	}

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

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

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

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++) {
489
		if (pdev->urbs[i]) {
490
			PWC_DEBUG_MEMORY("Freeing URB\n");
491 492 493 494 495 496 497 498
			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 已提交
499 500
		}
	}
501 502
}

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

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

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

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

518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533
/*
 * 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);
	}
}

534 535 536
/*********
 * sysfs
 *********/
537
static struct pwc_device *cd_to_pwc(struct device *cd)
538 539 540 541 542
{
	struct video_device *vdev = to_video_device(cd);
	return video_get_drvdata(vdev);
}

543 544
static ssize_t show_pan_tilt(struct device *class_dev,
			     struct device_attribute *attr, char *buf)
545 546 547 548 549
{
	struct pwc_device *pdev = cd_to_pwc(class_dev);
	return sprintf(buf, "%d %d\n", pdev->pan_angle, pdev->tilt_angle);
}

550 551 552
static ssize_t store_pan_tilt(struct device *class_dev,
			      struct device_attribute *attr,
			      const char *buf, size_t count)
553 554 555 556 557 558 559 560 561 562 563 564 565 566 567
{
	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);
}
568 569
static DEVICE_ATTR(pan_tilt, S_IRUGO | S_IWUSR, show_pan_tilt,
		   store_pan_tilt);
570

571 572
static ssize_t show_snapshot_button_status(struct device *class_dev,
					   struct device_attribute *attr, char *buf)
573 574 575 576 577 578 579
{
	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);
}

580 581
static DEVICE_ATTR(button, S_IRUGO | S_IWUSR, show_snapshot_button_status,
		   NULL);
582

583
static int pwc_create_sysfs_files(struct pwc_device *pdev)
584
{
585 586
	int rc;

587
	rc = device_create_file(&pdev->vdev.dev, &dev_attr_button);
588 589 590
	if (rc)
		goto err;
	if (pdev->features & FEATURE_MOTOR_PANTILT) {
591
		rc = device_create_file(&pdev->vdev.dev, &dev_attr_pan_tilt);
592 593
		if (rc)
			goto err_button;
594 595 596 597 598
	}

	return 0;

err_button:
599
	device_remove_file(&pdev->vdev.dev, &dev_attr_button);
600
err:
601
	PWC_ERROR("Could not create sysfs files.\n");
602
	return rc;
603 604
}

605
static void pwc_remove_sysfs_files(struct pwc_device *pdev)
606 607
{
	if (pdev->features & FEATURE_MOTOR_PANTILT)
608 609
		device_remove_file(&pdev->vdev.dev, &dev_attr_pan_tilt);
	device_remove_file(&pdev->vdev.dev, &dev_attr_button);
610 611
}

612
#ifdef CONFIG_USB_PWC_DEBUG
613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636
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:
637
			return "unknown type of sensor";
638 639 640
	}
}
#endif
L
Linus Torvalds 已提交
641 642 643 644

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

645
static void pwc_video_release(struct v4l2_device *v)
L
Linus Torvalds 已提交
646
{
647
	struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
648
	int hint;
649

650 651 652 653
	/* 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;
654

655 656 657 658 659 660 661 662
	/* 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;
	}

663 664
	v4l2_ctrl_handler_free(&pdev->ctrl_handler);

665
	kfree(pdev);
666 667
}

668
static int pwc_video_close(struct file *file)
L
Linus Torvalds 已提交
669
{
670
	struct pwc_device *pdev = video_drvdata(file);
L
Linus Torvalds 已提交
671

672 673 674 675
	if (pdev->capt_file == file) {
		vb2_queue_release(&pdev->vb_queue);
		pdev->capt_file = NULL;
	}
676
	return v4l2_fh_release(file);
L
Linus Torvalds 已提交
677 678
}

679
static ssize_t pwc_video_read(struct file *file, char __user *buf,
680
			      size_t count, loff_t *ppos)
L
Linus Torvalds 已提交
681
{
682
	struct pwc_device *pdev = video_drvdata(file);
L
Linus Torvalds 已提交
683

684 685
	if (!pdev->udev)
		return -ENODEV;
686

687 688 689 690 691 692
	if (pdev->capt_file != NULL &&
	    pdev->capt_file != file)
		return -EBUSY;

	pdev->capt_file = file;

693 694 695
	return vb2_read(&pdev->vb_queue, buf, count, ppos,
			file->f_flags & O_NONBLOCK);
}
L
Linus Torvalds 已提交
696

697 698
static unsigned int pwc_video_poll(struct file *file, poll_table *wait)
{
699
	struct pwc_device *pdev = video_drvdata(file);
700

701
	if (!pdev->udev)
702
		return POLL_ERR;
L
Linus Torvalds 已提交
703

704
	return vb2_poll(&pdev->vb_queue, file, wait);
L
Linus Torvalds 已提交
705 706
}

707
static int pwc_video_mmap(struct file *file, struct vm_area_struct *vma)
L
Linus Torvalds 已提交
708
{
709
	struct pwc_device *pdev = video_drvdata(file);
L
Linus Torvalds 已提交
710

711 712 713
	if (pdev->capt_file != file)
		return -EBUSY;

714 715
	return vb2_mmap(&pdev->vb_queue, vma);
}
L
Linus Torvalds 已提交
716

717 718 719
/***************************************************************************/
/* Videobuf2 operations */

720 721 722
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[])
723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740
{
	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);
741

742 743 744 745 746 747 748 749 750 751 752 753 754
	/* 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 */
755 756
	if (!pdev->udev)
		return -ENODEV;
L
Linus Torvalds 已提交
757 758 759 760

	return 0;
}

761
static int buffer_finish(struct vb2_buffer *vb)
L
Linus Torvalds 已提交
762
{
763 764
	struct pwc_device *pdev = vb2_get_drv_priv(vb->vb2_queue);
	struct pwc_frame_buf *buf = container_of(vb, struct pwc_frame_buf, vb);
765

766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791
	/*
	 * 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);
}

792
static int start_streaming(struct vb2_queue *vq, unsigned int count)
793 794 795
{
	struct pwc_device *pdev = vb2_get_drv_priv(vq);

796 797 798
	if (!pdev->udev)
		return -ENODEV;

799 800 801 802 803 804 805 806 807 808
	/* 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);

809 810 811 812 813 814 815
	return pwc_isoc_init(pdev);
}

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

816 817 818
	if (pdev->udev) {
		pwc_set_leds(pdev, 0, 0);
		pwc_camera_power(pdev, 0);
819
		pwc_isoc_cleanup(pdev);
820
	}
821
	pwc_cleanup_queued_bufs(pdev);
822

L
Linus Torvalds 已提交
823 824 825
	return 0;
}

826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
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 已提交
851 852 853 854 855 856 857 858 859 860 861 862
/***************************************************************************/
/* 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;
863
	int hint, rc;
L
Linus Torvalds 已提交
864 865
	int features = 0;
	int video_nr = -1; /* default: use next available device */
866
	int my_power_save = power_save;
L
Linus Torvalds 已提交
867 868
	char serial_number[30], *name;

869 870 871
	vendor_id = le16_to_cpu(udev->descriptor.idVendor);
	product_id = le16_to_cpu(udev->descriptor.idProduct);

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

L
Linus Torvalds 已提交
1087 1088 1089 1090
	}
	else if (vendor_id == 0x0d81) {
		switch(product_id) {
		case 0x1900:
1091
			PWC_INFO("Visionite VCS-UC300 USB webcam detected.\n");
L
Linus Torvalds 已提交
1092 1093 1094 1095
			name = "Visionite VCS-UC300";
			type_id = 740; /* CCD sensor */
			break;
		case 0x1910:
1096
			PWC_INFO("Visionite VCS-UM100 USB webcam detected.\n");
L
Linus Torvalds 已提交
1097 1098 1099 1100 1101 1102 1103 1104
			name = "Visionite VCS-UM100";
			type_id = 730; /* CMOS sensor */
			break;
		default:
			return -ENODEV;
			break;
		}
	}
1105
	else
L
Linus Torvalds 已提交
1106 1107
		return -ENODEV; /* Not any of the know types; but the list keeps growing. */

1108 1109 1110
	if (my_power_save == -1)
		my_power_save = 0;

L
Linus Torvalds 已提交
1111 1112
	memset(serial_number, 0, 30);
	usb_string(udev, udev->descriptor.iSerialNumber, serial_number, 29);
1113
	PWC_DEBUG_PROBE("Device serial number is %s\n", serial_number);
L
Linus Torvalds 已提交
1114 1115

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

	/* Allocate structure, initialize pointers, mutexes, etc. and link it to the usb_device */
1119
	pdev = kzalloc(sizeof(struct pwc_device), GFP_KERNEL);
L
Linus Torvalds 已提交
1120
	if (pdev == NULL) {
1121
		PWC_ERROR("Oops, could not allocate memory for pwc_device.\n");
L
Linus Torvalds 已提交
1122 1123 1124 1125 1126 1127
		return -ENOMEM;
	}
	pdev->type = type_id;
	pdev->vframes = default_fps;
	strcpy(pdev->serial, serial_number);
	pdev->features = features;
1128
	if (vendor_id == 0x046D && product_id == 0x08B5) {
L
Linus Torvalds 已提交
1129
		/* Logitech QuickCam Orbit
1130 1131 1132
		   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 已提交
1133 1134 1135 1136 1137
		pdev->angle_range.pan_min  = -7000;
		pdev->angle_range.pan_max  =  7000;
		pdev->angle_range.tilt_min = -3000;
		pdev->angle_range.tilt_max =  2500;
	}
1138
	pwc_construct(pdev); /* set min/max sizes correct */
L
Linus Torvalds 已提交
1139

1140
	mutex_init(&pdev->modlock);
1141
	mutex_init(&pdev->udevlock);
1142 1143
	spin_lock_init(&pdev->queued_bufs_lock);
	INIT_LIST_HEAD(&pdev->queued_bufs);
L
Linus Torvalds 已提交
1144 1145 1146

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

1149 1150 1151 1152 1153 1154 1155 1156 1157 1158
	/* 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);

1159 1160 1161 1162
	/* Init video_device structure */
	memcpy(&pdev->vdev, &pwc_template, sizeof(pwc_template));
	pdev->vdev.lock = &pdev->modlock;
	strcpy(pdev->vdev.name, name);
1163
	set_bit(V4L2_FL_USE_FH_PRIO, &pdev->vdev.flags);
1164
	video_set_drvdata(&pdev->vdev, pdev);
L
Linus Torvalds 已提交
1165 1166

	pdev->release = le16_to_cpu(udev->descriptor.bcdDevice);
1167
	PWC_DEBUG_PROBE("Release: %04x\n", pdev->release);
L
Linus Torvalds 已提交
1168 1169 1170 1171 1172 1173 1174

	/* 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)) {
1175 1176 1177 1178
				/* 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 已提交
1179 1180 1181 1182 1183
			}
		}
	}

	/* occupy slot */
1184
	if (hint < MAX_DEV_HINTS)
L
Linus Torvalds 已提交
1185 1186
		device_hint[hint].pdev = pdev;

1187 1188 1189 1190 1191 1192 1193 1194 1195
#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

1196 1197
	/* Set the leds off */
	pwc_set_leds(pdev, 0, 0);
1198 1199 1200 1201 1202 1203 1204

	/* 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;

1205 1206 1207 1208 1209 1210 1211
	/* 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;
	}

1212
	/* And powerdown the camera until streaming starts */
1213 1214
	pwc_camera_power(pdev, 0);

1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225
	/* 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;

1226
	rc = video_register_device(&pdev->vdev, VFL_TYPE_GRABBER, video_nr);
1227 1228
	if (rc < 0) {
		PWC_ERROR("Failed to register as video device (%d).\n", rc);
1229
		goto err_unregister_v4l2_dev;
1230
	}
1231
	rc = pwc_create_sysfs_files(pdev);
1232 1233 1234
	if (rc)
		goto err_video_unreg;

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

1237 1238 1239 1240 1241
#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.");
1242
		rc = -ENOMEM;
1243
		pwc_remove_sysfs_files(pdev);
1244
		goto err_video_unreg;
1245 1246
	}

1247 1248 1249
	usb_make_path(udev, pdev->button_phys, sizeof(pdev->button_phys));
	strlcat(pdev->button_phys, "/input0", sizeof(pdev->button_phys));

1250
	pdev->button_dev->name = "PWC snapshot button";
1251
	pdev->button_dev->phys = pdev->button_phys;
1252 1253 1254
	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);
1255
	pdev->button_dev->keybit[BIT_WORD(KEY_CAMERA)] = BIT_MASK(KEY_CAMERA);
1256 1257 1258 1259 1260

	rc = input_register_device(pdev->button_dev);
	if (rc) {
		input_free_device(pdev->button_dev);
		pdev->button_dev = NULL;
1261
		pwc_remove_sysfs_files(pdev);
1262
		goto err_video_unreg;
1263 1264 1265
	}
#endif

L
Linus Torvalds 已提交
1266
	return 0;
1267

1268
err_video_unreg:
1269
	video_unregister_device(&pdev->vdev);
1270 1271
err_unregister_v4l2_dev:
	v4l2_device_unregister(&pdev->v4l2_dev);
1272 1273
err_free_controls:
	v4l2_ctrl_handler_free(&pdev->ctrl_handler);
1274
err_free_mem:
1275 1276
	if (hint < MAX_DEV_HINTS)
		device_hint[hint].pdev = NULL;
1277
	kfree(pdev);
1278
	return rc;
L
Linus Torvalds 已提交
1279 1280
}

1281
/* The user yanked out the cable... */
L
Linus Torvalds 已提交
1282 1283
static void usb_pwc_disconnect(struct usb_interface *intf)
{
1284 1285
	struct v4l2_device *v = usb_get_intfdata(intf);
	struct pwc_device *pdev = container_of(v, struct pwc_device, v4l2_dev);
L
Linus Torvalds 已提交
1286

1287
	mutex_lock(&pdev->udevlock);
H
Hans Verkuil 已提交
1288
	mutex_lock(&pdev->modlock);
L
Linus Torvalds 已提交
1289

1290 1291
	/* No need to keep the urbs around after disconnection */
	pwc_isoc_cleanup(pdev);
1292
	pwc_cleanup_queued_bufs(pdev);
1293
	pdev->udev = NULL;
L
Linus Torvalds 已提交
1294

H
Hans Verkuil 已提交
1295
	mutex_unlock(&pdev->modlock);
1296
	mutex_unlock(&pdev->udevlock);
1297 1298 1299

	pwc_remove_sysfs_files(pdev);
	video_unregister_device(&pdev->vdev);
1300
	v4l2_device_unregister(&pdev->v4l2_dev);
1301 1302 1303 1304 1305

#ifdef CONFIG_USB_PWC_INPUT_EVDEV
	if (pdev->button_dev)
		input_unregister_device(pdev->button_dev);
#endif
1306 1307

	v4l2_device_put(&pdev->v4l2_dev);
L
Linus Torvalds 已提交
1308 1309 1310
}


1311 1312
/*
 * Initialization code & module stuff
L
Linus Torvalds 已提交
1313 1314
 */

1315
static int fps;
L
Linus Torvalds 已提交
1316 1317
static int compression = -1;
static int leds[2] = { -1, -1 };
1318
static unsigned int leds_nargs;
1319
static char *dev_hint[MAX_DEV_HINTS];
1320
static unsigned int dev_hint_nargs;
1321 1322

module_param(fps, int, 0444);
1323
#ifdef CONFIG_USB_PWC_DEBUG
1324 1325
module_param_named(trace, pwc_trace, int, 0644);
#endif
1326
module_param(power_save, int, 0644);
1327 1328 1329
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 已提交
1330 1331

MODULE_PARM_DESC(fps, "Initial frames per second. Varies with model, useful range 5-30");
1332
#ifdef CONFIG_USB_PWC_DEBUG
L
Linus Torvalds 已提交
1333
MODULE_PARM_DESC(trace, "For debugging purposes");
1334
#endif
1335
MODULE_PARM_DESC(power_save, "Turn power saving for new cameras on or off");
L
Linus Torvalds 已提交
1336 1337 1338 1339 1340 1341 1342
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");
1343 1344
MODULE_ALIAS("pwcx");
MODULE_VERSION( PWC_VERSION );
L
Linus Torvalds 已提交
1345 1346 1347

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

1350
#ifdef CONFIG_USB_PWC_DEBUG
1351 1352 1353 1354
	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 已提交
1355

1356 1357 1358 1359 1360
	if (pwc_trace >= 0) {
		PWC_DEBUG_MODULE("Trace options: 0x%04x\n", pwc_trace);
	}
#endif

L
Linus Torvalds 已提交
1361 1362
	if (fps) {
		if (fps < 4 || fps > 30) {
1363
			PWC_ERROR("Framerate out of bounds (4-30).\n");
L
Linus Torvalds 已提交
1364 1365 1366
			return -EINVAL;
		}
		default_fps = fps;
1367
		PWC_DEBUG_MODULE("Default framerate set to %d.\n", default_fps);
L
Linus Torvalds 已提交
1368 1369 1370 1371
	}

	if (compression >= 0) {
		if (compression > 3) {
1372
			PWC_ERROR("Invalid compression setting; use a number between 0 (uncompressed) and 3 (high).\n");
L
Linus Torvalds 已提交
1373 1374 1375
			return -EINVAL;
		}
		pwc_preferred_compression = compression;
1376
		PWC_DEBUG_MODULE("Preferred compression set to %d.\n", pwc_preferred_compression);
L
Linus Torvalds 已提交
1377 1378 1379 1380 1381 1382
	}
	if (leds[0] >= 0)
		led_on = leds[0];
	if (leds[1] >= 0)
		led_off = leds[1];

1383
	/* Big device node whoopla. Basically, it allows you to assign a
L
Linus Torvalds 已提交
1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407
	   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) {
1408
				PWC_ERROR("Malformed camera hint: the colon must be after the dot.\n");
L
Linus Torvalds 已提交
1409 1410 1411 1412 1413 1414
				return -EINVAL;
			}

			if (*colon == '\0') {
				/* No colon */
				if (*dot != '\0') {
1415
					PWC_ERROR("Malformed camera hint: no colon + device node given.\n");
L
Linus Torvalds 已提交
1416 1417 1418 1419
					return -EINVAL;
				}
				else {
					/* No type or serial number specified, just a number. */
1420 1421
					device_hint[i].device_node =
						simple_strtol(s, NULL, 10);
L
Linus Torvalds 已提交
1422 1423 1424 1425
				}
			}
			else {
				/* There's a colon, so we have at least a type and a device node */
1426 1427 1428 1429
				device_hint[i].type =
					simple_strtol(s, NULL, 10);
				device_hint[i].device_node =
					simple_strtol(colon + 1, NULL, 10);
L
Linus Torvalds 已提交
1430 1431 1432
				if (*dot != '\0') {
					/* There's a serial number as well */
					int k;
1433

L
Linus Torvalds 已提交
1434 1435 1436 1437 1438 1439 1440 1441 1442
					dot++;
					k = 0;
					while (*dot != ':' && k < 29) {
						device_hint[i].serial_number[k++] = *dot;
						dot++;
					}
					device_hint[i].serial_number[k] = '\0';
				}
			}
1443 1444 1445 1446
			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 已提交
1447 1448 1449 1450 1451
		}
		else
			device_hint[i].type = 0; /* not filled */
	} /* ..for MAX_DEV_HINTS */

1452
	PWC_DEBUG_PROBE("Registering driver at address 0x%p.\n", &pwc_driver);
L
Linus Torvalds 已提交
1453 1454 1455 1456 1457
	return usb_register(&pwc_driver);
}

static void __exit usb_pwc_exit(void)
{
1458
	PWC_DEBUG_MODULE("Deregistering driver.\n");
L
Linus Torvalds 已提交
1459
	usb_deregister(&pwc_driver);
1460
	PWC_INFO("Philips webcam module removed.\n");
L
Linus Torvalds 已提交
1461 1462 1463 1464 1465
}

module_init(usb_pwc_init);
module_exit(usb_pwc_exit);

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