usbvision-video.c revision c84e6036ba7177a404cc860cb5a440e06fad92dd
1483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
27ca659e3c1c3dd67073751385ae3bd25b27526bbMauro Carvalho Chehab * USB USBVISION Video device driver 0.9.9
3483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
4483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
5483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
6483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Copyright (c) 1999-2005 Joerg Heckenbach <joerg@heckenbach-aw.de>
7483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
8483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This module is part of usbvision driver project.
9483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
10483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This program is free software; you can redistribute it and/or modify
11483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * it under the terms of the GNU General Public License as published by
12483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * the Free Software Foundation; either version 2 of the License, or
13483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * (at your option) any later version.
14483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
15483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This program is distributed in the hope that it will be useful,
16483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * but WITHOUT ANY WARRANTY; without even the implied warranty of
17483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * GNU General Public License for more details.
19483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
20483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * You should have received a copy of the GNU General Public License
21483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * along with this program; if not, write to the Free Software
22483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
24483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Let's call the version 0.... until compression decoding is completely
25483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * implemented.
26483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
27483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This driver is written by Jose Ignacio Gijon and Joerg Heckenbach.
28483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * It was based on USB CPiA driver written by Peter Pregler,
29483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Scott J. Bertin and Johannes Erdfelt
30483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Ideas are taken from bttv driver by Ralph Metzler, Marcus Metzler &
31483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Gerd Knorr and zoran 36120/36125 driver by Pauline Middelink
32483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Updates to driver completed by Dwaine P. Garden
33483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
34483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
35483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * TODO:
36483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *     - use submit_urb for all setup packets
37483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *     - Fix memory settings for nt1004. It is 4 times as big as the
38483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *       nt1003 memory.
39c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE *     - Add audio on endpoint 3 for nt1004 chip.
40c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE *         Seems impossible, needs a codec interface.  Which one?
41483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *     - Clean up the driver.
42483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *     - optimization for performance.
43483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *     - Add Videotext capability (VBI).  Working on it.....
44483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *     - Check audio for other devices
45483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
46483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
47483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
48f30ebd43597e9b2bbbc8b0eb650f5aad545e255bMauro Carvalho Chehab#include <linux/version.h>
49483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/kernel.h>
50483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/list.h>
51483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/timer.h>
52483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/slab.h>
53483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/mm.h>
54483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/utsname.h>
55483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/highmem.h>
56483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/videodev.h>
57483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/vmalloc.h>
58483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/module.h>
59483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/init.h>
60483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/spinlock.h>
61483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <asm/io.h>
62483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/videodev2.h>
63483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/video_decoder.h>
64483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/i2c.h>
65483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
66483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <media/saa7115.h>
67483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <media/v4l2-common.h>
68483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <media/tuner.h>
69483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <media/audiochip.h>
70483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
71a1ed551cdb4f29157466340760fde68bcda704a9Mauro Carvalho Chehab#include <linux/workqueue.h>
72483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
73483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#ifdef CONFIG_KMOD
74483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/kmod.h>
75483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#endif
76483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
77483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include "usbvision.h"
78659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab#include "usbvision-cards.h"
79483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
80c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#define DRIVER_AUTHOR "Joerg Heckenbach <joerg@heckenbach-aw.de>,\
81c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE Dwaine Garden <DwaineGarden@rogers.com>"
82483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_NAME "usbvision"
83483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_ALIAS "USBVision"
84483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_DESC "USBVision USB Video Device Driver for Linux"
85483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_LICENSE "GPL"
86483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define USBVISION_DRIVER_VERSION_MAJOR 0
87483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define USBVISION_DRIVER_VERSION_MINOR 9
88483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define USBVISION_DRIVER_VERSION_PATCHLEVEL 9
89c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#define USBVISION_DRIVER_VERSION KERNEL_VERSION(USBVISION_DRIVER_VERSION_MAJOR,\
90c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEUSBVISION_DRIVER_VERSION_MINOR,\
91c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEUSBVISION_DRIVER_VERSION_PATCHLEVEL)
92c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#define USBVISION_VERSION_STRING __stringify(USBVISION_DRIVER_VERSION_MAJOR)\
93c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE "." __stringify(USBVISION_DRIVER_VERSION_MINOR)\
94c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE "." __stringify(USBVISION_DRIVER_VERSION_PATCHLEVEL)
95483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
96483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define	ENABLE_HEXDUMP	0	/* Enable if you need it */
97483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
98483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
99483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#ifdef USBVISION_DEBUG
100483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	#define PDEBUG(level, fmt, args...) \
101c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (video_debug & (level)) \
102c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ ,\
103c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				## args)
104483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#else
105483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	#define PDEBUG(level, fmt, args...) do {} while(0)
106483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#endif
107483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
108483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DBG_IO		1<<1
109483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DBG_PROBE	1<<2
110c876a3468d0f136710af81595177889953d1ff71Thierry MERLE#define DBG_MMAP	1<<3
111483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
112483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//String operations
113483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define rmspace(str)	while(*str==' ') str++;
114483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define goto2next(str)	while(*str!=' ') str++; while(*str==' ') str++;
115483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
116483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
117c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* sequential number of usbvision device */
118c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int usbvision_nr = 0;
119483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
120483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct usbvision_v4l2_format_st usbvision_v4l2_format[] = {
121483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 1,  8, V4L2_PIX_FMT_GREY    , "GREY" },
122483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_RGB565  , "RGB565" },
123483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 3, 24, V4L2_PIX_FMT_RGB24   , "RGB24" },
124483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 4, 32, V4L2_PIX_FMT_RGB32   , "RGB32" },
125483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_RGB555  , "RGB555" },
126483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_YUYV    , "YUV422" },
127483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 12, V4L2_PIX_FMT_YVU420  , "YUV420P" }, // 1.5 !
128483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_YUV422P , "YUV422P" }
129483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
130483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
131c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Function prototypes */
132483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_release(struct usb_usbvision *usbvision);
133483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
134c84e6036ba7177a404cc860cb5a440e06fad92ddJoe Perches/* Default initialization of device driver parameters */
135c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Set the default format for ISOC endpoint */
136c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int isocMode = ISOC_MODE_COMPRESS;
137c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Set the default Debug Mode of the device driver */
138c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int video_debug = 0;
139c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Set the default device to power on at startup */
140c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int PowerOnAtOpen = 1;
141c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Sequential Number of Video Device */
142c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int video_nr = -1;
143c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Sequential Number of Radio Device */
144c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int radio_nr = -1;
145c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Sequential Number of VBI Device */
146c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vbi_nr = -1;
147c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
148c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Grab parameters for the device driver */
149c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
150c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Showing parameters under SYSFS */
151483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(isocMode, int, 0444);
152483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(video_debug, int, 0444);
153483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(PowerOnAtOpen, int, 0444);
154483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(video_nr, int, 0444);
155483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(radio_nr, int, 0444);
156483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(vbi_nr, int, 0444);
157483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
158483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(isocMode, " Set the default format for ISOC endpoint.  Default: 0x60 (Compression On)");
159483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(video_debug, " Set the default Debug Mode of the device driver.  Default: 0 (Off)");
160483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(PowerOnAtOpen, " Set the default device to power on when device is opened.  Default: 1 (On)");
161483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(video_nr, "Set video device number (/dev/videoX).  Default: -1 (autodetect)");
162483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(radio_nr, "Set radio device number (/dev/radioX).  Default: -1 (autodetect)");
163483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(vbi_nr, "Set vbi device number (/dev/vbiX).  Default: -1 (autodetect)");
164483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
165483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
166483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Misc stuff
167483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_AUTHOR(DRIVER_AUTHOR);
168483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_DESCRIPTION(DRIVER_DESC);
169483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_LICENSE(DRIVER_LICENSE);
170a1ed551cdb4f29157466340760fde68bcda704a9Mauro Carvalho ChehabMODULE_VERSION(USBVISION_VERSION_STRING);
171a1ed551cdb4f29157466340760fde68bcda704a9Mauro Carvalho ChehabMODULE_ALIAS(DRIVER_ALIAS);
172483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
173483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
174c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*****************************************************************************/
175c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* SYSFS Code - Copied from the stv680.c usb module.			     */
176c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Device information is located at /sys/class/video4linux/video0            */
177c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Device parameters information is located at /sys/module/usbvision         */
178c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Device USB Information is located at                                      */
179c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*   /sys/bus/usb/drivers/USBVision Video Grabber                            */
180c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*****************************************************************************/
181483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
182483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
183483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define YES_NO(x) ((x) ? "Yes" : "No")
184483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
18554bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic inline struct usb_usbvision *cd_to_usbvision(struct device *cd)
186483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
187c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
188c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
189483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return video_get_drvdata(vdev);
190483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
191483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
19254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_version(struct device *cd,
19354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			    struct device_attribute *attr, char *buf)
194483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
195483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return sprintf(buf, "%s\n", USBVISION_VERSION_STRING);
196483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
19754bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(version, S_IRUGO, show_version, NULL);
198483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
19954bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_model(struct device *cd,
20054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			  struct device_attribute *attr, char *buf)
201483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
202c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
203c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
204483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
205c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return sprintf(buf, "%s\n",
206c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision_device_data[usbvision->DevModel].ModelString);
207483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
20854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(model, S_IRUGO, show_model, NULL);
209483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
21054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_hue(struct device *cd,
21154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			struct device_attribute *attr, char *buf)
212483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
213c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
214c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
215483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
216483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
217483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_HUE;
218483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
219ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
220ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2212a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
222483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
22354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(hue, S_IRUGO, show_hue, NULL);
224483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
22554bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_contrast(struct device *cd,
22654bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			     struct device_attribute *attr, char *buf)
227483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
228c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
229c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
230483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
231483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
232483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_CONTRAST;
233483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
234ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
235ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2362a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
237483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
23854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(contrast, S_IRUGO, show_contrast, NULL);
239483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
24054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_brightness(struct device *cd,
24154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			       struct device_attribute *attr, char *buf)
242483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
243c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
244c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
245483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
246483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
247483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_BRIGHTNESS;
248483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
249ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
250ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2512a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
252483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
25354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(brightness, S_IRUGO, show_brightness, NULL);
254483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
25554bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_saturation(struct device *cd,
25654bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			       struct device_attribute *attr, char *buf)
257483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
258c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
259c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
260483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
261483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
262483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_SATURATION;
263483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
264ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
265ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2662a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
267483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
26854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(saturation, S_IRUGO, show_saturation, NULL);
269483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
27054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_streaming(struct device *cd,
27154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers			      struct device_attribute *attr, char *buf)
272483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
273c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
274c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
275483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
276c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return sprintf(buf, "%s\n",
277c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       YES_NO(usbvision->streaming==Stream_On?1:0));
278483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
27954bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(streaming, S_IRUGO, show_streaming, NULL);
280483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
28154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_compression(struct device *cd,
28254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers				struct device_attribute *attr, char *buf)
283483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
284c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
285c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
286483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
287c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return sprintf(buf, "%s\n",
288c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       YES_NO(usbvision->isocMode==ISOC_MODE_COMPRESS));
289483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
29054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(compression, S_IRUGO, show_compression, NULL);
291483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
29254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic ssize_t show_device_bridge(struct device *cd,
29354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers				  struct device_attribute *attr, char *buf)
294483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
295c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
296c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
297483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
298483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return sprintf(buf, "%d\n", usbvision->bridgeType);
299483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
30054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sieversstatic DEVICE_ATTR(bridge, S_IRUGO, show_device_bridge, NULL);
301483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
302483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_create_sysfs(struct video_device *vdev)
303483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
304483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int res;
305ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if (!vdev)
306ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		return;
307ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	do {
30854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
30954bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_version);
310ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
311ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
31254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
31354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_model);
314ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
315ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
31654bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
31754bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_hue);
318ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
319ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
32054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
32154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_contrast);
322ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
323ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
32454bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
32554bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_brightness);
326ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
327ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
32854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
32954bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_saturation);
330ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
331ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
33254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
33354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_streaming);
334ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
335ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
33654bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
33754bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_compression);
338ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
339ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
34054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		res = device_create_file(&vdev->class_dev,
34154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_bridge);
342ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res>=0)
343ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			return;
344ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	} while (0);
345ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden
346ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	err("%s error: %d\n", __FUNCTION__, res);
347483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
348483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
349483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_remove_sysfs(struct video_device *vdev)
350483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
351483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (vdev) {
35254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
35354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_version);
35454bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
35554bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_model);
35654bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
35754bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_hue);
35854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
35954bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_contrast);
36054bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
36154bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_brightness);
36254bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
36354bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_saturation);
36454bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
36554bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_streaming);
36654bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
36754bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_compression);
36854bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers		device_remove_file(&vdev->class_dev,
36954bd5b66c87d14e250f108aad1228b905d6882f6Kay Sievers					 &dev_attr_bridge);
370483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
371483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
372483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
373483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
374483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
375483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_open()
376483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
377483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This is part of Video 4 Linux API. The driver can be opened by one
378483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * client only (checks internal counter 'usbvision->user'). The procedure
379483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * then allocates buffers needed for video processing.
380483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
381483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
382483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_v4l2_open(struct inode *inode, struct file *file)
383483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
384483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
385c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
386c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
387483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode = 0;
388483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
389483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "open");
390483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
391483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
392483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_reset_powerOffTimer(usbvision);
393483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
394483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->user)
395483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		errCode = -EBUSY;
396483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	else {
3976f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		/* Allocate memory for the scratch ring buffer */
3986f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		errCode = usbvision_scratch_alloc(usbvision);
3996f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		if (isocMode==ISOC_MODE_COMPRESS) {
400c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			/* Allocate intermediate decompression buffers
401c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			   only if needed */
4026f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE			errCode = usbvision_decompress_alloc(usbvision);
403483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
404483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (errCode) {
405483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			/* Deallocate all buffers if trouble */
406483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_scratch_free(usbvision);
407483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_decompress_free(usbvision);
408483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
409483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
410483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
411483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* If so far no errors then we shall start the camera */
412483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!errCode) {
413289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke		mutex_lock(&usbvision->lock);
414483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->power == 0) {
415483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_power_on(usbvision);
4161ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE			usbvision_i2c_register(usbvision);
417483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
418483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
419483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		/* Send init sequence only once, it's large! */
420483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (!usbvision->initialized) {
421483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			int setup_ok = 0;
422483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			setup_ok = usbvision_setup(usbvision,isocMode);
423483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			if (setup_ok)
424483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision->initialized = 1;
425483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			else
426483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				errCode = -EBUSY;
427483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
428483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
429483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (!errCode) {
430483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_begin_streaming(usbvision);
431483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			errCode = usbvision_init_isoc(usbvision);
432c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			/* device must be initialized before isoc transfer */
433483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_muxsel(usbvision,0);
434483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision->user++;
435c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
436483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			if (PowerOnAtOpen) {
4371ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE				usbvision_i2c_unregister(usbvision);
438483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision_power_off(usbvision);
439483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision->initialized = 0;
440483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			}
441483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
442289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke		mutex_unlock(&usbvision->lock);
443483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
444483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
445483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (errCode) {
446483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
447483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
448483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* prepare queues */
449483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_empty_framequeues(usbvision);
450483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
451483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "success");
452483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
453483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
454483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
455483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
456483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_v4l2_close()
457483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
458483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This is part of Video 4 Linux API. The procedure
459483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * stops streaming and deallocates all buffers that were earlier
460483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * allocated in usbvision_v4l2_open().
461483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
462483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
463483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_v4l2_close(struct inode *inode, struct file *file)
464483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
465483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
466c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
467c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
468483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
469483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "close");
470289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
471483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
472483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_audio_off(usbvision);
473483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_restart_isoc(usbvision);
474483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_stop_isoc(usbvision);
475483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
476483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_decompress_free(usbvision);
47738284ba361d69eca34a3bfc553ebfac81fea2698Thierry MERLE	usbvision_frames_free(usbvision);
4786f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	usbvision_empty_framequeues(usbvision);
479483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_scratch_free(usbvision);
480483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
481483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->user--;
482483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
483483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (PowerOnAtOpen) {
484c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* power off in a little while
485c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		   to avoid off/on every close/open short sequences */
486483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_set_powerOffTimer(usbvision);
487483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->initialized = 0;
488483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
489483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
490289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
491483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
492483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->remove_pending) {
493de6a1b8edc48155249896f2600398e139f4860c6Dwaine Garden		printk(KERN_INFO "%s: Final disconnect\n", __FUNCTION__);
494483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_release(usbvision);
495483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
496483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
497483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "success");
498483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
499483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
500483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
501483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
502483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
503483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
504483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
505483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_ioctl()
506483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
507483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This is part of Video 4 Linux API. The procedure handles ioctl() calls.
508483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
509483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
510c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#ifdef CONFIG_VIDEO_ADV_DEBUG
511c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_register (struct file *file, void *priv,
512c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_register *reg)
513483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
514483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
515c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
516c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
517c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int errCode;
518483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
519c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!v4l2_chip_match_host(reg->match_type, reg->match_chip))
520c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
521c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* NT100x has a 8-bit register space */
522c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	errCode = usbvision_read_reg(usbvision, reg->reg&0xff);
523c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (errCode < 0) {
524c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: VIDIOC_DBG_G_REGISTER failed: error %d",
525c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, errCode);
526c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return errCode;
527c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
528bc147135bc410bdd9da684646af75a188d882d56Trent Piepho	reg->val = errCode;
529c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
530c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
531483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
532c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_register (struct file *file, void *priv,
533c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_register *reg)
534c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
535c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
536c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
537c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
538c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int errCode;
53962d50addf0774115adaa9e01e09099c3d7daa13dTrent Piepho
540c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!v4l2_chip_match_host(reg->match_type, reg->match_chip))
541c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
542c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* NT100x has a 8-bit register space */
543bc147135bc410bdd9da684646af75a188d882d56Trent Piepho	errCode = usbvision_write_reg(usbvision, reg->reg&0xff, reg->val);
544bc147135bc410bdd9da684646af75a188d882d56Trent Piepho	if (errCode < 0) {
545c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: VIDIOC_DBG_S_REGISTER failed: error %d",
546c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, errCode);
547c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return errCode;
548c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
549c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
550c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
551483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#endif
552c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
553c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_querycap (struct file *file, void  *priv,
554c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					struct v4l2_capability *vc)
555c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
556c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
557c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
558c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
559c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
560c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strlcpy(vc->driver, "USBVision", sizeof(vc->driver));
561c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strlcpy(vc->card,
562c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision_device_data[usbvision->DevModel].ModelString,
563c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		sizeof(vc->card));
564c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strlcpy(vc->bus_info, usbvision->dev->dev.bus_id,
565c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		sizeof(vc->bus_info));
566c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vc->version = USBVISION_DRIVER_VERSION;
567c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vc->capabilities = V4L2_CAP_VIDEO_CAPTURE |
568c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_CAP_AUDIO |
569c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_CAP_READWRITE |
570c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_CAP_STREAMING |
571c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(usbvision->have_tuner ? V4L2_CAP_TUNER : 0);
572c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
573c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
574c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
575c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_enum_input (struct file *file, void *priv,
576c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_input *vi)
577c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
578c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
579c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
580c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
581c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int chan;
582c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
583c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((vi->index >= usbvision->video_inputs) || (vi->index < 0) )
584c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
585c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (usbvision->have_tuner) {
586c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		chan = vi->index;
587c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
588c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		chan = vi->index + 1; /*skip Television string*/
589c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
590c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Determine the requested input characteristics
591c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   specific for each usbvision card model */
592c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	switch(chan) {
593c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 0:
594c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
595c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "White Video Input");
596c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
597c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Television");
598c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->type = V4L2_INPUT_TYPE_TUNER;
599c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->audioset = 1;
600c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->tuner = chan;
601c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->std = USBVISION_NORMS;
602483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
603c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
604c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 1:
605c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->type = V4L2_INPUT_TYPE_CAMERA;
606c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
607c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Green Video Input");
608c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
609c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Composite Video Input");
610483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
611c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->std = V4L2_STD_PAL;
612c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
613c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 2:
614c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->type = V4L2_INPUT_TYPE_CAMERA;
615c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
616c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Yellow Video Input");
617c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
618c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "S-Video Input");
619483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
620c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->std = V4L2_STD_PAL;
621c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
622c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 3:
623c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->type = V4L2_INPUT_TYPE_CAMERA;
624c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(vi->name, "Red Video Input");
625c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->std = V4L2_STD_PAL;
626c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
627c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
628c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
629c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
630483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
631c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_input (struct file *file, void *priv, unsigned int *input)
632c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
633c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
634c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
635c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
636483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
637c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	*input = usbvision->ctl_input;
638c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
639c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
640483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
641c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_input (struct file *file, void *priv, unsigned int input)
642c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
643c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
644c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
645c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
646483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
647c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((input >= usbvision->video_inputs) || (input < 0) )
648c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
649483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
650289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
65166a17879e9f18a38c4ca5e6ba600a3f5b1b51188Thierry MERLE	usbvision_muxsel(usbvision, input);
652c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_set_input(usbvision);
653c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_set_output(usbvision,
654c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			     usbvision->curwidth,
655c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			     usbvision->curheight);
656289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
657c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
658c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
659483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
660c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_std (struct file *file, void *priv, v4l2_std_id *id)
661c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
662c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
663c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
664c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
665c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->tvnormId=*id;
666483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
667289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
668c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_S_STD,
669c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			 &usbvision->tvnormId);
670289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
67166a17879e9f18a38c4ca5e6ba600a3f5b1b51188Thierry MERLE	/* propagate the change to the decoder */
67266a17879e9f18a38c4ca5e6ba600a3f5b1b51188Thierry MERLE	usbvision_muxsel(usbvision, usbvision->ctl_input);
673483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
674c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
675c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
676483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
677c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_tuner (struct file *file, void *priv,
678c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_tuner *vt)
679c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
680c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
681c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
682c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
683483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
684c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!usbvision->have_tuner || vt->index)	// Only tuner 0
685c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
686c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->radio) {
687c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(vt->name, "Radio");
688c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vt->type = V4L2_TUNER_RADIO;
689c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
690c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(vt->name, "Television");
691c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
692c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Let clients fill in the remainder of this struct */
693c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision,VIDIOC_G_TUNER,vt);
694483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
695c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
696c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
697483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
698c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_tuner (struct file *file, void *priv,
699c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_tuner *vt)
700c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
701c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
702c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
703c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
704483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
705c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	// Only no or one tuner for now
706c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!usbvision->have_tuner || vt->index)
707c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
708c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* let clients handle this */
709c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision,VIDIOC_S_TUNER,vt);
710483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
711c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
712c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
713483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
714c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_frequency (struct file *file, void *priv,
715c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_frequency *freq)
716c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
717c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
718c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
719c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
720483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
721c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	freq->tuner = 0; // Only one tuner
722c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->radio) {
723c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		freq->type = V4L2_TUNER_RADIO;
724c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
725c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		freq->type = V4L2_TUNER_ANALOG_TV;
726c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
727c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	freq->frequency = usbvision->freq;
728483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
729c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
730c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
731483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
732c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_frequency (struct file *file, void *priv,
733c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_frequency *freq)
734c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
735c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
736c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
737c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
738483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
739c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	// Only no or one tuner for now
740c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!usbvision->have_tuner || freq->tuner)
741c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
742483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
743c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->freq = freq->frequency;
744c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_S_FREQUENCY, freq);
745483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
746c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
747c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
748483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
749c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_audio (struct file *file, void *priv, struct v4l2_audio *a)
750c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
751c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
752c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
753c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
754483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
755c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	memset(a,0,sizeof(*a));
756c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->radio) {
757c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(a->name,"Radio");
758c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
759c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(a->name, "TV");
760c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
761483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
762c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
763c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
764483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
765c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_audio (struct file *file, void *fh,
766c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			  struct v4l2_audio *a)
767c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
768c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(a->index) {
769c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
770c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
771483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
772c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
773c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
774483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
775c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_queryctrl (struct file *file, void *priv,
776c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			    struct v4l2_queryctrl *ctrl)
777c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
778c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
779c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
780c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
781c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int id=ctrl->id;
782483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
783c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	memset(ctrl,0,sizeof(*ctrl));
784c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	ctrl->id=id;
785483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
786c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_QUERYCTRL, ctrl);
787483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
788c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!ctrl->type)
789c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
790483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
791c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
792c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
793483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
794c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_ctrl (struct file *file, void *priv,
795c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_control *ctrl)
796c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
797c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
798c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
799c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
800c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_G_CTRL, ctrl);
801483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
802c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
803c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
804c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
805c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_ctrl (struct file *file, void *priv,
806c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_control *ctrl)
807c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
808c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
809c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
810c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
811c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_S_CTRL, ctrl);
812c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
813c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
814c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
815c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
816c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_reqbufs (struct file *file,
817c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			   void *priv, struct v4l2_requestbuffers *vr)
818c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
819c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
820c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
821c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
822c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int ret;
823c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
824c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	RESTRICT_TO_RANGE(vr->count,1,USBVISION_NUMFRAMES);
825c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
826c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Check input validity:
827c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   the user must do a VIDEO CAPTURE and MMAP method. */
828c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if((vr->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) ||
829c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   (vr->memory != V4L2_MEMORY_MMAP))
830c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
831c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
832c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->streaming == Stream_On) {
833c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if ((ret = usbvision_stream_interrupt(usbvision)))
834c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return ret;
835483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
836c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
837c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_frames_free(usbvision);
838c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_empty_framequeues(usbvision);
839c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vr->count = usbvision_frames_alloc(usbvision,vr->count);
840c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
841c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->curFrame = NULL;
842c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
843483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
844483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
845483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
846c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_querybuf (struct file *file,
847c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			    void *priv, struct v4l2_buffer *vb)
848483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
849c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
850c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
851c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
852c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usbvision_frame *frame;
853c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
854c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* FIXME : must control
855c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   that buffers are mapped (VIDIOC_REQBUFS has been called) */
856c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
857c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
858c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
859c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->index>=usbvision->num_frames)  {
860c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
861c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
862c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Updating the corresponding frame state */
863c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->flags = 0;
864c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame = &usbvision->frame[vb->index];
865c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(frame->grabstate >= FrameState_Ready)
866c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vb->flags |= V4L2_BUF_FLAG_QUEUED;
867c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(frame->grabstate >= FrameState_Done)
868c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vb->flags |= V4L2_BUF_FLAG_DONE;
869c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(frame->grabstate == FrameState_Unused)
870c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vb->flags |= V4L2_BUF_FLAG_MAPPED;
871c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->memory = V4L2_MEMORY_MMAP;
872c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
873c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->m.offset = vb->index*PAGE_ALIGN(usbvision->max_frame_size);
874c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
875c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->memory = V4L2_MEMORY_MMAP;
876c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->field = V4L2_FIELD_NONE;
877c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->length = usbvision->curwidth*
878c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->curheight*
879c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->palette.bytes_per_pixel;
880c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->timestamp = usbvision->frame[vb->index].timestamp;
881c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->sequence = usbvision->frame[vb->index].sequence;
882c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
883483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
884483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
885c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_qbuf (struct file *file, void *priv, struct v4l2_buffer *vb)
886c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
887c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
888c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
889c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
890c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usbvision_frame *frame;
891c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	unsigned long lock_flags;
892c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
893c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* FIXME : works only on VIDEO_CAPTURE MODE, MMAP. */
894c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
895c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
896c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
897c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->index>=usbvision->num_frames)  {
898c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
899c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
900c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
901c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame = &usbvision->frame[vb->index];
902c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
903c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (frame->grabstate != FrameState_Unused) {
904c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EAGAIN;
905c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
906c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
907c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Mark it as ready and enqueue frame */
908c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->grabstate = FrameState_Ready;
909c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->scanstate = ScanState_Scanning;
910c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->scanlength = 0;	/* Accumulated in usbvision_parse_data() */
911c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
912c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->flags &= ~V4L2_BUF_FLAG_DONE;
913c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
914c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* set v4l2_format index */
915c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->v4l2_format = usbvision->palette;
916c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
917c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
918c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	list_add_tail(&usbvision->frame[vb->index].frame, &usbvision->inqueue);
919c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
920c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
921c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
922c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
923c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
924c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_dqbuf (struct file *file, void *priv, struct v4l2_buffer *vb)
925c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
926c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
927c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
928c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
929c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int ret;
930c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usbvision_frame *f;
931c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	unsigned long lock_flags;
932c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
933c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (vb->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
934c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
935c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
936c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (list_empty(&(usbvision->outqueue))) {
937c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision->streaming == Stream_Idle)
938c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return -EINVAL;
939c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		ret = wait_event_interruptible
940c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			(usbvision->wait_frame,
941c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			 !list_empty(&(usbvision->outqueue)));
942c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (ret)
943c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return ret;
944c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
945c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
946c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
947c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	f = list_entry(usbvision->outqueue.next,
948c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       struct usbvision_frame, frame);
949c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	list_del(usbvision->outqueue.next);
950c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
951c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
952c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	f->grabstate = FrameState_Unused;
953c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
954c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->memory = V4L2_MEMORY_MMAP;
955c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->flags = V4L2_BUF_FLAG_MAPPED |
956c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_BUF_FLAG_QUEUED |
957c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_BUF_FLAG_DONE;
958c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->index = f->index;
959c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->sequence = f->sequence;
960c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->timestamp = f->timestamp;
961c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->field = V4L2_FIELD_NONE;
962c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->bytesused = f->scanlength;
963c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
964c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
965c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
966c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
967c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
968c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
969c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
970c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
971c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
972c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
973c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
974c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->streaming = Stream_On;
975c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision,VIDIOC_STREAMON , &b);
976c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
977c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
978c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
979c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
980c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_streamoff(struct file *file,
981c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			    void *priv, enum v4l2_buf_type type)
982c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
983c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
984c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
985c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
986c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
987c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
988c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
989c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
990c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
991c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->streaming == Stream_On) {
992c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision_stream_interrupt(usbvision);
993c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* Stop all video streamings */
994c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		call_i2c_clients(usbvision,VIDIOC_STREAMOFF , &b);
995c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
996c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_empty_framequeues(usbvision);
997c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
998c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
999c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1000c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1001c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_enum_fmt_cap (struct file *file, void  *priv,
1002c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					struct v4l2_fmtdesc *vfd)
1003c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1004c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vfd->index>=USBVISION_SUPPORTED_PALETTES-1) {
1005c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
1006c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1007c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vfd->flags = 0;
1008c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vfd->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1009c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strcpy(vfd->description,usbvision_v4l2_format[vfd->index].desc);
1010c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vfd->pixelformat = usbvision_v4l2_format[vfd->index].format;
1011c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	memset(vfd->reserved, 0, sizeof(vfd->reserved));
1012c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1013c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1014c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1015c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_fmt_cap (struct file *file, void *priv,
1016c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					struct v4l2_format *vf)
1017c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1018c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
1019c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1020c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1021c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.width = usbvision->curwidth;
1022c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.height = usbvision->curheight;
1023c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.pixelformat = usbvision->palette.format;
1024c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.bytesperline =
1025c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->curwidth*usbvision->palette.bytes_per_pixel;
1026c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*usbvision->curheight;
1027c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
1028c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.field = V4L2_FIELD_NONE; /* Always progressive image */
1029c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1030c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1031c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1032c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1033c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_try_fmt_cap (struct file *file, void *priv,
1034c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			       struct v4l2_format *vf)
1035c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1036c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
1037c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1038c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1039c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int formatIdx;
1040c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1041c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Find requested format in available ones */
1042c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	for(formatIdx=0;formatIdx<USBVISION_SUPPORTED_PALETTES;formatIdx++) {
1043c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if(vf->fmt.pix.pixelformat ==
1044c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		   usbvision_v4l2_format[formatIdx].format) {
1045c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			usbvision->palette = usbvision_v4l2_format[formatIdx];
1046c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			break;
1047c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		}
1048c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1049c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* robustness */
1050c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(formatIdx == USBVISION_SUPPORTED_PALETTES) {
1051c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
1052c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1053c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	RESTRICT_TO_RANGE(vf->fmt.pix.width, MIN_FRAME_WIDTH, MAX_FRAME_WIDTH);
1054c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	RESTRICT_TO_RANGE(vf->fmt.pix.height, MIN_FRAME_HEIGHT, MAX_FRAME_HEIGHT);
1055c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1056c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.bytesperline = vf->fmt.pix.width*
1057c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->palette.bytes_per_pixel;
1058c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*vf->fmt.pix.height;
1059c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1060c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1061c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1062c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1063c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_fmt_cap(struct file *file, void *priv,
1064c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			       struct v4l2_format *vf)
1065c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1066c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
1067c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1068c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1069c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int ret;
1070c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1071c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if( 0 != (ret=vidioc_try_fmt_cap (file, priv, vf)) ) {
1072c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return ret;
1073c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1074c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1075c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* stop io in case it is already in progress */
1076c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->streaming == Stream_On) {
1077c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if ((ret = usbvision_stream_interrupt(usbvision)))
1078c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return ret;
1079c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1080c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_frames_free(usbvision);
1081c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_empty_framequeues(usbvision);
1082c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1083c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->curFrame = NULL;
1084c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1085c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* by now we are committed to the new data... */
1086289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1087c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_set_output(usbvision, vf->fmt.pix.width, vf->fmt.pix.height);
1088289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1089c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1090c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1091c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1092483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
10938a5ab4157b3933d4fa29a1612879ab08f681041aAl Virostatic ssize_t usbvision_v4l2_read(struct file *file, char __user *buf,
1094483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		      size_t count, loff_t *ppos)
1095483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1096483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1097c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1098c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1099483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int noblock = file->f_flags & O_NONBLOCK;
1100483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	unsigned long lock_flags;
1101483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1102483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int ret,i;
1103483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usbvision_frame *frame;
1104483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1105c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	PDEBUG(DBG_IO, "%s: %ld bytes, noblock=%d", __FUNCTION__,
1106c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       (unsigned long)count, noblock);
1107483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1108483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!USBVISION_IS_OPERATIONAL(usbvision) || (buf == NULL))
1109483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EFAULT;
1110483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1111c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* This entry point is compatible with the mmap routines
1112c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   so that a user can do either VIDIOC_QBUF/VIDIOC_DQBUF
1113c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   to get frames or call read on the device. */
11146f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	if(!usbvision->num_frames) {
1115c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* First, allocate some frames to work with
1116c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		   if this has not been done with VIDIOC_REQBUF */
11176f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision_frames_free(usbvision);
11186f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision_empty_framequeues(usbvision);
11196f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision_frames_alloc(usbvision,USBVISION_NUMFRAMES);
11206f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	}
11216f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE
11226f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	if(usbvision->streaming != Stream_On) {
11236f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		/* no stream is running, make it running ! */
11246f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision->streaming = Stream_On;
11256f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		call_i2c_clients(usbvision,VIDIOC_STREAMON , NULL);
11266f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	}
1127483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1128c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Then, enqueue as many frames as possible
1129c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   (like a user of VIDIOC_QBUF would do) */
11306f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	for(i=0;i<usbvision->num_frames;i++) {
1131483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		frame = &usbvision->frame[i];
1132483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if(frame->grabstate == FrameState_Unused) {
1133483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			/* Mark it as ready and enqueue frame */
1134483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			frame->grabstate = FrameState_Ready;
1135483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			frame->scanstate = ScanState_Scanning;
1136c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			/* Accumulated in usbvision_parse_data() */
1137c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			frame->scanlength = 0;
1138483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1139483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			/* set v4l2_format index */
1140483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			frame->v4l2_format = usbvision->palette;
1141483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1142483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
1143483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			list_add_tail(&frame->frame, &usbvision->inqueue);
1144c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			spin_unlock_irqrestore(&usbvision->queue_lock,
1145c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					       lock_flags);
1146483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1147483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1148483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1149483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* Then try to steal a frame (like a VIDIOC_DQBUF would do) */
1150483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (list_empty(&(usbvision->outqueue))) {
1151483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if(noblock)
1152483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			return -EAGAIN;
1153483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1154483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		ret = wait_event_interruptible
1155483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			(usbvision->wait_frame,
1156483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			 !list_empty(&(usbvision->outqueue)));
1157483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (ret)
1158483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			return ret;
1159483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1160483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1161483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
1162483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	frame = list_entry(usbvision->outqueue.next,
1163483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			   struct usbvision_frame, frame);
1164483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	list_del(usbvision->outqueue.next);
1165483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
1166483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1167483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* An error returns an empty frame */
1168483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (frame->grabstate == FrameState_Error) {
1169483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		frame->bytes_read = 0;
1170483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return 0;
1171483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1172483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1173c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	PDEBUG(DBG_IO, "%s: frmx=%d, bytes_read=%ld, scanlength=%ld",
1174c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       __FUNCTION__,
1175c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       frame->index, frame->bytes_read, frame->scanlength);
1176483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1177483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* copy bytes to user space; we allow for partials reads */
1178483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if ((count + frame->bytes_read) > (unsigned long)frame->scanlength)
1179483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		count = frame->scanlength - frame->bytes_read;
1180483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1181483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (copy_to_user(buf, frame->data + frame->bytes_read, count)) {
1182483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EFAULT;
1183483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1184483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1185483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	frame->bytes_read += count;
1186c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	PDEBUG(DBG_IO, "%s: {copy} count used=%ld, new bytes_read=%ld",
1187c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       __FUNCTION__,
1188c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       (unsigned long)count, frame->bytes_read);
1189483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1190c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* For now, forget the frame if it has not been read in one shot. */
1191483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/* 	if (frame->bytes_read >= frame->scanlength) {// All data has been read */
1192483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		frame->bytes_read = 0;
1193483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1194483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		/* Mark it as available to be used again. */
1195c430ca1e16b2b4b30f567806c73e270caea8db1dThierry MERLE		frame->grabstate = FrameState_Unused;
1196483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/* 	} */
1197483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1198483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return count;
1199483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1200483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1201483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_v4l2_mmap(struct file *file, struct vm_area_struct *vma)
1202483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1203483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	unsigned long size = vma->vm_end - vma->vm_start,
1204483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		start = vma->vm_start;
1205483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	void *pos;
1206483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	u32 i;
1207483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1208483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1209c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1210c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1211483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
12126f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	PDEBUG(DBG_MMAP, "mmap");
12136f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE
1214289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1215483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1216483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!USBVISION_IS_OPERATIONAL(usbvision)) {
1217289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke		mutex_unlock(&usbvision->lock);
1218483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EFAULT;
1219483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1220483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1221483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!(vma->vm_flags & VM_WRITE) ||
12226f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	    size != PAGE_ALIGN(usbvision->max_frame_size)) {
1223289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke		mutex_unlock(&usbvision->lock);
1224483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EINVAL;
1225483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1226483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
12276f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	for (i = 0; i < usbvision->num_frames; i++) {
1228c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (((PAGE_ALIGN(usbvision->max_frame_size)*i) >> PAGE_SHIFT) ==
1229c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    vma->vm_pgoff)
1230483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			break;
1231483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
12326f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	if (i == usbvision->num_frames) {
1233c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_MMAP,
1234c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       "mmap: user supplied mapping address is out of range");
1235289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke		mutex_unlock(&usbvision->lock);
1236483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EINVAL;
1237483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1238483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1239483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* VM_IO is eventually going to replace PageReserved altogether */
1240483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vma->vm_flags |= VM_IO;
1241483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vma->vm_flags |= VM_RESERVED;	/* avoid to swap out this VMA */
1242483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1243483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	pos = usbvision->frame[i].data;
1244483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	while (size > 0) {
1245483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1246483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (vm_insert_page(vma, start, vmalloc_to_page(pos))) {
1247c876a3468d0f136710af81595177889953d1ff71Thierry MERLE			PDEBUG(DBG_MMAP, "mmap: vm_insert_page failed");
1248289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke			mutex_unlock(&usbvision->lock);
1249483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			return -EAGAIN;
1250483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1251483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		start += PAGE_SIZE;
1252483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		pos += PAGE_SIZE;
1253483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		size -= PAGE_SIZE;
1254483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1255483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1256289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1257483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
1258483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1259483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1260483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1261483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1262483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Here comes the stuff for radio on usbvision based devices
1263483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1264483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1265483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_radio_open(struct inode *inode, struct file *file)
1266483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1267483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1268c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1269c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1270483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode = 0;
1271483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1272483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "%s:", __FUNCTION__);
1273483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1274289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1275483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1276483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->user) {
1277483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: Someone tried to open an already opened USBVision Radio!", __FUNCTION__);
1278483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		errCode = -EBUSY;
1279483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1280483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	else {
1281483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if(PowerOnAtOpen) {
1282483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_reset_powerOffTimer(usbvision);
1283483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			if (usbvision->power == 0) {
1284483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision_power_on(usbvision);
12851ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE				usbvision_i2c_register(usbvision);
1286483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			}
1287483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1288483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
12892a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		/* Alternate interface 1 is is the biggest frame size */
12902a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		errCode = usbvision_set_alternate(usbvision);
12912a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		if (errCode < 0) {
12922a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE			usbvision->last_error = errCode;
1293544e6175330c86ad87abeeb1b048f56bafd96c31Andrew Morton			errCode = -EBUSY;
1294544e6175330c86ad87abeeb1b048f56bafd96c31Andrew Morton			goto out;
12952a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		}
12962a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1297483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		// If so far no errors then we shall start the radio
1298483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->radio = 1;
1299483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		call_i2c_clients(usbvision,AUDC_SET_RADIO,&usbvision->tuner_type);
1300483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_set_audio(usbvision, USBVISION_AUDIO_RADIO);
1301483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->user++;
1302483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1303483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1304483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (errCode) {
1305483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (PowerOnAtOpen) {
13061ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE			usbvision_i2c_unregister(usbvision);
1307483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_power_off(usbvision);
1308483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision->initialized = 0;
1309483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1310483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1311544e6175330c86ad87abeeb1b048f56bafd96c31Andrew Mortonout:
1312289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1313483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
1314483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1315483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1316483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1317483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_radio_close(struct inode *inode, struct file *file)
1318483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1319483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1320c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1321c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1322483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode = 0;
1323483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1324483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "");
1325483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1326289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1327483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
13282a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	/* Set packet size to 0 */
13292a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->ifaceAlt=0;
13302a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	errCode = usb_set_interface(usbvision->dev, usbvision->iface,
13312a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE				    usbvision->ifaceAlt);
13322a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1333483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_audio_off(usbvision);
1334483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->radio=0;
1335483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->user--;
1336483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1337483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (PowerOnAtOpen) {
1338483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_set_powerOffTimer(usbvision);
1339483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->initialized = 0;
1340483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1341483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1342289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1343483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1344483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->remove_pending) {
1345de6a1b8edc48155249896f2600398e139f4860c6Dwaine Garden		printk(KERN_INFO "%s: Final disconnect\n", __FUNCTION__);
1346483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_release(usbvision);
1347483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1348483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1349483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1350483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "success");
1351483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1352483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
1353483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1354483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1355483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1356483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Here comes the stuff for vbi on usbvision based devices
1357483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1358483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1359483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_vbi_open(struct inode *inode, struct file *file)
1360483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1361483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* TODO */
1362c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return -ENODEV;
1363483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1364483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1365483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1366483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_vbi_close(struct inode *inode, struct file *file)
1367483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1368483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* TODO */
1369c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return -ENODEV;
1370483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1371483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1372483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_do_vbi_ioctl(struct inode *inode, struct file *file,
1373483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				 unsigned int cmd, void *arg)
1374483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1375483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* TODO */
1376c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return -ENOIOCTLCMD;
1377483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1378483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1379483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_vbi_ioctl(struct inode *inode, struct file *file,
1380483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		       unsigned int cmd, unsigned long arg)
1381483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1382483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return video_usercopy(inode, file, cmd, arg, usbvision_do_vbi_ioctl);
1383483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1384483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1385483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1386483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//
1387483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Video registration stuff
1388483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//
1389483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1390483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Video template
1391fa027c2a0a0d6d1df6b29ee99048502c93da0dd4Arjan van de Venstatic const struct file_operations usbvision_fops = {
1392483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1393483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.open		= usbvision_v4l2_open,
1394483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= usbvision_v4l2_close,
1395483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.read		= usbvision_v4l2_read,
1396483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.mmap		= usbvision_v4l2_mmap,
1397c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.ioctl		= video_ioctl2,
1398483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.llseek		= no_llseek,
1399c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* 	.poll          = video_poll, */
1400c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.compat_ioctl  = v4l_compat_ioctl32,
1401483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1402483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device usbvision_video_template = {
1403483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1404483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.type		= VID_TYPE_TUNER | VID_TYPE_CAPTURE,
1405483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.fops		= &usbvision_fops,
1406483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name           = "usbvision-video",
1407483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= video_device_release,
1408483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.minor		= -1,
1409c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_querycap      = vidioc_querycap,
1410c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_enum_fmt_cap  = vidioc_enum_fmt_cap,
1411c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_fmt_cap     = vidioc_g_fmt_cap,
1412c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_try_fmt_cap   = vidioc_try_fmt_cap,
1413c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_fmt_cap     = vidioc_s_fmt_cap,
1414c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_reqbufs       = vidioc_reqbufs,
1415c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_querybuf      = vidioc_querybuf,
1416c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_qbuf          = vidioc_qbuf,
1417c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_dqbuf         = vidioc_dqbuf,
1418c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_std         = vidioc_s_std,
1419c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_enum_input    = vidioc_enum_input,
1420c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_input       = vidioc_g_input,
1421c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_input       = vidioc_s_input,
1422c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_queryctrl     = vidioc_queryctrl,
1423c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_audio       = vidioc_g_audio,
1424ed4d6375a1498009a9e68d93661207351d36874fAl Viro	.vidioc_s_audio       = vidioc_s_audio,
1425c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_ctrl        = vidioc_g_ctrl,
1426c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_ctrl        = vidioc_s_ctrl,
1427c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_streamon      = vidioc_streamon,
1428c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_streamoff     = vidioc_streamoff,
1429c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#ifdef CONFIG_VIDEO_V4L1_COMPAT
1430c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*  	.vidiocgmbuf          = vidiocgmbuf, */
1431c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#endif
1432c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_tuner       = vidioc_g_tuner,
1433c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_tuner       = vidioc_s_tuner,
1434c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_frequency   = vidioc_g_frequency,
1435c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_frequency   = vidioc_s_frequency,
1436c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#ifdef CONFIG_VIDEO_ADV_DEBUG
1437c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_register    = vidioc_g_register,
1438c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_register    = vidioc_s_register,
1439c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#endif
1440c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.tvnorms              = USBVISION_NORMS,
1441c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.current_norm         = V4L2_STD_PAL
1442483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1443483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1444483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1445483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Radio template
1446fa027c2a0a0d6d1df6b29ee99048502c93da0dd4Arjan van de Venstatic const struct file_operations usbvision_radio_fops = {
1447483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1448483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.open		= usbvision_radio_open,
1449483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= usbvision_radio_close,
1450c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.ioctl		= video_ioctl2,
1451483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.llseek		= no_llseek,
1452c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.compat_ioctl  = v4l_compat_ioctl32,
1453483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1454483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1455483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device usbvision_radio_template=
1456483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1457483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1458483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.type		= VID_TYPE_TUNER,
1459483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.fops		= &usbvision_radio_fops,
1460483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name           = "usbvision-radio",
1461c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.release	= video_device_release,
1462483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.minor		= -1,
1463c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_querycap      = vidioc_querycap,
1464c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_enum_input    = vidioc_enum_input,
1465c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_input       = vidioc_g_input,
1466c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_input       = vidioc_s_input,
1467c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_queryctrl     = vidioc_queryctrl,
1468c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_audio       = vidioc_g_audio,
1469ed4d6375a1498009a9e68d93661207351d36874fAl Viro	.vidioc_s_audio       = vidioc_s_audio,
1470c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_ctrl        = vidioc_g_ctrl,
1471c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_ctrl        = vidioc_s_ctrl,
1472c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_tuner       = vidioc_g_tuner,
1473c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_tuner       = vidioc_s_tuner,
1474c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_frequency   = vidioc_g_frequency,
1475c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_frequency   = vidioc_s_frequency,
1476c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1477c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.tvnorms              = USBVISION_NORMS,
1478c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.current_norm         = V4L2_STD_PAL
1479483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1480483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1481483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// vbi template
1482fa027c2a0a0d6d1df6b29ee99048502c93da0dd4Arjan van de Venstatic const struct file_operations usbvision_vbi_fops = {
1483483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1484483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.open		= usbvision_vbi_open,
1485483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= usbvision_vbi_close,
1486483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.ioctl		= usbvision_vbi_ioctl,
1487483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.llseek		= no_llseek,
1488c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.compat_ioctl  = v4l_compat_ioctl32,
1489483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1490483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1491483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device usbvision_vbi_template=
1492483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1493483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1494483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.type		= VID_TYPE_TUNER,
1495483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.fops		= &usbvision_vbi_fops,
1496483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= video_device_release,
1497483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name           = "usbvision-vbi",
1498483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.minor		= -1,
1499483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1500483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1501483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1502483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device *usbvision_vdev_init(struct usb_usbvision *usbvision,
1503483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE					struct video_device *vdev_template,
1504483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE					char *name)
1505483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1506483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_device *usb_dev = usbvision->dev;
1507483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *vdev;
1508483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1509483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usb_dev == NULL) {
1510483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: usbvision->dev is not set", __FUNCTION__);
1511483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return NULL;
1512483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1513483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1514483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vdev = video_device_alloc();
1515483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (NULL == vdev) {
1516483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return NULL;
1517483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1518483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	*vdev = *vdev_template;
1519483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//	vdev->minor   = -1;
1520483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vdev->dev     = &usb_dev->dev;
1521483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	snprintf(vdev->name, sizeof(vdev->name), "%s", name);
1522483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	video_set_drvdata(vdev, usbvision);
1523483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return vdev;
1524483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1525483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1526483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// unregister video4linux devices
1527483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_unregister_video(struct usb_usbvision *usbvision)
1528483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1529483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// vbi Device:
1530483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->vbi) {
1531c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_PROBE, "unregister /dev/vbi%d [v4l2]",
1532c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->vbi->minor & 0x1f);
1533483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->vbi->minor != -1) {
1534483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_unregister_device(usbvision->vbi);
1535c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
1536483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_device_release(usbvision->vbi);
1537483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1538483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->vbi = NULL;
1539483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1540483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1541483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Radio Device:
1542483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->rdev) {
1543c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_PROBE, "unregister /dev/radio%d [v4l2]",
1544c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->rdev->minor & 0x1f);
1545483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->rdev->minor != -1) {
1546483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_unregister_device(usbvision->rdev);
1547c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
1548483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_device_release(usbvision->rdev);
1549483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1550483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->rdev = NULL;
1551483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1552483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1553483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Video Device:
1554483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->vdev) {
1555c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_PROBE, "unregister /dev/video%d [v4l2]",
1556c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->vdev->minor & 0x1f);
1557483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->vdev->minor != -1) {
1558483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_unregister_device(usbvision->vdev);
1559c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
1560483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_device_release(usbvision->vdev);
1561483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1562483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->vdev = NULL;
1563483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1564483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1565483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1566483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// register video4linux devices
1567483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int __devinit usbvision_register_video(struct usb_usbvision *usbvision)
1568483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1569483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Video Device:
1570c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->vdev = usbvision_vdev_init(usbvision,
1571c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					      &usbvision_video_template,
1572c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					      "USBVision Video");
1573483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->vdev == NULL) {
1574483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1575483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1576c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (video_register_device(usbvision->vdev,
1577c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				  VFL_TYPE_GRABBER,
1578c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				  video_nr)<0) {
1579483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1580483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1581c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	printk(KERN_INFO "USBVision[%d]: registered USBVision Video device /dev/video%d [v4l2]\n",
1582c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       usbvision->nr,usbvision->vdev->minor & 0x1f);
1583483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1584483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Radio Device:
1585483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision_device_data[usbvision->DevModel].Radio) {
1586483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		// usbvision has radio
1587c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->rdev = usbvision_vdev_init(usbvision,
1588c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						      &usbvision_radio_template,
1589c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						      "USBVision Radio");
1590483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->rdev == NULL) {
1591483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1592483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1593c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (video_register_device(usbvision->rdev,
1594c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  VFL_TYPE_RADIO,
1595c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  radio_nr)<0) {
1596483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1597483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1598c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		printk(KERN_INFO "USBVision[%d]: registered USBVision Radio device /dev/radio%d [v4l2]\n",
1599c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->nr, usbvision->rdev->minor & 0x1f);
1600483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1601483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// vbi Device:
1602483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision_device_data[usbvision->DevModel].vbi) {
1603c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->vbi = usbvision_vdev_init(usbvision,
1604c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						     &usbvision_vbi_template,
1605c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						     "USBVision VBI");
1606483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->vdev == NULL) {
1607483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1608483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1609c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (video_register_device(usbvision->vbi,
1610c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  VFL_TYPE_VBI,
1611c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  vbi_nr)<0) {
1612483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1613483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1614c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		printk(KERN_INFO "USBVision[%d]: registered USBVision VBI device /dev/vbi%d [v4l2] (Not Working Yet!)\n",
1615c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->nr,usbvision->vbi->minor & 0x1f);
1616483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1617483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// all done
1618483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
1619483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1620483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE err_exit:
1621483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	err("USBVision[%d]: video_register_device() failed", usbvision->nr);
1622483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_unregister_video(usbvision);
1623483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return -1;
1624483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1625483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1626483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1627483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_alloc()
1628483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1629c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE * This code allocates the struct usb_usbvision.
1630c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE * It is filled with default values.
1631483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1632483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Returns NULL on error, a pointer to usb_usbvision else.
1633483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1634483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1635483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct usb_usbvision *usbvision_alloc(struct usb_device *dev)
1636483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1637483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision;
1638483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1639c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((usbvision = kzalloc(sizeof(struct usb_usbvision), GFP_KERNEL)) ==
1640c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	    NULL) {
1641483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1642483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1643483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1644483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->dev = dev;
1645483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1646289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_init(&usbvision->lock);	/* available */
1647483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1648483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// prepare control urb for control messages during interrupts
1649483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->ctrlUrb = usb_alloc_urb(USBVISION_URB_FRAMES, GFP_KERNEL);
1650483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->ctrlUrb == NULL) {
1651483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1652483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1653483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	init_waitqueue_head(&usbvision->ctrlUrb_wq);
1654483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1655483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_init_powerOffTimer(usbvision);
1656483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1657483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return usbvision;
1658483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1659483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEerr_exit:
1660483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision && usbvision->ctrlUrb) {
1661483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usb_free_urb(usbvision->ctrlUrb);
1662483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1663483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision) {
1664483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		kfree(usbvision);
1665483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1666483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return NULL;
1667483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1668483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1669483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1670483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_release()
1671483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1672483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This code does final release of struct usb_usbvision. This happens
1673483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * after the device is disconnected -and- all clients closed their files.
1674483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1675483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1676483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_release(struct usb_usbvision *usbvision)
1677483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1678483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "");
1679483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1680289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1681483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1682483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_reset_powerOffTimer(usbvision);
1683483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1684483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->initialized = 0;
1685483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1686289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1687483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1688483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_remove_sysfs(usbvision->vdev);
1689483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_unregister_video(usbvision);
1690483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1691483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->ctrlUrb) {
1692483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usb_free_urb(usbvision->ctrlUrb);
1693483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1694483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1695483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	kfree(usbvision);
1696483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1697483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "success");
1698483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1699483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1700483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1701c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*********************** usb interface **********************************/
1702483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1703483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_configure_video(struct usb_usbvision *usbvision)
1704483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1705c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int model;
1706483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1707483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision == NULL)
1708483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return;
1709483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1710483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	model = usbvision->DevModel;
1711483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->palette = usbvision_v4l2_format[2]; // V4L2_PIX_FMT_RGB24;
1712483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1713c682b3a7fb8ec69ac73511bbb6a378e40aa35f35Trent Piepho	if (usbvision_device_data[usbvision->DevModel].Vin_Reg2_override) {
1714c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->Vin_Reg2_Preset =
1715c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			usbvision_device_data[usbvision->DevModel].Vin_Reg2;
1716483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	} else {
1717483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->Vin_Reg2_Preset = 0;
1718483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1719483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1720c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->tvnormId = usbvision_device_data[model].VideoNorm;
1721483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1722483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->video_inputs = usbvision_device_data[model].VideoChannels;
1723483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->ctl_input = 0;
1724483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1725483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* This should be here to make i2c clients to be able to register */
1726c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* first switch off audio */
1727c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_audio_off(usbvision);
1728483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!PowerOnAtOpen) {
1729c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* and then power up the noisy tuner */
1730c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision_power_on(usbvision);
17311ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE		usbvision_i2c_register(usbvision);
1732483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1733483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1734483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1735483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1736483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_probe()
1737483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1738483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This procedure queries device descriptor and accepts the interface
1739483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * if it looks like USBVISION video device
1740483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1741483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1742659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehabstatic int __devinit usbvision_probe(struct usb_interface *intf,
1743659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				     const struct usb_device_id *devid)
1744483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
17452a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	struct usb_device *dev = usb_get_dev(interface_to_usbdev(intf));
17462a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	struct usb_interface *uif;
1747483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	__u8 ifnum = intf->altsetting->desc.bInterfaceNumber;
1748483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	const struct usb_host_interface *interface;
1749483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = NULL;
1750483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	const struct usb_endpoint_descriptor *endpoint;
17512a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	int model,i;
1752483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1753483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "VID=%#04x, PID=%#04x, ifnum=%u",
1754659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				dev->descriptor.idVendor,
1755659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				dev->descriptor.idProduct, ifnum);
17562a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1757659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab	model = devid->driver_info;
1758f8a389db502f7b287903b209f925df5570ff5478Mauro Carvalho Chehab	if ( (model<0) || (model>=usbvision_device_data_size) ) {
1759672d013bed5e144ac641db343251e35d3212c9adThierry MERLE		PDEBUG(DBG_PROBE, "model out of bounds %d",model);
1760f8a389db502f7b287903b209f925df5570ff5478Mauro Carvalho Chehab		return -ENODEV;
1761f8a389db502f7b287903b209f925df5570ff5478Mauro Carvalho Chehab	}
1762659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab	printk(KERN_INFO "%s: %s found\n", __FUNCTION__,
1763659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				usbvision_device_data[model].ModelString);
1764483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1765483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision_device_data[model].Interface >= 0) {
1766483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		interface = &dev->actconfig->interface[usbvision_device_data[model].Interface]->altsetting[0];
1767c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
1768483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		interface = &dev->actconfig->interface[ifnum]->altsetting[0];
1769483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1770483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	endpoint = &interface->endpoint[1].desc;
1771c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) !=
1772c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	    USB_ENDPOINT_XFER_ISOC) {
1773c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: interface %d. has non-ISO endpoint!",
1774c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, ifnum);
1775c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: Endpoint attributes %d",
1776c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, endpoint->bmAttributes);
1777483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -ENODEV;
1778483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1779c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
1780c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	    USB_DIR_OUT) {
1781c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: interface %d. has ISO OUT endpoint!",
1782c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, ifnum);
1783483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -ENODEV;
1784483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1785483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1786483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if ((usbvision = usbvision_alloc(dev)) == NULL) {
1787483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: couldn't allocate USBVision struct", __FUNCTION__);
1788483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -ENOMEM;
1789483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1790659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab
1791483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (dev->descriptor.bNumConfigurations > 1) {
1792483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->bridgeType = BRIDGE_NT1004;
1793c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else if (model == DAZZLE_DVC_90_REV_1_SECAM) {
1794483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->bridgeType = BRIDGE_NT1005;
1795c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
1796483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->bridgeType = BRIDGE_NT1003;
1797483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1798483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "bridgeType %d", usbvision->bridgeType);
1799483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1800289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1801483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
18022a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	/* compute alternate max packet sizes */
18032a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	uif = dev->actconfig->interface[0];
18042a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
18052a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->num_alt=uif->num_altsetting;
18062a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	PDEBUG(DBG_PROBE, "Alternate settings: %i",usbvision->num_alt);
18072a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->alt_max_pkt_size = kmalloc(32*
18082a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE					      usbvision->num_alt,GFP_KERNEL);
18092a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	if (usbvision->alt_max_pkt_size == NULL) {
18102a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		err("usbvision: out of memory!\n");
18110991112c1c4625323df8a582de1b2f8609922248Daniel Walker		mutex_unlock(&usbvision->lock);
18122a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		return -ENOMEM;
18132a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	}
18142a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
18152a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	for (i = 0; i < usbvision->num_alt ; i++) {
18162a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		u16 tmp = le16_to_cpu(uif->altsetting[i].endpoint[1].desc.
18172a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE				      wMaxPacketSize);
18182a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		usbvision->alt_max_pkt_size[i] =
18192a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE			(tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
18202a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		PDEBUG(DBG_PROBE, "Alternate setting %i, max size= %i",i,
18212a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		       usbvision->alt_max_pkt_size[i]);
18222a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	}
18232a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
18242a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1825483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->nr = usbvision_nr++;
1826483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1827483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->have_tuner = usbvision_device_data[model].Tuner;
1828483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->have_tuner) {
1829483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->tuner_type = usbvision_device_data[model].TunerType;
1830483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1831483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1832483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->tuner_addr = ADDR_UNSET;
1833483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1834483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->DevModel = model;
1835483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->remove_pending = 0;
1836483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->iface = ifnum;
18372a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->ifaceAlt = 0;
1838483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->video_endp = endpoint->bEndpointAddress;
1839483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->isocPacketSize = 0;
1840483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->usb_bandwidth = 0;
1841483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->user = 0;
1842483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->streaming = Stream_Off;
1843483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_register_video(usbvision);
1844483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_configure_video(usbvision);
1845289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1846483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1847483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1848483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usb_set_intfdata (intf, usbvision);
1849483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_create_sysfs(usbvision->vdev);
1850483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1851483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "success");
1852483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
1853483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1854483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1855483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1856483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1857483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_disconnect()
1858483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1859483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This procedure stops all driver activity, deallocates interface-private
1860483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * structure (pointed by 'ptr') and after that driver should be removable
1861483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * with no ill consequences.
1862483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1863483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1864483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void __devexit usbvision_disconnect(struct usb_interface *intf)
1865483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1866483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = usb_get_intfdata(intf);
1867483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1868483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "");
1869483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1870483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision == NULL) {
1871483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: usb_get_intfdata() failed", __FUNCTION__);
1872483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return;
1873483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1874483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usb_set_intfdata (intf, NULL);
1875483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1876289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_lock(&usbvision->lock);
1877483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1878483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// At this time we ask to cancel outstanding URBs
1879483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_stop_isoc(usbvision);
1880483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1881483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->power) {
18821ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE		usbvision_i2c_unregister(usbvision);
1883483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_power_off(usbvision);
1884483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1885483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->remove_pending = 1;	// Now all ISO data will be ignored
1886483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1887483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usb_put_dev(usbvision->dev);
1888483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->dev = NULL;	// USB device is no more
1889483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1890289d4d2f0746715ada41e0945116eb3d62d5f35cMatthias Kaehlcke	mutex_unlock(&usbvision->lock);
1891483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1892483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->user) {
1893c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		printk(KERN_INFO "%s: In use, disconnect pending\n",
1894c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       __FUNCTION__);
1895483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		wake_up_interruptible(&usbvision->wait_frame);
1896483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		wake_up_interruptible(&usbvision->wait_stream);
1897c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
1898483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_release(usbvision);
1899483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1900483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1901483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "success");
1902483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1903483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1904483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1905483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct usb_driver usbvision_driver = {
1906483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name		= "usbvision",
1907483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.id_table	= usbvision_table,
1908483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.probe		= usbvision_probe,
1909483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.disconnect	= usbvision_disconnect
1910483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1911483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1912483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1913483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_init()
1914483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1915483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This code is run to initialize the driver.
1916483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1917483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1918483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int __init usbvision_init(void)
1919483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1920483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode;
1921483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1922483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "");
1923483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1924483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO,  "IO      debugging is enabled [video]");
1925483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "PROBE   debugging is enabled [video]");
1926c876a3468d0f136710af81595177889953d1ff71Thierry MERLE	PDEBUG(DBG_MMAP, "MMAP    debugging is enabled [video]");
1927483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1928483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* disable planar mode support unless compression enabled */
1929483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (isocMode != ISOC_MODE_COMPRESS ) {
1930483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		// FIXME : not the right way to set supported flag
1931483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_v4l2_format[6].supported = 0; // V4L2_PIX_FMT_YVU420
1932483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_v4l2_format[7].supported = 0; // V4L2_PIX_FMT_YUV422P
1933483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1934483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1935483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	errCode = usb_register(&usbvision_driver);
1936483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1937483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (errCode == 0) {
1938de6a1b8edc48155249896f2600398e139f4860c6Dwaine Garden		printk(KERN_INFO DRIVER_DESC " : " USBVISION_VERSION_STRING "\n");
1939483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		PDEBUG(DBG_PROBE, "success");
1940483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1941483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
1942483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1943483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1944483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void __exit usbvision_exit(void)
1945483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1946483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE PDEBUG(DBG_PROBE, "");
1947483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1948483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE usb_deregister(&usbvision_driver);
1949483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE PDEBUG(DBG_PROBE, "success");
1950483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1951483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1952483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_init(usbvision_init);
1953483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_exit(usbvision_exit);
1954483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1955483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1956483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Overrides for Emacs so that we follow Linus's tabbing style.
1957483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * ---------------------------------------------------------------------------
1958483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Local variables:
1959483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * c-basic-offset: 8
1960483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * End:
1961483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1962