usbvision-video.c revision 66a17879e9f18a38c4ca5e6ba600a3f5b1b51188
1/*
2 * USB USBVISION Video device driver 0.9.9
3 *
4 *
5 *
6 * Copyright (c) 1999-2005 Joerg Heckenbach <joerg@heckenbach-aw.de>
7 *
8 * This module is part of usbvision driver project.
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 *
24 * Let's call the version 0.... until compression decoding is completely
25 * implemented.
26 *
27 * This driver is written by Jose Ignacio Gijon and Joerg Heckenbach.
28 * It was based on USB CPiA driver written by Peter Pregler,
29 * Scott J. Bertin and Johannes Erdfelt
30 * Ideas are taken from bttv driver by Ralph Metzler, Marcus Metzler &
31 * Gerd Knorr and zoran 36120/36125 driver by Pauline Middelink
32 * Updates to driver completed by Dwaine P. Garden
33 *
34 *
35 * TODO:
36 *     - use submit_urb for all setup packets
37 *     - Fix memory settings for nt1004. It is 4 times as big as the
38 *       nt1003 memory.
39 *     - Add audio on endpoint 3 for nt1004 chip.
40 *         Seems impossible, needs a codec interface.  Which one?
41 *     - Clean up the driver.
42 *     - optimization for performance.
43 *     - Add Videotext capability (VBI).  Working on it.....
44 *     - Check audio for other devices
45 *
46 */
47
48#include <linux/version.h>
49#include <linux/kernel.h>
50#include <linux/list.h>
51#include <linux/timer.h>
52#include <linux/slab.h>
53#include <linux/mm.h>
54#include <linux/utsname.h>
55#include <linux/highmem.h>
56#include <linux/videodev.h>
57#include <linux/vmalloc.h>
58#include <linux/module.h>
59#include <linux/init.h>
60#include <linux/spinlock.h>
61#include <asm/io.h>
62#include <linux/videodev2.h>
63#include <linux/video_decoder.h>
64#include <linux/i2c.h>
65
66#include <media/saa7115.h>
67#include <media/v4l2-common.h>
68#include <media/tuner.h>
69#include <media/audiochip.h>
70
71#include <linux/moduleparam.h>
72#include <linux/workqueue.h>
73
74#ifdef CONFIG_KMOD
75#include <linux/kmod.h>
76#endif
77
78#include "usbvision.h"
79#include "usbvision-cards.h"
80
81#define DRIVER_AUTHOR "Joerg Heckenbach <joerg@heckenbach-aw.de>,\
82 Dwaine Garden <DwaineGarden@rogers.com>"
83#define DRIVER_NAME "usbvision"
84#define DRIVER_ALIAS "USBVision"
85#define DRIVER_DESC "USBVision USB Video Device Driver for Linux"
86#define DRIVER_LICENSE "GPL"
87#define USBVISION_DRIVER_VERSION_MAJOR 0
88#define USBVISION_DRIVER_VERSION_MINOR 9
89#define USBVISION_DRIVER_VERSION_PATCHLEVEL 9
90#define USBVISION_DRIVER_VERSION KERNEL_VERSION(USBVISION_DRIVER_VERSION_MAJOR,\
91USBVISION_DRIVER_VERSION_MINOR,\
92USBVISION_DRIVER_VERSION_PATCHLEVEL)
93#define USBVISION_VERSION_STRING __stringify(USBVISION_DRIVER_VERSION_MAJOR)\
94 "." __stringify(USBVISION_DRIVER_VERSION_MINOR)\
95 "." __stringify(USBVISION_DRIVER_VERSION_PATCHLEVEL)
96
97#define	ENABLE_HEXDUMP	0	/* Enable if you need it */
98
99
100#ifdef USBVISION_DEBUG
101	#define PDEBUG(level, fmt, args...) \
102		if (video_debug & (level)) \
103			info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ ,\
104				## args)
105#else
106	#define PDEBUG(level, fmt, args...) do {} while(0)
107#endif
108
109#define DBG_IO		1<<1
110#define DBG_PROBE	1<<2
111#define DBG_MMAP	1<<3
112
113//String operations
114#define rmspace(str)	while(*str==' ') str++;
115#define goto2next(str)	while(*str!=' ') str++; while(*str==' ') str++;
116
117
118/* sequential number of usbvision device */
119static int usbvision_nr = 0;
120
121static struct usbvision_v4l2_format_st usbvision_v4l2_format[] = {
122	{ 1, 1,  8, V4L2_PIX_FMT_GREY    , "GREY" },
123	{ 1, 2, 16, V4L2_PIX_FMT_RGB565  , "RGB565" },
124	{ 1, 3, 24, V4L2_PIX_FMT_RGB24   , "RGB24" },
125	{ 1, 4, 32, V4L2_PIX_FMT_RGB32   , "RGB32" },
126	{ 1, 2, 16, V4L2_PIX_FMT_RGB555  , "RGB555" },
127	{ 1, 2, 16, V4L2_PIX_FMT_YUYV    , "YUV422" },
128	{ 1, 2, 12, V4L2_PIX_FMT_YVU420  , "YUV420P" }, // 1.5 !
129	{ 1, 2, 16, V4L2_PIX_FMT_YUV422P , "YUV422P" }
130};
131
132/* Function prototypes */
133static void usbvision_release(struct usb_usbvision *usbvision);
134
135/* Default initalization of device driver parameters */
136/* Set the default format for ISOC endpoint */
137static int isocMode = ISOC_MODE_COMPRESS;
138/* Set the default Debug Mode of the device driver */
139static int video_debug = 0;
140/* Set the default device to power on at startup */
141static int PowerOnAtOpen = 1;
142/* Sequential Number of Video Device */
143static int video_nr = -1;
144/* Sequential Number of Radio Device */
145static int radio_nr = -1;
146/* Sequential Number of VBI Device */
147static int vbi_nr = -1;
148
149/* Grab parameters for the device driver */
150
151/* Showing parameters under SYSFS */
152module_param(isocMode, int, 0444);
153module_param(video_debug, int, 0444);
154module_param(PowerOnAtOpen, int, 0444);
155module_param(video_nr, int, 0444);
156module_param(radio_nr, int, 0444);
157module_param(vbi_nr, int, 0444);
158
159MODULE_PARM_DESC(isocMode, " Set the default format for ISOC endpoint.  Default: 0x60 (Compression On)");
160MODULE_PARM_DESC(video_debug, " Set the default Debug Mode of the device driver.  Default: 0 (Off)");
161MODULE_PARM_DESC(PowerOnAtOpen, " Set the default device to power on when device is opened.  Default: 1 (On)");
162MODULE_PARM_DESC(video_nr, "Set video device number (/dev/videoX).  Default: -1 (autodetect)");
163MODULE_PARM_DESC(radio_nr, "Set radio device number (/dev/radioX).  Default: -1 (autodetect)");
164MODULE_PARM_DESC(vbi_nr, "Set vbi device number (/dev/vbiX).  Default: -1 (autodetect)");
165
166
167// Misc stuff
168MODULE_AUTHOR(DRIVER_AUTHOR);
169MODULE_DESCRIPTION(DRIVER_DESC);
170MODULE_LICENSE(DRIVER_LICENSE);
171MODULE_VERSION(USBVISION_VERSION_STRING);
172MODULE_ALIAS(DRIVER_ALIAS);
173
174
175/*****************************************************************************/
176/* SYSFS Code - Copied from the stv680.c usb module.			     */
177/* Device information is located at /sys/class/video4linux/video0            */
178/* Device parameters information is located at /sys/module/usbvision         */
179/* Device USB Information is located at                                      */
180/*   /sys/bus/usb/drivers/USBVision Video Grabber                            */
181/*****************************************************************************/
182
183
184#define YES_NO(x) ((x) ? "Yes" : "No")
185
186static inline struct usb_usbvision *cd_to_usbvision(struct class_device *cd)
187{
188	struct video_device *vdev =
189		container_of(cd, struct video_device, class_dev);
190	return video_get_drvdata(vdev);
191}
192
193static ssize_t show_version(struct class_device *cd, char *buf)
194{
195	return sprintf(buf, "%s\n", USBVISION_VERSION_STRING);
196}
197static CLASS_DEVICE_ATTR(version, S_IRUGO, show_version, NULL);
198
199static ssize_t show_model(struct class_device *cd, char *buf)
200{
201	struct video_device *vdev =
202		container_of(cd, struct video_device, class_dev);
203	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
204	return sprintf(buf, "%s\n",
205		       usbvision_device_data[usbvision->DevModel].ModelString);
206}
207static CLASS_DEVICE_ATTR(model, S_IRUGO, show_model, NULL);
208
209static ssize_t show_hue(struct class_device *cd, char *buf)
210{
211	struct video_device *vdev =
212		container_of(cd, struct video_device, class_dev);
213	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
214	struct v4l2_control ctrl;
215	ctrl.id = V4L2_CID_HUE;
216	ctrl.value = 0;
217	if(usbvision->user)
218		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
219	return sprintf(buf, "%d\n", ctrl.value);
220}
221static CLASS_DEVICE_ATTR(hue, S_IRUGO, show_hue, NULL);
222
223static ssize_t show_contrast(struct class_device *cd, char *buf)
224{
225	struct video_device *vdev =
226		container_of(cd, struct video_device, class_dev);
227	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
228	struct v4l2_control ctrl;
229	ctrl.id = V4L2_CID_CONTRAST;
230	ctrl.value = 0;
231	if(usbvision->user)
232		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
233	return sprintf(buf, "%d\n", ctrl.value);
234}
235static CLASS_DEVICE_ATTR(contrast, S_IRUGO, show_contrast, NULL);
236
237static ssize_t show_brightness(struct class_device *cd, char *buf)
238{
239	struct video_device *vdev =
240		container_of(cd, struct video_device, class_dev);
241	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
242	struct v4l2_control ctrl;
243	ctrl.id = V4L2_CID_BRIGHTNESS;
244	ctrl.value = 0;
245	if(usbvision->user)
246		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
247	return sprintf(buf, "%d\n", ctrl.value);
248}
249static CLASS_DEVICE_ATTR(brightness, S_IRUGO, show_brightness, NULL);
250
251static ssize_t show_saturation(struct class_device *cd, char *buf)
252{
253	struct video_device *vdev =
254		container_of(cd, struct video_device, class_dev);
255	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
256	struct v4l2_control ctrl;
257	ctrl.id = V4L2_CID_SATURATION;
258	ctrl.value = 0;
259	if(usbvision->user)
260		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
261	return sprintf(buf, "%d\n", ctrl.value);
262}
263static CLASS_DEVICE_ATTR(saturation, S_IRUGO, show_saturation, NULL);
264
265static ssize_t show_streaming(struct class_device *cd, char *buf)
266{
267	struct video_device *vdev =
268		container_of(cd, struct video_device, class_dev);
269	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
270	return sprintf(buf, "%s\n",
271		       YES_NO(usbvision->streaming==Stream_On?1:0));
272}
273static CLASS_DEVICE_ATTR(streaming, S_IRUGO, show_streaming, NULL);
274
275static ssize_t show_compression(struct class_device *cd, char *buf)
276{
277	struct video_device *vdev =
278		container_of(cd, struct video_device, class_dev);
279	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
280	return sprintf(buf, "%s\n",
281		       YES_NO(usbvision->isocMode==ISOC_MODE_COMPRESS));
282}
283static CLASS_DEVICE_ATTR(compression, S_IRUGO, show_compression, NULL);
284
285static ssize_t show_device_bridge(struct class_device *cd, char *buf)
286{
287	struct video_device *vdev =
288		container_of(cd, struct video_device, class_dev);
289	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
290	return sprintf(buf, "%d\n", usbvision->bridgeType);
291}
292static CLASS_DEVICE_ATTR(bridge, S_IRUGO, show_device_bridge, NULL);
293
294static void usbvision_create_sysfs(struct video_device *vdev)
295{
296	int res;
297	if (!vdev)
298		return;
299	do {
300		res=class_device_create_file(&vdev->class_dev,
301					     &class_device_attr_version);
302		if (res<0)
303			break;
304		res=class_device_create_file(&vdev->class_dev,
305					     &class_device_attr_model);
306		if (res<0)
307			break;
308		res=class_device_create_file(&vdev->class_dev,
309					     &class_device_attr_hue);
310		if (res<0)
311			break;
312		res=class_device_create_file(&vdev->class_dev,
313					     &class_device_attr_contrast);
314		if (res<0)
315			break;
316		res=class_device_create_file(&vdev->class_dev,
317					     &class_device_attr_brightness);
318		if (res<0)
319			break;
320		res=class_device_create_file(&vdev->class_dev,
321					     &class_device_attr_saturation);
322		if (res<0)
323			break;
324		res=class_device_create_file(&vdev->class_dev,
325					     &class_device_attr_streaming);
326		if (res<0)
327			break;
328		res=class_device_create_file(&vdev->class_dev,
329					     &class_device_attr_compression);
330		if (res<0)
331			break;
332		res=class_device_create_file(&vdev->class_dev,
333					     &class_device_attr_bridge);
334		if (res>=0)
335			return;
336	} while (0);
337
338	err("%s error: %d\n", __FUNCTION__, res);
339}
340
341static void usbvision_remove_sysfs(struct video_device *vdev)
342{
343	if (vdev) {
344		class_device_remove_file(&vdev->class_dev,
345					 &class_device_attr_version);
346		class_device_remove_file(&vdev->class_dev,
347					 &class_device_attr_model);
348		class_device_remove_file(&vdev->class_dev,
349					 &class_device_attr_hue);
350		class_device_remove_file(&vdev->class_dev,
351					 &class_device_attr_contrast);
352		class_device_remove_file(&vdev->class_dev,
353					 &class_device_attr_brightness);
354		class_device_remove_file(&vdev->class_dev,
355					 &class_device_attr_saturation);
356		class_device_remove_file(&vdev->class_dev,
357					 &class_device_attr_streaming);
358		class_device_remove_file(&vdev->class_dev,
359					 &class_device_attr_compression);
360		class_device_remove_file(&vdev->class_dev,
361					 &class_device_attr_bridge);
362	}
363}
364
365
366/*
367 * usbvision_open()
368 *
369 * This is part of Video 4 Linux API. The driver can be opened by one
370 * client only (checks internal counter 'usbvision->user'). The procedure
371 * then allocates buffers needed for video processing.
372 *
373 */
374static int usbvision_v4l2_open(struct inode *inode, struct file *file)
375{
376	struct video_device *dev = video_devdata(file);
377	struct usb_usbvision *usbvision =
378		(struct usb_usbvision *) video_get_drvdata(dev);
379	int errCode = 0;
380
381	PDEBUG(DBG_IO, "open");
382
383
384	usbvision_reset_powerOffTimer(usbvision);
385
386	if (usbvision->user)
387		errCode = -EBUSY;
388	else {
389		/* Allocate memory for the scratch ring buffer */
390		errCode = usbvision_scratch_alloc(usbvision);
391		if (isocMode==ISOC_MODE_COMPRESS) {
392			/* Allocate intermediate decompression buffers
393			   only if needed */
394			errCode = usbvision_decompress_alloc(usbvision);
395		}
396		if (errCode) {
397			/* Deallocate all buffers if trouble */
398			usbvision_scratch_free(usbvision);
399			usbvision_decompress_free(usbvision);
400		}
401	}
402
403	/* If so far no errors then we shall start the camera */
404	if (!errCode) {
405		down(&usbvision->lock);
406		if (usbvision->power == 0) {
407			usbvision_power_on(usbvision);
408			usbvision_i2c_register(usbvision);
409		}
410
411		/* Send init sequence only once, it's large! */
412		if (!usbvision->initialized) {
413			int setup_ok = 0;
414			setup_ok = usbvision_setup(usbvision,isocMode);
415			if (setup_ok)
416				usbvision->initialized = 1;
417			else
418				errCode = -EBUSY;
419		}
420
421		if (!errCode) {
422			usbvision_begin_streaming(usbvision);
423			errCode = usbvision_init_isoc(usbvision);
424			/* device must be initialized before isoc transfer */
425			usbvision_muxsel(usbvision,0);
426			usbvision->user++;
427		} else {
428			if (PowerOnAtOpen) {
429				usbvision_i2c_unregister(usbvision);
430				usbvision_power_off(usbvision);
431				usbvision->initialized = 0;
432			}
433		}
434		up(&usbvision->lock);
435	}
436
437	if (errCode) {
438	}
439
440	/* prepare queues */
441	usbvision_empty_framequeues(usbvision);
442
443	PDEBUG(DBG_IO, "success");
444	return errCode;
445}
446
447/*
448 * usbvision_v4l2_close()
449 *
450 * This is part of Video 4 Linux API. The procedure
451 * stops streaming and deallocates all buffers that were earlier
452 * allocated in usbvision_v4l2_open().
453 *
454 */
455static int usbvision_v4l2_close(struct inode *inode, struct file *file)
456{
457	struct video_device *dev = video_devdata(file);
458	struct usb_usbvision *usbvision =
459		(struct usb_usbvision *) video_get_drvdata(dev);
460
461	PDEBUG(DBG_IO, "close");
462	down(&usbvision->lock);
463
464	usbvision_audio_off(usbvision);
465	usbvision_restart_isoc(usbvision);
466	usbvision_stop_isoc(usbvision);
467
468	usbvision_decompress_free(usbvision);
469	usbvision_frames_free(usbvision);
470	usbvision_empty_framequeues(usbvision);
471	usbvision_scratch_free(usbvision);
472
473	usbvision->user--;
474
475	if (PowerOnAtOpen) {
476		/* power off in a little while
477		   to avoid off/on every close/open short sequences */
478		usbvision_set_powerOffTimer(usbvision);
479		usbvision->initialized = 0;
480	}
481
482	up(&usbvision->lock);
483
484	if (usbvision->remove_pending) {
485		printk(KERN_INFO "%s: Final disconnect\n", __FUNCTION__);
486		usbvision_release(usbvision);
487	}
488
489	PDEBUG(DBG_IO, "success");
490
491
492	return 0;
493}
494
495
496/*
497 * usbvision_ioctl()
498 *
499 * This is part of Video 4 Linux API. The procedure handles ioctl() calls.
500 *
501 */
502#ifdef CONFIG_VIDEO_ADV_DEBUG
503static int vidioc_g_register (struct file *file, void *priv,
504				struct v4l2_register *reg)
505{
506	struct video_device *dev = video_devdata(file);
507	struct usb_usbvision *usbvision =
508		(struct usb_usbvision *) video_get_drvdata(dev);
509	int errCode;
510
511	if (!v4l2_chip_match_host(reg->match_type, reg->match_chip))
512		return -EINVAL;
513	/* NT100x has a 8-bit register space */
514	errCode = usbvision_read_reg(usbvision, reg->reg&0xff);
515	if (errCode < 0) {
516		err("%s: VIDIOC_DBG_G_REGISTER failed: error %d",
517		    __FUNCTION__, errCode);
518		return errCode;
519	}
520	return 0;
521}
522
523static int vidioc_s_register (struct file *file, void *priv,
524				struct v4l2_register *reg)
525{
526	struct video_device *dev = video_devdata(file);
527	struct usb_usbvision *usbvision =
528		(struct usb_usbvision *) video_get_drvdata(dev);
529	int errCode;
530
531	if (!v4l2_chip_match_host(reg->match_type, reg->match_chip))
532		return -EINVAL;
533	/* NT100x has a 8-bit register space */
534	reg->val = (u8)usbvision_write_reg(usbvision, reg->reg&0xff, reg->val);
535	if (reg->val < 0) {
536		err("%s: VIDIOC_DBG_S_REGISTER failed: error %d",
537		    __FUNCTION__, errCode);
538		return errCode;
539	}
540	return 0;
541}
542#endif
543
544static int vidioc_querycap (struct file *file, void  *priv,
545					struct v4l2_capability *vc)
546{
547	struct video_device *dev = video_devdata(file);
548	struct usb_usbvision *usbvision =
549		(struct usb_usbvision *) video_get_drvdata(dev);
550
551	strlcpy(vc->driver, "USBVision", sizeof(vc->driver));
552	strlcpy(vc->card,
553		usbvision_device_data[usbvision->DevModel].ModelString,
554		sizeof(vc->card));
555	strlcpy(vc->bus_info, usbvision->dev->dev.bus_id,
556		sizeof(vc->bus_info));
557	vc->version = USBVISION_DRIVER_VERSION;
558	vc->capabilities = V4L2_CAP_VIDEO_CAPTURE |
559		V4L2_CAP_AUDIO |
560		V4L2_CAP_READWRITE |
561		V4L2_CAP_STREAMING |
562		(usbvision->have_tuner ? V4L2_CAP_TUNER : 0);
563	return 0;
564}
565
566static int vidioc_enum_input (struct file *file, void *priv,
567				struct v4l2_input *vi)
568{
569	struct video_device *dev = video_devdata(file);
570	struct usb_usbvision *usbvision =
571		(struct usb_usbvision *) video_get_drvdata(dev);
572	int chan;
573
574	if ((vi->index >= usbvision->video_inputs) || (vi->index < 0) )
575		return -EINVAL;
576	if (usbvision->have_tuner) {
577		chan = vi->index;
578	} else {
579		chan = vi->index + 1; /*skip Television string*/
580	}
581	/* Determine the requested input characteristics
582	   specific for each usbvision card model */
583	switch(chan) {
584	case 0:
585		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
586			strcpy(vi->name, "White Video Input");
587		} else {
588			strcpy(vi->name, "Television");
589			vi->type = V4L2_INPUT_TYPE_TUNER;
590			vi->audioset = 1;
591			vi->tuner = chan;
592			vi->std = USBVISION_NORMS;
593		}
594		break;
595	case 1:
596		vi->type = V4L2_INPUT_TYPE_CAMERA;
597		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
598			strcpy(vi->name, "Green Video Input");
599		} else {
600			strcpy(vi->name, "Composite Video Input");
601		}
602		vi->std = V4L2_STD_PAL;
603		break;
604	case 2:
605		vi->type = V4L2_INPUT_TYPE_CAMERA;
606		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
607			strcpy(vi->name, "Yellow Video Input");
608		} else {
609			strcpy(vi->name, "S-Video Input");
610		}
611		vi->std = V4L2_STD_PAL;
612		break;
613	case 3:
614		vi->type = V4L2_INPUT_TYPE_CAMERA;
615		strcpy(vi->name, "Red Video Input");
616		vi->std = V4L2_STD_PAL;
617		break;
618	}
619	return 0;
620}
621
622static int vidioc_g_input (struct file *file, void *priv, unsigned int *input)
623{
624	struct video_device *dev = video_devdata(file);
625	struct usb_usbvision *usbvision =
626		(struct usb_usbvision *) video_get_drvdata(dev);
627
628	*input = usbvision->ctl_input;
629	return 0;
630}
631
632static int vidioc_s_input (struct file *file, void *priv, unsigned int input)
633{
634	struct video_device *dev = video_devdata(file);
635	struct usb_usbvision *usbvision =
636		(struct usb_usbvision *) video_get_drvdata(dev);
637
638	if ((input >= usbvision->video_inputs) || (input < 0) )
639		return -EINVAL;
640
641	down(&usbvision->lock);
642	usbvision_muxsel(usbvision, input);
643	usbvision_set_input(usbvision);
644	usbvision_set_output(usbvision,
645			     usbvision->curwidth,
646			     usbvision->curheight);
647	up(&usbvision->lock);
648	return 0;
649}
650
651static int vidioc_s_std (struct file *file, void *priv, v4l2_std_id *id)
652{
653	struct video_device *dev = video_devdata(file);
654	struct usb_usbvision *usbvision =
655		(struct usb_usbvision *) video_get_drvdata(dev);
656	usbvision->tvnormId=*id;
657
658	down(&usbvision->lock);
659	call_i2c_clients(usbvision, VIDIOC_S_STD,
660			 &usbvision->tvnormId);
661	up(&usbvision->lock);
662	/* propagate the change to the decoder */
663	usbvision_muxsel(usbvision, usbvision->ctl_input);
664
665	return 0;
666}
667
668static int vidioc_g_tuner (struct file *file, void *priv,
669				struct v4l2_tuner *vt)
670{
671	struct video_device *dev = video_devdata(file);
672	struct usb_usbvision *usbvision =
673		(struct usb_usbvision *) video_get_drvdata(dev);
674
675	if (!usbvision->have_tuner || vt->index)	// Only tuner 0
676		return -EINVAL;
677	if(usbvision->radio) {
678		strcpy(vt->name, "Radio");
679		vt->type = V4L2_TUNER_RADIO;
680	} else {
681		strcpy(vt->name, "Television");
682	}
683	/* Let clients fill in the remainder of this struct */
684	call_i2c_clients(usbvision,VIDIOC_G_TUNER,vt);
685
686	return 0;
687}
688
689static int vidioc_s_tuner (struct file *file, void *priv,
690				struct v4l2_tuner *vt)
691{
692	struct video_device *dev = video_devdata(file);
693	struct usb_usbvision *usbvision =
694		(struct usb_usbvision *) video_get_drvdata(dev);
695
696	// Only no or one tuner for now
697	if (!usbvision->have_tuner || vt->index)
698		return -EINVAL;
699	/* let clients handle this */
700	call_i2c_clients(usbvision,VIDIOC_S_TUNER,vt);
701
702	return 0;
703}
704
705static int vidioc_g_frequency (struct file *file, void *priv,
706				struct v4l2_frequency *freq)
707{
708	struct video_device *dev = video_devdata(file);
709	struct usb_usbvision *usbvision =
710		(struct usb_usbvision *) video_get_drvdata(dev);
711
712	freq->tuner = 0; // Only one tuner
713	if(usbvision->radio) {
714		freq->type = V4L2_TUNER_RADIO;
715	} else {
716		freq->type = V4L2_TUNER_ANALOG_TV;
717	}
718	freq->frequency = usbvision->freq;
719
720	return 0;
721}
722
723static int vidioc_s_frequency (struct file *file, void *priv,
724				struct v4l2_frequency *freq)
725{
726	struct video_device *dev = video_devdata(file);
727	struct usb_usbvision *usbvision =
728		(struct usb_usbvision *) video_get_drvdata(dev);
729
730	// Only no or one tuner for now
731	if (!usbvision->have_tuner || freq->tuner)
732		return -EINVAL;
733
734	usbvision->freq = freq->frequency;
735	call_i2c_clients(usbvision, VIDIOC_S_FREQUENCY, freq);
736
737	return 0;
738}
739
740static int vidioc_g_audio (struct file *file, void *priv, struct v4l2_audio *a)
741{
742	struct video_device *dev = video_devdata(file);
743	struct usb_usbvision *usbvision =
744		(struct usb_usbvision *) video_get_drvdata(dev);
745
746	memset(a,0,sizeof(*a));
747	if(usbvision->radio) {
748		strcpy(a->name,"Radio");
749	} else {
750		strcpy(a->name, "TV");
751	}
752
753	return 0;
754}
755
756static int vidioc_s_audio (struct file *file, void *fh,
757			  struct v4l2_audio *a)
758{
759	if(a->index) {
760		return -EINVAL;
761	}
762
763	return 0;
764}
765
766static int vidioc_queryctrl (struct file *file, void *priv,
767			    struct v4l2_queryctrl *ctrl)
768{
769	struct video_device *dev = video_devdata(file);
770	struct usb_usbvision *usbvision =
771		(struct usb_usbvision *) video_get_drvdata(dev);
772	int id=ctrl->id;
773
774	memset(ctrl,0,sizeof(*ctrl));
775	ctrl->id=id;
776
777	call_i2c_clients(usbvision, VIDIOC_QUERYCTRL, ctrl);
778
779	if (!ctrl->type)
780		return -EINVAL;
781
782	return 0;
783}
784
785static int vidioc_g_ctrl (struct file *file, void *priv,
786				struct v4l2_control *ctrl)
787{
788	struct video_device *dev = video_devdata(file);
789	struct usb_usbvision *usbvision =
790		(struct usb_usbvision *) video_get_drvdata(dev);
791	call_i2c_clients(usbvision, VIDIOC_G_CTRL, ctrl);
792
793	return 0;
794}
795
796static int vidioc_s_ctrl (struct file *file, void *priv,
797				struct v4l2_control *ctrl)
798{
799	struct video_device *dev = video_devdata(file);
800	struct usb_usbvision *usbvision =
801		(struct usb_usbvision *) video_get_drvdata(dev);
802	call_i2c_clients(usbvision, VIDIOC_S_CTRL, ctrl);
803
804	return 0;
805}
806
807static int vidioc_reqbufs (struct file *file,
808			   void *priv, struct v4l2_requestbuffers *vr)
809{
810	struct video_device *dev = video_devdata(file);
811	struct usb_usbvision *usbvision =
812		(struct usb_usbvision *) video_get_drvdata(dev);
813	int ret;
814
815	RESTRICT_TO_RANGE(vr->count,1,USBVISION_NUMFRAMES);
816
817	/* Check input validity:
818	   the user must do a VIDEO CAPTURE and MMAP method. */
819	if((vr->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) ||
820	   (vr->memory != V4L2_MEMORY_MMAP))
821		return -EINVAL;
822
823	if(usbvision->streaming == Stream_On) {
824		if ((ret = usbvision_stream_interrupt(usbvision)))
825			return ret;
826	}
827
828	usbvision_frames_free(usbvision);
829	usbvision_empty_framequeues(usbvision);
830	vr->count = usbvision_frames_alloc(usbvision,vr->count);
831
832	usbvision->curFrame = NULL;
833
834	return 0;
835}
836
837static int vidioc_querybuf (struct file *file,
838			    void *priv, struct v4l2_buffer *vb)
839{
840	struct video_device *dev = video_devdata(file);
841	struct usb_usbvision *usbvision =
842		(struct usb_usbvision *) video_get_drvdata(dev);
843	struct usbvision_frame *frame;
844
845	/* FIXME : must control
846	   that buffers are mapped (VIDIOC_REQBUFS has been called) */
847	if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
848		return -EINVAL;
849	}
850	if(vb->index>=usbvision->num_frames)  {
851		return -EINVAL;
852	}
853	/* Updating the corresponding frame state */
854	vb->flags = 0;
855	frame = &usbvision->frame[vb->index];
856	if(frame->grabstate >= FrameState_Ready)
857		vb->flags |= V4L2_BUF_FLAG_QUEUED;
858	if(frame->grabstate >= FrameState_Done)
859		vb->flags |= V4L2_BUF_FLAG_DONE;
860	if(frame->grabstate == FrameState_Unused)
861		vb->flags |= V4L2_BUF_FLAG_MAPPED;
862	vb->memory = V4L2_MEMORY_MMAP;
863
864	vb->m.offset = vb->index*PAGE_ALIGN(usbvision->max_frame_size);
865
866	vb->memory = V4L2_MEMORY_MMAP;
867	vb->field = V4L2_FIELD_NONE;
868	vb->length = usbvision->curwidth*
869		usbvision->curheight*
870		usbvision->palette.bytes_per_pixel;
871	vb->timestamp = usbvision->frame[vb->index].timestamp;
872	vb->sequence = usbvision->frame[vb->index].sequence;
873	return 0;
874}
875
876static int vidioc_qbuf (struct file *file, void *priv, struct v4l2_buffer *vb)
877{
878	struct video_device *dev = video_devdata(file);
879	struct usb_usbvision *usbvision =
880		(struct usb_usbvision *) video_get_drvdata(dev);
881	struct usbvision_frame *frame;
882	unsigned long lock_flags;
883
884	/* FIXME : works only on VIDEO_CAPTURE MODE, MMAP. */
885	if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
886		return -EINVAL;
887	}
888	if(vb->index>=usbvision->num_frames)  {
889		return -EINVAL;
890	}
891
892	frame = &usbvision->frame[vb->index];
893
894	if (frame->grabstate != FrameState_Unused) {
895		return -EAGAIN;
896	}
897
898	/* Mark it as ready and enqueue frame */
899	frame->grabstate = FrameState_Ready;
900	frame->scanstate = ScanState_Scanning;
901	frame->scanlength = 0;	/* Accumulated in usbvision_parse_data() */
902
903	vb->flags &= ~V4L2_BUF_FLAG_DONE;
904
905	/* set v4l2_format index */
906	frame->v4l2_format = usbvision->palette;
907
908	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
909	list_add_tail(&usbvision->frame[vb->index].frame, &usbvision->inqueue);
910	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
911
912	return 0;
913}
914
915static int vidioc_dqbuf (struct file *file, void *priv, struct v4l2_buffer *vb)
916{
917	struct video_device *dev = video_devdata(file);
918	struct usb_usbvision *usbvision =
919		(struct usb_usbvision *) video_get_drvdata(dev);
920	int ret;
921	struct usbvision_frame *f;
922	unsigned long lock_flags;
923
924	if (vb->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
925		return -EINVAL;
926
927	if (list_empty(&(usbvision->outqueue))) {
928		if (usbvision->streaming == Stream_Idle)
929			return -EINVAL;
930		ret = wait_event_interruptible
931			(usbvision->wait_frame,
932			 !list_empty(&(usbvision->outqueue)));
933		if (ret)
934			return ret;
935	}
936
937	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
938	f = list_entry(usbvision->outqueue.next,
939		       struct usbvision_frame, frame);
940	list_del(usbvision->outqueue.next);
941	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
942
943	f->grabstate = FrameState_Unused;
944
945	vb->memory = V4L2_MEMORY_MMAP;
946	vb->flags = V4L2_BUF_FLAG_MAPPED |
947		V4L2_BUF_FLAG_QUEUED |
948		V4L2_BUF_FLAG_DONE;
949	vb->index = f->index;
950	vb->sequence = f->sequence;
951	vb->timestamp = f->timestamp;
952	vb->field = V4L2_FIELD_NONE;
953	vb->bytesused = f->scanlength;
954
955	return 0;
956}
957
958static int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
959{
960	struct video_device *dev = video_devdata(file);
961	struct usb_usbvision *usbvision =
962		(struct usb_usbvision *) video_get_drvdata(dev);
963	int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
964
965	usbvision->streaming = Stream_On;
966	call_i2c_clients(usbvision,VIDIOC_STREAMON , &b);
967
968	return 0;
969}
970
971static int vidioc_streamoff(struct file *file,
972			    void *priv, enum v4l2_buf_type type)
973{
974	struct video_device *dev = video_devdata(file);
975	struct usb_usbvision *usbvision =
976		(struct usb_usbvision *) video_get_drvdata(dev);
977	int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
978
979	if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
980		return -EINVAL;
981
982	if(usbvision->streaming == Stream_On) {
983		usbvision_stream_interrupt(usbvision);
984		/* Stop all video streamings */
985		call_i2c_clients(usbvision,VIDIOC_STREAMOFF , &b);
986	}
987	usbvision_empty_framequeues(usbvision);
988
989	return 0;
990}
991
992static int vidioc_enum_fmt_cap (struct file *file, void  *priv,
993					struct v4l2_fmtdesc *vfd)
994{
995	if(vfd->index>=USBVISION_SUPPORTED_PALETTES-1) {
996		return -EINVAL;
997	}
998	vfd->flags = 0;
999	vfd->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1000	strcpy(vfd->description,usbvision_v4l2_format[vfd->index].desc);
1001	vfd->pixelformat = usbvision_v4l2_format[vfd->index].format;
1002	memset(vfd->reserved, 0, sizeof(vfd->reserved));
1003	return 0;
1004}
1005
1006static int vidioc_g_fmt_cap (struct file *file, void *priv,
1007					struct v4l2_format *vf)
1008{
1009	struct video_device *dev = video_devdata(file);
1010	struct usb_usbvision *usbvision =
1011		(struct usb_usbvision *) video_get_drvdata(dev);
1012	vf->fmt.pix.width = usbvision->curwidth;
1013	vf->fmt.pix.height = usbvision->curheight;
1014	vf->fmt.pix.pixelformat = usbvision->palette.format;
1015	vf->fmt.pix.bytesperline =
1016		usbvision->curwidth*usbvision->palette.bytes_per_pixel;
1017	vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*usbvision->curheight;
1018	vf->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
1019	vf->fmt.pix.field = V4L2_FIELD_NONE; /* Always progressive image */
1020
1021	return 0;
1022}
1023
1024static int vidioc_try_fmt_cap (struct file *file, void *priv,
1025			       struct v4l2_format *vf)
1026{
1027	struct video_device *dev = video_devdata(file);
1028	struct usb_usbvision *usbvision =
1029		(struct usb_usbvision *) video_get_drvdata(dev);
1030	int formatIdx;
1031
1032	/* Find requested format in available ones */
1033	for(formatIdx=0;formatIdx<USBVISION_SUPPORTED_PALETTES;formatIdx++) {
1034		if(vf->fmt.pix.pixelformat ==
1035		   usbvision_v4l2_format[formatIdx].format) {
1036			usbvision->palette = usbvision_v4l2_format[formatIdx];
1037			break;
1038		}
1039	}
1040	/* robustness */
1041	if(formatIdx == USBVISION_SUPPORTED_PALETTES) {
1042		return -EINVAL;
1043	}
1044	RESTRICT_TO_RANGE(vf->fmt.pix.width, MIN_FRAME_WIDTH, MAX_FRAME_WIDTH);
1045	RESTRICT_TO_RANGE(vf->fmt.pix.height, MIN_FRAME_HEIGHT, MAX_FRAME_HEIGHT);
1046
1047	vf->fmt.pix.bytesperline = vf->fmt.pix.width*
1048		usbvision->palette.bytes_per_pixel;
1049	vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*vf->fmt.pix.height;
1050
1051	return 0;
1052}
1053
1054static int vidioc_s_fmt_cap(struct file *file, void *priv,
1055			       struct v4l2_format *vf)
1056{
1057	struct video_device *dev = video_devdata(file);
1058	struct usb_usbvision *usbvision =
1059		(struct usb_usbvision *) video_get_drvdata(dev);
1060	int ret;
1061
1062	if( 0 != (ret=vidioc_try_fmt_cap (file, priv, vf)) ) {
1063		return ret;
1064	}
1065
1066	/* stop io in case it is already in progress */
1067	if(usbvision->streaming == Stream_On) {
1068		if ((ret = usbvision_stream_interrupt(usbvision)))
1069			return ret;
1070	}
1071	usbvision_frames_free(usbvision);
1072	usbvision_empty_framequeues(usbvision);
1073
1074	usbvision->curFrame = NULL;
1075
1076	/* by now we are committed to the new data... */
1077	down(&usbvision->lock);
1078	usbvision_set_output(usbvision, vf->fmt.pix.width, vf->fmt.pix.height);
1079	up(&usbvision->lock);
1080
1081	return 0;
1082}
1083
1084static ssize_t usbvision_v4l2_read(struct file *file, char __user *buf,
1085		      size_t count, loff_t *ppos)
1086{
1087	struct video_device *dev = video_devdata(file);
1088	struct usb_usbvision *usbvision =
1089		(struct usb_usbvision *) video_get_drvdata(dev);
1090	int noblock = file->f_flags & O_NONBLOCK;
1091	unsigned long lock_flags;
1092
1093	int ret,i;
1094	struct usbvision_frame *frame;
1095
1096	PDEBUG(DBG_IO, "%s: %ld bytes, noblock=%d", __FUNCTION__,
1097	       (unsigned long)count, noblock);
1098
1099	if (!USBVISION_IS_OPERATIONAL(usbvision) || (buf == NULL))
1100		return -EFAULT;
1101
1102	/* This entry point is compatible with the mmap routines
1103	   so that a user can do either VIDIOC_QBUF/VIDIOC_DQBUF
1104	   to get frames or call read on the device. */
1105	if(!usbvision->num_frames) {
1106		/* First, allocate some frames to work with
1107		   if this has not been done with VIDIOC_REQBUF */
1108		usbvision_frames_free(usbvision);
1109		usbvision_empty_framequeues(usbvision);
1110		usbvision_frames_alloc(usbvision,USBVISION_NUMFRAMES);
1111	}
1112
1113	if(usbvision->streaming != Stream_On) {
1114		/* no stream is running, make it running ! */
1115		usbvision->streaming = Stream_On;
1116		call_i2c_clients(usbvision,VIDIOC_STREAMON , NULL);
1117	}
1118
1119	/* Then, enqueue as many frames as possible
1120	   (like a user of VIDIOC_QBUF would do) */
1121	for(i=0;i<usbvision->num_frames;i++) {
1122		frame = &usbvision->frame[i];
1123		if(frame->grabstate == FrameState_Unused) {
1124			/* Mark it as ready and enqueue frame */
1125			frame->grabstate = FrameState_Ready;
1126			frame->scanstate = ScanState_Scanning;
1127			/* Accumulated in usbvision_parse_data() */
1128			frame->scanlength = 0;
1129
1130			/* set v4l2_format index */
1131			frame->v4l2_format = usbvision->palette;
1132
1133			spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
1134			list_add_tail(&frame->frame, &usbvision->inqueue);
1135			spin_unlock_irqrestore(&usbvision->queue_lock,
1136					       lock_flags);
1137		}
1138	}
1139
1140	/* Then try to steal a frame (like a VIDIOC_DQBUF would do) */
1141	if (list_empty(&(usbvision->outqueue))) {
1142		if(noblock)
1143			return -EAGAIN;
1144
1145		ret = wait_event_interruptible
1146			(usbvision->wait_frame,
1147			 !list_empty(&(usbvision->outqueue)));
1148		if (ret)
1149			return ret;
1150	}
1151
1152	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
1153	frame = list_entry(usbvision->outqueue.next,
1154			   struct usbvision_frame, frame);
1155	list_del(usbvision->outqueue.next);
1156	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
1157
1158	/* An error returns an empty frame */
1159	if (frame->grabstate == FrameState_Error) {
1160		frame->bytes_read = 0;
1161		return 0;
1162	}
1163
1164	PDEBUG(DBG_IO, "%s: frmx=%d, bytes_read=%ld, scanlength=%ld",
1165	       __FUNCTION__,
1166	       frame->index, frame->bytes_read, frame->scanlength);
1167
1168	/* copy bytes to user space; we allow for partials reads */
1169	if ((count + frame->bytes_read) > (unsigned long)frame->scanlength)
1170		count = frame->scanlength - frame->bytes_read;
1171
1172	if (copy_to_user(buf, frame->data + frame->bytes_read, count)) {
1173		return -EFAULT;
1174	}
1175
1176	frame->bytes_read += count;
1177	PDEBUG(DBG_IO, "%s: {copy} count used=%ld, new bytes_read=%ld",
1178	       __FUNCTION__,
1179	       (unsigned long)count, frame->bytes_read);
1180
1181	/* For now, forget the frame if it has not been read in one shot. */
1182/* 	if (frame->bytes_read >= frame->scanlength) {// All data has been read */
1183		frame->bytes_read = 0;
1184
1185		/* Mark it as available to be used again. */
1186		frame->grabstate = FrameState_Unused;
1187/* 	} */
1188
1189	return count;
1190}
1191
1192static int usbvision_v4l2_mmap(struct file *file, struct vm_area_struct *vma)
1193{
1194	unsigned long size = vma->vm_end - vma->vm_start,
1195		start = vma->vm_start;
1196	void *pos;
1197	u32 i;
1198
1199	struct video_device *dev = video_devdata(file);
1200	struct usb_usbvision *usbvision =
1201		(struct usb_usbvision *) video_get_drvdata(dev);
1202
1203	PDEBUG(DBG_MMAP, "mmap");
1204
1205	down(&usbvision->lock);
1206
1207	if (!USBVISION_IS_OPERATIONAL(usbvision)) {
1208		up(&usbvision->lock);
1209		return -EFAULT;
1210	}
1211
1212	if (!(vma->vm_flags & VM_WRITE) ||
1213	    size != PAGE_ALIGN(usbvision->max_frame_size)) {
1214		up(&usbvision->lock);
1215		return -EINVAL;
1216	}
1217
1218	for (i = 0; i < usbvision->num_frames; i++) {
1219		if (((PAGE_ALIGN(usbvision->max_frame_size)*i) >> PAGE_SHIFT) ==
1220		    vma->vm_pgoff)
1221			break;
1222	}
1223	if (i == usbvision->num_frames) {
1224		PDEBUG(DBG_MMAP,
1225		       "mmap: user supplied mapping address is out of range");
1226		up(&usbvision->lock);
1227		return -EINVAL;
1228	}
1229
1230	/* VM_IO is eventually going to replace PageReserved altogether */
1231	vma->vm_flags |= VM_IO;
1232	vma->vm_flags |= VM_RESERVED;	/* avoid to swap out this VMA */
1233
1234	pos = usbvision->frame[i].data;
1235	while (size > 0) {
1236
1237		if (vm_insert_page(vma, start, vmalloc_to_page(pos))) {
1238			PDEBUG(DBG_MMAP, "mmap: vm_insert_page failed");
1239			up(&usbvision->lock);
1240			return -EAGAIN;
1241		}
1242		start += PAGE_SIZE;
1243		pos += PAGE_SIZE;
1244		size -= PAGE_SIZE;
1245	}
1246
1247	up(&usbvision->lock);
1248	return 0;
1249}
1250
1251
1252/*
1253 * Here comes the stuff for radio on usbvision based devices
1254 *
1255 */
1256static int usbvision_radio_open(struct inode *inode, struct file *file)
1257{
1258	struct video_device *dev = video_devdata(file);
1259	struct usb_usbvision *usbvision =
1260		(struct usb_usbvision *) video_get_drvdata(dev);
1261	int errCode = 0;
1262
1263	PDEBUG(DBG_IO, "%s:", __FUNCTION__);
1264
1265	down(&usbvision->lock);
1266
1267	if (usbvision->user) {
1268		err("%s: Someone tried to open an already opened USBVision Radio!", __FUNCTION__);
1269		errCode = -EBUSY;
1270	}
1271	else {
1272		if(PowerOnAtOpen) {
1273			usbvision_reset_powerOffTimer(usbvision);
1274			if (usbvision->power == 0) {
1275				usbvision_power_on(usbvision);
1276				usbvision_i2c_register(usbvision);
1277			}
1278		}
1279
1280		/* Alternate interface 1 is is the biggest frame size */
1281		errCode = usbvision_set_alternate(usbvision);
1282		if (errCode < 0) {
1283			usbvision->last_error = errCode;
1284			return -EBUSY;
1285		}
1286
1287		// If so far no errors then we shall start the radio
1288		usbvision->radio = 1;
1289		call_i2c_clients(usbvision,AUDC_SET_RADIO,&usbvision->tuner_type);
1290		usbvision_set_audio(usbvision, USBVISION_AUDIO_RADIO);
1291		usbvision->user++;
1292	}
1293
1294	if (errCode) {
1295		if (PowerOnAtOpen) {
1296			usbvision_i2c_unregister(usbvision);
1297			usbvision_power_off(usbvision);
1298			usbvision->initialized = 0;
1299		}
1300	}
1301	up(&usbvision->lock);
1302	return errCode;
1303}
1304
1305
1306static int usbvision_radio_close(struct inode *inode, struct file *file)
1307{
1308	struct video_device *dev = video_devdata(file);
1309	struct usb_usbvision *usbvision =
1310		(struct usb_usbvision *) video_get_drvdata(dev);
1311	int errCode = 0;
1312
1313	PDEBUG(DBG_IO, "");
1314
1315	down(&usbvision->lock);
1316
1317	/* Set packet size to 0 */
1318	usbvision->ifaceAlt=0;
1319	errCode = usb_set_interface(usbvision->dev, usbvision->iface,
1320				    usbvision->ifaceAlt);
1321
1322	usbvision_audio_off(usbvision);
1323	usbvision->radio=0;
1324	usbvision->user--;
1325
1326	if (PowerOnAtOpen) {
1327		usbvision_set_powerOffTimer(usbvision);
1328		usbvision->initialized = 0;
1329	}
1330
1331	up(&usbvision->lock);
1332
1333	if (usbvision->remove_pending) {
1334		printk(KERN_INFO "%s: Final disconnect\n", __FUNCTION__);
1335		usbvision_release(usbvision);
1336	}
1337
1338
1339	PDEBUG(DBG_IO, "success");
1340
1341	return errCode;
1342}
1343
1344/*
1345 * Here comes the stuff for vbi on usbvision based devices
1346 *
1347 */
1348static int usbvision_vbi_open(struct inode *inode, struct file *file)
1349{
1350	/* TODO */
1351	return -ENODEV;
1352
1353}
1354
1355static int usbvision_vbi_close(struct inode *inode, struct file *file)
1356{
1357	/* TODO */
1358	return -ENODEV;
1359}
1360
1361static int usbvision_do_vbi_ioctl(struct inode *inode, struct file *file,
1362				 unsigned int cmd, void *arg)
1363{
1364	/* TODO */
1365	return -ENOIOCTLCMD;
1366}
1367
1368static int usbvision_vbi_ioctl(struct inode *inode, struct file *file,
1369		       unsigned int cmd, unsigned long arg)
1370{
1371	return video_usercopy(inode, file, cmd, arg, usbvision_do_vbi_ioctl);
1372}
1373
1374
1375//
1376// Video registration stuff
1377//
1378
1379// Video template
1380static const struct file_operations usbvision_fops = {
1381	.owner             = THIS_MODULE,
1382	.open		= usbvision_v4l2_open,
1383	.release	= usbvision_v4l2_close,
1384	.read		= usbvision_v4l2_read,
1385	.mmap		= usbvision_v4l2_mmap,
1386	.ioctl		= video_ioctl2,
1387	.llseek		= no_llseek,
1388/* 	.poll          = video_poll, */
1389	.mmap	       = usbvision_v4l2_mmap,
1390	.compat_ioctl  = v4l_compat_ioctl32,
1391};
1392static struct video_device usbvision_video_template = {
1393	.owner             = THIS_MODULE,
1394	.type		= VID_TYPE_TUNER | VID_TYPE_CAPTURE,
1395	.hardware	= VID_HARDWARE_USBVISION,
1396	.fops		= &usbvision_fops,
1397	.name           = "usbvision-video",
1398	.release	= video_device_release,
1399	.minor		= -1,
1400	.vidioc_querycap      = vidioc_querycap,
1401	.vidioc_enum_fmt_cap  = vidioc_enum_fmt_cap,
1402	.vidioc_g_fmt_cap     = vidioc_g_fmt_cap,
1403	.vidioc_try_fmt_cap   = vidioc_try_fmt_cap,
1404	.vidioc_s_fmt_cap     = vidioc_s_fmt_cap,
1405	.vidioc_reqbufs       = vidioc_reqbufs,
1406	.vidioc_querybuf      = vidioc_querybuf,
1407	.vidioc_qbuf          = vidioc_qbuf,
1408	.vidioc_dqbuf         = vidioc_dqbuf,
1409	.vidioc_s_std         = vidioc_s_std,
1410	.vidioc_enum_input    = vidioc_enum_input,
1411	.vidioc_g_input       = vidioc_g_input,
1412	.vidioc_s_input       = vidioc_s_input,
1413	.vidioc_queryctrl     = vidioc_queryctrl,
1414	.vidioc_g_audio       = vidioc_g_audio,
1415	.vidioc_g_audio       = vidioc_s_audio,
1416	.vidioc_g_ctrl        = vidioc_g_ctrl,
1417	.vidioc_s_ctrl        = vidioc_s_ctrl,
1418	.vidioc_streamon      = vidioc_streamon,
1419	.vidioc_streamoff     = vidioc_streamoff,
1420#ifdef CONFIG_VIDEO_V4L1_COMPAT
1421/*  	.vidiocgmbuf          = vidiocgmbuf, */
1422#endif
1423	.vidioc_g_tuner       = vidioc_g_tuner,
1424	.vidioc_s_tuner       = vidioc_s_tuner,
1425	.vidioc_g_frequency   = vidioc_g_frequency,
1426	.vidioc_s_frequency   = vidioc_s_frequency,
1427#ifdef CONFIG_VIDEO_ADV_DEBUG
1428	.vidioc_g_register    = vidioc_g_register,
1429	.vidioc_s_register    = vidioc_s_register,
1430#endif
1431	.tvnorms              = USBVISION_NORMS,
1432	.current_norm         = V4L2_STD_PAL
1433};
1434
1435
1436// Radio template
1437static const struct file_operations usbvision_radio_fops = {
1438	.owner             = THIS_MODULE,
1439	.open		= usbvision_radio_open,
1440	.release	= usbvision_radio_close,
1441	.ioctl		= video_ioctl2,
1442	.llseek		= no_llseek,
1443	.compat_ioctl  = v4l_compat_ioctl32,
1444};
1445
1446static struct video_device usbvision_radio_template=
1447{
1448	.owner             = THIS_MODULE,
1449	.type		= VID_TYPE_TUNER,
1450	.hardware	= VID_HARDWARE_USBVISION,
1451	.fops		= &usbvision_radio_fops,
1452	.name           = "usbvision-radio",
1453	.release	= video_device_release,
1454	.minor		= -1,
1455	.vidioc_querycap      = vidioc_querycap,
1456	.vidioc_enum_input    = vidioc_enum_input,
1457	.vidioc_g_input       = vidioc_g_input,
1458	.vidioc_s_input       = vidioc_s_input,
1459	.vidioc_queryctrl     = vidioc_queryctrl,
1460	.vidioc_g_audio       = vidioc_g_audio,
1461	.vidioc_g_audio       = vidioc_s_audio,
1462	.vidioc_g_ctrl        = vidioc_g_ctrl,
1463	.vidioc_s_ctrl        = vidioc_s_ctrl,
1464	.vidioc_g_tuner       = vidioc_g_tuner,
1465	.vidioc_s_tuner       = vidioc_s_tuner,
1466	.vidioc_g_frequency   = vidioc_g_frequency,
1467	.vidioc_s_frequency   = vidioc_s_frequency,
1468
1469	.tvnorms              = USBVISION_NORMS,
1470	.current_norm         = V4L2_STD_PAL
1471};
1472
1473// vbi template
1474static const struct file_operations usbvision_vbi_fops = {
1475	.owner             = THIS_MODULE,
1476	.open		= usbvision_vbi_open,
1477	.release	= usbvision_vbi_close,
1478	.ioctl		= usbvision_vbi_ioctl,
1479	.llseek		= no_llseek,
1480	.compat_ioctl  = v4l_compat_ioctl32,
1481};
1482
1483static struct video_device usbvision_vbi_template=
1484{
1485	.owner             = THIS_MODULE,
1486	.type		= VID_TYPE_TUNER,
1487	.hardware	= VID_HARDWARE_USBVISION,
1488	.fops		= &usbvision_vbi_fops,
1489	.release	= video_device_release,
1490	.name           = "usbvision-vbi",
1491	.minor		= -1,
1492};
1493
1494
1495static struct video_device *usbvision_vdev_init(struct usb_usbvision *usbvision,
1496					struct video_device *vdev_template,
1497					char *name)
1498{
1499	struct usb_device *usb_dev = usbvision->dev;
1500	struct video_device *vdev;
1501
1502	if (usb_dev == NULL) {
1503		err("%s: usbvision->dev is not set", __FUNCTION__);
1504		return NULL;
1505	}
1506
1507	vdev = video_device_alloc();
1508	if (NULL == vdev) {
1509		return NULL;
1510	}
1511	*vdev = *vdev_template;
1512//	vdev->minor   = -1;
1513	vdev->dev     = &usb_dev->dev;
1514	snprintf(vdev->name, sizeof(vdev->name), "%s", name);
1515	video_set_drvdata(vdev, usbvision);
1516	return vdev;
1517}
1518
1519// unregister video4linux devices
1520static void usbvision_unregister_video(struct usb_usbvision *usbvision)
1521{
1522	// vbi Device:
1523	if (usbvision->vbi) {
1524		PDEBUG(DBG_PROBE, "unregister /dev/vbi%d [v4l2]",
1525		       usbvision->vbi->minor & 0x1f);
1526		if (usbvision->vbi->minor != -1) {
1527			video_unregister_device(usbvision->vbi);
1528		} else {
1529			video_device_release(usbvision->vbi);
1530		}
1531		usbvision->vbi = NULL;
1532	}
1533
1534	// Radio Device:
1535	if (usbvision->rdev) {
1536		PDEBUG(DBG_PROBE, "unregister /dev/radio%d [v4l2]",
1537		       usbvision->rdev->minor & 0x1f);
1538		if (usbvision->rdev->minor != -1) {
1539			video_unregister_device(usbvision->rdev);
1540		} else {
1541			video_device_release(usbvision->rdev);
1542		}
1543		usbvision->rdev = NULL;
1544	}
1545
1546	// Video Device:
1547	if (usbvision->vdev) {
1548		PDEBUG(DBG_PROBE, "unregister /dev/video%d [v4l2]",
1549		       usbvision->vdev->minor & 0x1f);
1550		if (usbvision->vdev->minor != -1) {
1551			video_unregister_device(usbvision->vdev);
1552		} else {
1553			video_device_release(usbvision->vdev);
1554		}
1555		usbvision->vdev = NULL;
1556	}
1557}
1558
1559// register video4linux devices
1560static int __devinit usbvision_register_video(struct usb_usbvision *usbvision)
1561{
1562	// Video Device:
1563	usbvision->vdev = usbvision_vdev_init(usbvision,
1564					      &usbvision_video_template,
1565					      "USBVision Video");
1566	if (usbvision->vdev == NULL) {
1567		goto err_exit;
1568	}
1569	if (video_register_device(usbvision->vdev,
1570				  VFL_TYPE_GRABBER,
1571				  video_nr)<0) {
1572		goto err_exit;
1573	}
1574	printk(KERN_INFO "USBVision[%d]: registered USBVision Video device /dev/video%d [v4l2]\n",
1575	       usbvision->nr,usbvision->vdev->minor & 0x1f);
1576
1577	// Radio Device:
1578	if (usbvision_device_data[usbvision->DevModel].Radio) {
1579		// usbvision has radio
1580		usbvision->rdev = usbvision_vdev_init(usbvision,
1581						      &usbvision_radio_template,
1582						      "USBVision Radio");
1583		if (usbvision->rdev == NULL) {
1584			goto err_exit;
1585		}
1586		if (video_register_device(usbvision->rdev,
1587					  VFL_TYPE_RADIO,
1588					  radio_nr)<0) {
1589			goto err_exit;
1590		}
1591		printk(KERN_INFO "USBVision[%d]: registered USBVision Radio device /dev/radio%d [v4l2]\n",
1592		       usbvision->nr, usbvision->rdev->minor & 0x1f);
1593	}
1594	// vbi Device:
1595	if (usbvision_device_data[usbvision->DevModel].vbi) {
1596		usbvision->vbi = usbvision_vdev_init(usbvision,
1597						     &usbvision_vbi_template,
1598						     "USBVision VBI");
1599		if (usbvision->vdev == NULL) {
1600			goto err_exit;
1601		}
1602		if (video_register_device(usbvision->vbi,
1603					  VFL_TYPE_VBI,
1604					  vbi_nr)<0) {
1605			goto err_exit;
1606		}
1607		printk(KERN_INFO "USBVision[%d]: registered USBVision VBI device /dev/vbi%d [v4l2] (Not Working Yet!)\n",
1608		       usbvision->nr,usbvision->vbi->minor & 0x1f);
1609	}
1610	// all done
1611	return 0;
1612
1613 err_exit:
1614	err("USBVision[%d]: video_register_device() failed", usbvision->nr);
1615	usbvision_unregister_video(usbvision);
1616	return -1;
1617}
1618
1619/*
1620 * usbvision_alloc()
1621 *
1622 * This code allocates the struct usb_usbvision.
1623 * It is filled with default values.
1624 *
1625 * Returns NULL on error, a pointer to usb_usbvision else.
1626 *
1627 */
1628static struct usb_usbvision *usbvision_alloc(struct usb_device *dev)
1629{
1630	struct usb_usbvision *usbvision;
1631
1632	if ((usbvision = kzalloc(sizeof(struct usb_usbvision), GFP_KERNEL)) ==
1633	    NULL) {
1634		goto err_exit;
1635	}
1636
1637	usbvision->dev = dev;
1638
1639	init_MUTEX(&usbvision->lock);	/* to 1 == available */
1640
1641	// prepare control urb for control messages during interrupts
1642	usbvision->ctrlUrb = usb_alloc_urb(USBVISION_URB_FRAMES, GFP_KERNEL);
1643	if (usbvision->ctrlUrb == NULL) {
1644		goto err_exit;
1645	}
1646	init_waitqueue_head(&usbvision->ctrlUrb_wq);
1647	init_MUTEX(&usbvision->ctrlUrbLock);	/* to 1 == available */
1648
1649	usbvision_init_powerOffTimer(usbvision);
1650
1651	return usbvision;
1652
1653err_exit:
1654	if (usbvision && usbvision->ctrlUrb) {
1655		usb_free_urb(usbvision->ctrlUrb);
1656	}
1657	if (usbvision) {
1658		kfree(usbvision);
1659	}
1660	return NULL;
1661}
1662
1663/*
1664 * usbvision_release()
1665 *
1666 * This code does final release of struct usb_usbvision. This happens
1667 * after the device is disconnected -and- all clients closed their files.
1668 *
1669 */
1670static void usbvision_release(struct usb_usbvision *usbvision)
1671{
1672	PDEBUG(DBG_PROBE, "");
1673
1674	down(&usbvision->lock);
1675
1676	usbvision_reset_powerOffTimer(usbvision);
1677
1678	usbvision->initialized = 0;
1679
1680	up(&usbvision->lock);
1681
1682	usbvision_remove_sysfs(usbvision->vdev);
1683	usbvision_unregister_video(usbvision);
1684
1685	if (usbvision->ctrlUrb) {
1686		usb_free_urb(usbvision->ctrlUrb);
1687	}
1688
1689	kfree(usbvision);
1690
1691	PDEBUG(DBG_PROBE, "success");
1692}
1693
1694
1695/*********************** usb interface **********************************/
1696
1697static void usbvision_configure_video(struct usb_usbvision *usbvision)
1698{
1699	int model;
1700
1701	if (usbvision == NULL)
1702		return;
1703
1704	model = usbvision->DevModel;
1705	usbvision->palette = usbvision_v4l2_format[2]; // V4L2_PIX_FMT_RGB24;
1706
1707	if (usbvision_device_data[usbvision->DevModel].Vin_Reg2_override) {
1708		usbvision->Vin_Reg2_Preset =
1709			usbvision_device_data[usbvision->DevModel].Vin_Reg2;
1710	} else {
1711		usbvision->Vin_Reg2_Preset = 0;
1712	}
1713
1714	usbvision->tvnormId = usbvision_device_data[model].VideoNorm;
1715
1716	usbvision->video_inputs = usbvision_device_data[model].VideoChannels;
1717	usbvision->ctl_input = 0;
1718
1719	/* This should be here to make i2c clients to be able to register */
1720	/* first switch off audio */
1721	usbvision_audio_off(usbvision);
1722	if (!PowerOnAtOpen) {
1723		/* and then power up the noisy tuner */
1724		usbvision_power_on(usbvision);
1725		usbvision_i2c_register(usbvision);
1726	}
1727}
1728
1729/*
1730 * usbvision_probe()
1731 *
1732 * This procedure queries device descriptor and accepts the interface
1733 * if it looks like USBVISION video device
1734 *
1735 */
1736static int __devinit usbvision_probe(struct usb_interface *intf,
1737				     const struct usb_device_id *devid)
1738{
1739	struct usb_device *dev = usb_get_dev(interface_to_usbdev(intf));
1740	struct usb_interface *uif;
1741	__u8 ifnum = intf->altsetting->desc.bInterfaceNumber;
1742	const struct usb_host_interface *interface;
1743	struct usb_usbvision *usbvision = NULL;
1744	const struct usb_endpoint_descriptor *endpoint;
1745	int model,i;
1746
1747	PDEBUG(DBG_PROBE, "VID=%#04x, PID=%#04x, ifnum=%u",
1748				dev->descriptor.idVendor,
1749				dev->descriptor.idProduct, ifnum);
1750
1751	model = devid->driver_info;
1752	if ( (model<0) || (model>=usbvision_device_data_size) ) {
1753		PDEBUG(DBG_PROBE, "model out of bounds %d",model);
1754		return -ENODEV;
1755	}
1756	printk(KERN_INFO "%s: %s found\n", __FUNCTION__,
1757				usbvision_device_data[model].ModelString);
1758
1759	if (usbvision_device_data[model].Interface >= 0) {
1760		interface = &dev->actconfig->interface[usbvision_device_data[model].Interface]->altsetting[0];
1761	} else {
1762		interface = &dev->actconfig->interface[ifnum]->altsetting[0];
1763	}
1764	endpoint = &interface->endpoint[1].desc;
1765	if ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) !=
1766	    USB_ENDPOINT_XFER_ISOC) {
1767		err("%s: interface %d. has non-ISO endpoint!",
1768		    __FUNCTION__, ifnum);
1769		err("%s: Endpoint attributes %d",
1770		    __FUNCTION__, endpoint->bmAttributes);
1771		return -ENODEV;
1772	}
1773	if ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
1774	    USB_DIR_OUT) {
1775		err("%s: interface %d. has ISO OUT endpoint!",
1776		    __FUNCTION__, ifnum);
1777		return -ENODEV;
1778	}
1779
1780	if ((usbvision = usbvision_alloc(dev)) == NULL) {
1781		err("%s: couldn't allocate USBVision struct", __FUNCTION__);
1782		return -ENOMEM;
1783	}
1784
1785	if (dev->descriptor.bNumConfigurations > 1) {
1786		usbvision->bridgeType = BRIDGE_NT1004;
1787	} else if (model == DAZZLE_DVC_90_REV_1_SECAM) {
1788		usbvision->bridgeType = BRIDGE_NT1005;
1789	} else {
1790		usbvision->bridgeType = BRIDGE_NT1003;
1791	}
1792	PDEBUG(DBG_PROBE, "bridgeType %d", usbvision->bridgeType);
1793
1794	down(&usbvision->lock);
1795
1796	/* compute alternate max packet sizes */
1797	uif = dev->actconfig->interface[0];
1798
1799	usbvision->num_alt=uif->num_altsetting;
1800	PDEBUG(DBG_PROBE, "Alternate settings: %i",usbvision->num_alt);
1801	usbvision->alt_max_pkt_size = kmalloc(32*
1802					      usbvision->num_alt,GFP_KERNEL);
1803	if (usbvision->alt_max_pkt_size == NULL) {
1804		err("usbvision: out of memory!\n");
1805		return -ENOMEM;
1806	}
1807
1808	for (i = 0; i < usbvision->num_alt ; i++) {
1809		u16 tmp = le16_to_cpu(uif->altsetting[i].endpoint[1].desc.
1810				      wMaxPacketSize);
1811		usbvision->alt_max_pkt_size[i] =
1812			(tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
1813		PDEBUG(DBG_PROBE, "Alternate setting %i, max size= %i",i,
1814		       usbvision->alt_max_pkt_size[i]);
1815	}
1816
1817
1818	usbvision->nr = usbvision_nr++;
1819
1820	usbvision->have_tuner = usbvision_device_data[model].Tuner;
1821	if (usbvision->have_tuner) {
1822		usbvision->tuner_type = usbvision_device_data[model].TunerType;
1823	}
1824
1825	usbvision->tuner_addr = ADDR_UNSET;
1826
1827	usbvision->DevModel = model;
1828	usbvision->remove_pending = 0;
1829	usbvision->iface = ifnum;
1830	usbvision->ifaceAlt = 0;
1831	usbvision->video_endp = endpoint->bEndpointAddress;
1832	usbvision->isocPacketSize = 0;
1833	usbvision->usb_bandwidth = 0;
1834	usbvision->user = 0;
1835	usbvision->streaming = Stream_Off;
1836	usbvision_register_video(usbvision);
1837	usbvision_configure_video(usbvision);
1838	up(&usbvision->lock);
1839
1840
1841	usb_set_intfdata (intf, usbvision);
1842	usbvision_create_sysfs(usbvision->vdev);
1843
1844	PDEBUG(DBG_PROBE, "success");
1845	return 0;
1846}
1847
1848
1849/*
1850 * usbvision_disconnect()
1851 *
1852 * This procedure stops all driver activity, deallocates interface-private
1853 * structure (pointed by 'ptr') and after that driver should be removable
1854 * with no ill consequences.
1855 *
1856 */
1857static void __devexit usbvision_disconnect(struct usb_interface *intf)
1858{
1859	struct usb_usbvision *usbvision = usb_get_intfdata(intf);
1860
1861	PDEBUG(DBG_PROBE, "");
1862
1863	if (usbvision == NULL) {
1864		err("%s: usb_get_intfdata() failed", __FUNCTION__);
1865		return;
1866	}
1867	usb_set_intfdata (intf, NULL);
1868
1869	down(&usbvision->lock);
1870
1871	// At this time we ask to cancel outstanding URBs
1872	usbvision_stop_isoc(usbvision);
1873
1874	if (usbvision->power) {
1875		usbvision_i2c_unregister(usbvision);
1876		usbvision_power_off(usbvision);
1877	}
1878	usbvision->remove_pending = 1;	// Now all ISO data will be ignored
1879
1880	usb_put_dev(usbvision->dev);
1881	usbvision->dev = NULL;	// USB device is no more
1882
1883	up(&usbvision->lock);
1884
1885	if (usbvision->user) {
1886		printk(KERN_INFO "%s: In use, disconnect pending\n",
1887		       __FUNCTION__);
1888		wake_up_interruptible(&usbvision->wait_frame);
1889		wake_up_interruptible(&usbvision->wait_stream);
1890	} else {
1891		usbvision_release(usbvision);
1892	}
1893
1894	PDEBUG(DBG_PROBE, "success");
1895
1896}
1897
1898static struct usb_driver usbvision_driver = {
1899	.name		= "usbvision",
1900	.id_table	= usbvision_table,
1901	.probe		= usbvision_probe,
1902	.disconnect	= usbvision_disconnect
1903};
1904
1905/*
1906 * usbvision_init()
1907 *
1908 * This code is run to initialize the driver.
1909 *
1910 */
1911static int __init usbvision_init(void)
1912{
1913	int errCode;
1914
1915	PDEBUG(DBG_PROBE, "");
1916
1917	PDEBUG(DBG_IO,  "IO      debugging is enabled [video]");
1918	PDEBUG(DBG_PROBE, "PROBE   debugging is enabled [video]");
1919	PDEBUG(DBG_MMAP, "MMAP    debugging is enabled [video]");
1920
1921	/* disable planar mode support unless compression enabled */
1922	if (isocMode != ISOC_MODE_COMPRESS ) {
1923		// FIXME : not the right way to set supported flag
1924		usbvision_v4l2_format[6].supported = 0; // V4L2_PIX_FMT_YVU420
1925		usbvision_v4l2_format[7].supported = 0; // V4L2_PIX_FMT_YUV422P
1926	}
1927
1928	errCode = usb_register(&usbvision_driver);
1929
1930	if (errCode == 0) {
1931		printk(KERN_INFO DRIVER_DESC " : " USBVISION_VERSION_STRING "\n");
1932		PDEBUG(DBG_PROBE, "success");
1933	}
1934	return errCode;
1935}
1936
1937static void __exit usbvision_exit(void)
1938{
1939 PDEBUG(DBG_PROBE, "");
1940
1941 usb_deregister(&usbvision_driver);
1942 PDEBUG(DBG_PROBE, "success");
1943}
1944
1945module_init(usbvision_init);
1946module_exit(usbvision_exit);
1947
1948/*
1949 * Overrides for Emacs so that we follow Linus's tabbing style.
1950 * ---------------------------------------------------------------------------
1951 * Local variables:
1952 * c-basic-offset: 8
1953 * End:
1954 */
1955