usbvision-video.c revision ed4d6375a1498009a9e68d93661207351d36874f
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/moduleparam.h>
72a1ed551cdb4f29157466340760fde68bcda704a9Mauro Carvalho Chehab#include <linux/workqueue.h>
73483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
74483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#ifdef CONFIG_KMOD
75483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include <linux/kmod.h>
76483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#endif
77483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
78483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#include "usbvision.h"
79659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab#include "usbvision-cards.h"
80483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
81c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#define DRIVER_AUTHOR "Joerg Heckenbach <joerg@heckenbach-aw.de>,\
82c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE Dwaine Garden <DwaineGarden@rogers.com>"
83483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_NAME "usbvision"
84483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_ALIAS "USBVision"
85483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_DESC "USBVision USB Video Device Driver for Linux"
86483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DRIVER_LICENSE "GPL"
87483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define USBVISION_DRIVER_VERSION_MAJOR 0
88483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define USBVISION_DRIVER_VERSION_MINOR 9
89483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define USBVISION_DRIVER_VERSION_PATCHLEVEL 9
90c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#define USBVISION_DRIVER_VERSION KERNEL_VERSION(USBVISION_DRIVER_VERSION_MAJOR,\
91c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEUSBVISION_DRIVER_VERSION_MINOR,\
92c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEUSBVISION_DRIVER_VERSION_PATCHLEVEL)
93c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#define USBVISION_VERSION_STRING __stringify(USBVISION_DRIVER_VERSION_MAJOR)\
94c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE "." __stringify(USBVISION_DRIVER_VERSION_MINOR)\
95c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE "." __stringify(USBVISION_DRIVER_VERSION_PATCHLEVEL)
96483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
97483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define	ENABLE_HEXDUMP	0	/* Enable if you need it */
98483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
99483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
100483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#ifdef USBVISION_DEBUG
101483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	#define PDEBUG(level, fmt, args...) \
102c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (video_debug & (level)) \
103c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ ,\
104c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				## args)
105483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#else
106483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	#define PDEBUG(level, fmt, args...) do {} while(0)
107483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#endif
108483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
109483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DBG_IO		1<<1
110483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define DBG_PROBE	1<<2
111c876a3468d0f136710af81595177889953d1ff71Thierry MERLE#define DBG_MMAP	1<<3
112483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
113483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//String operations
114483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define rmspace(str)	while(*str==' ') str++;
115483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define goto2next(str)	while(*str!=' ') str++; while(*str==' ') str++;
116483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
117483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
118c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* sequential number of usbvision device */
119c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int usbvision_nr = 0;
120483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
121483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct usbvision_v4l2_format_st usbvision_v4l2_format[] = {
122483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 1,  8, V4L2_PIX_FMT_GREY    , "GREY" },
123483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_RGB565  , "RGB565" },
124483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 3, 24, V4L2_PIX_FMT_RGB24   , "RGB24" },
125483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 4, 32, V4L2_PIX_FMT_RGB32   , "RGB32" },
126483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_RGB555  , "RGB555" },
127483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_YUYV    , "YUV422" },
128483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 12, V4L2_PIX_FMT_YVU420  , "YUV420P" }, // 1.5 !
129483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	{ 1, 2, 16, V4L2_PIX_FMT_YUV422P , "YUV422P" }
130483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
131483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
132c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Function prototypes */
133483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_release(struct usb_usbvision *usbvision);
134483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
135c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Default initalization of device driver parameters */
136c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Set the default format for ISOC endpoint */
137c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int isocMode = ISOC_MODE_COMPRESS;
138c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Set the default Debug Mode of the device driver */
139c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int video_debug = 0;
140c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Set the default device to power on at startup */
141c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int PowerOnAtOpen = 1;
142c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Sequential Number of Video Device */
143c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int video_nr = -1;
144c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Sequential Number of Radio Device */
145c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int radio_nr = -1;
146c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Sequential Number of VBI Device */
147c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vbi_nr = -1;
148c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
149c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Grab parameters for the device driver */
150c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
151c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Showing parameters under SYSFS */
152483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(isocMode, int, 0444);
153483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(video_debug, int, 0444);
154483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(PowerOnAtOpen, int, 0444);
155483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(video_nr, int, 0444);
156483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(radio_nr, int, 0444);
157483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_param(vbi_nr, int, 0444);
158483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
159483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(isocMode, " Set the default format for ISOC endpoint.  Default: 0x60 (Compression On)");
160483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(video_debug, " Set the default Debug Mode of the device driver.  Default: 0 (Off)");
161483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(PowerOnAtOpen, " Set the default device to power on when device is opened.  Default: 1 (On)");
162483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(video_nr, "Set video device number (/dev/videoX).  Default: -1 (autodetect)");
163483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(radio_nr, "Set radio device number (/dev/radioX).  Default: -1 (autodetect)");
164483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_PARM_DESC(vbi_nr, "Set vbi device number (/dev/vbiX).  Default: -1 (autodetect)");
165483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
166483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
167483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Misc stuff
168483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_AUTHOR(DRIVER_AUTHOR);
169483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_DESCRIPTION(DRIVER_DESC);
170483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEMODULE_LICENSE(DRIVER_LICENSE);
171a1ed551cdb4f29157466340760fde68bcda704a9Mauro Carvalho ChehabMODULE_VERSION(USBVISION_VERSION_STRING);
172a1ed551cdb4f29157466340760fde68bcda704a9Mauro Carvalho ChehabMODULE_ALIAS(DRIVER_ALIAS);
173483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
174483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
175c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*****************************************************************************/
176c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* SYSFS Code - Copied from the stv680.c usb module.			     */
177c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Device information is located at /sys/class/video4linux/video0            */
178c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Device parameters information is located at /sys/module/usbvision         */
179c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* Device USB Information is located at                                      */
180c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*   /sys/bus/usb/drivers/USBVision Video Grabber                            */
181c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*****************************************************************************/
182483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
183483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
184483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#define YES_NO(x) ((x) ? "Yes" : "No")
185483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
186483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic inline struct usb_usbvision *cd_to_usbvision(struct class_device *cd)
187483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
188c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
189c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
190483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return video_get_drvdata(vdev);
191483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
192483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
193483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic ssize_t show_version(struct class_device *cd, char *buf)
194483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
195483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return sprintf(buf, "%s\n", USBVISION_VERSION_STRING);
196483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
197483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(version, S_IRUGO, show_version, NULL);
198483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
199ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_model(struct class_device *cd, char *buf)
200483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
201c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
202c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
203483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
204c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return sprintf(buf, "%s\n",
205c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision_device_data[usbvision->DevModel].ModelString);
206483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
207483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(model, S_IRUGO, show_model, NULL);
208483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
209ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_hue(struct class_device *cd, char *buf)
210483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
211c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
212c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
213483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
214483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
215483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_HUE;
216483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
217ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
218ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2192a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
220483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
221483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(hue, S_IRUGO, show_hue, NULL);
222483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
223ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_contrast(struct class_device *cd, char *buf)
224483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
225c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
226c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
227483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
228483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
229483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_CONTRAST;
230483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
231ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
232ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2332a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
234483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
235483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(contrast, S_IRUGO, show_contrast, NULL);
236483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
237ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_brightness(struct class_device *cd, char *buf)
238483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
239c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
240c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
241483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
242483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
243483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_BRIGHTNESS;
244483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
245ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
246ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2472a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
248483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
249483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(brightness, S_IRUGO, show_brightness, NULL);
250483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
251ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_saturation(struct class_device *cd, char *buf)
252483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
253c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
254c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
255483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
256483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct v4l2_control ctrl;
257483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.id = V4L2_CID_SATURATION;
258483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	ctrl.value = 0;
259ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if(usbvision->user)
260ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
2612a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	return sprintf(buf, "%d\n", ctrl.value);
262483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
263483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(saturation, S_IRUGO, show_saturation, NULL);
264483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
265ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_streaming(struct class_device *cd, char *buf)
266483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
267c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
268c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
269483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
270c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return sprintf(buf, "%s\n",
271c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       YES_NO(usbvision->streaming==Stream_On?1:0));
272483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
273483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(streaming, S_IRUGO, show_streaming, NULL);
274483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
275ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_compression(struct class_device *cd, char *buf)
276483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
277c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
278c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
279483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
280c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return sprintf(buf, "%s\n",
281c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       YES_NO(usbvision->isocMode==ISOC_MODE_COMPRESS));
282483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
283483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(compression, S_IRUGO, show_compression, NULL);
284483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
285ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Gardenstatic ssize_t show_device_bridge(struct class_device *cd, char *buf)
286483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
287c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *vdev =
288c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		container_of(cd, struct video_device, class_dev);
289483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = video_get_drvdata(vdev);
290483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return sprintf(buf, "%d\n", usbvision->bridgeType);
291483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
292483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic CLASS_DEVICE_ATTR(bridge, S_IRUGO, show_device_bridge, NULL);
293483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
294483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_create_sysfs(struct video_device *vdev)
295483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
296483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int res;
297ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	if (!vdev)
298ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		return;
299ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	do {
300ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
301ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_version);
302ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
303ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
304ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
305ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_model);
306ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
307ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
308ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
309ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_hue);
310ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
311ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
312ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
313ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_contrast);
314ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
315ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
316ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
317ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_brightness);
318ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
319ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
320ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
321ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_saturation);
322ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
323ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
324ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
325ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_streaming);
326ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
327ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
328ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
329ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_compression);
330ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res<0)
331ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			break;
332ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		res=class_device_create_file(&vdev->class_dev,
333ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					     &class_device_attr_bridge);
334ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		if (res>=0)
335ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden			return;
336ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	} while (0);
337ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden
338ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden	err("%s error: %d\n", __FUNCTION__, res);
339483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
340483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
341483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_remove_sysfs(struct video_device *vdev)
342483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
343483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (vdev) {
344ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
345ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_version);
346ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
347ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_model);
348ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
349ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_hue);
350ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
351ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_contrast);
352ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
353ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_brightness);
354ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
355ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_saturation);
356ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
357ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_streaming);
358ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
359ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_compression);
360ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden		class_device_remove_file(&vdev->class_dev,
361ed00b41dc8bc286682d31ad64060ccc70513e90bDwaine Garden					 &class_device_attr_bridge);
362483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
363483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
364483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
365483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
366483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
367483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_open()
368483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
369483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This is part of Video 4 Linux API. The driver can be opened by one
370483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * client only (checks internal counter 'usbvision->user'). The procedure
371483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * then allocates buffers needed for video processing.
372483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
373483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
374483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_v4l2_open(struct inode *inode, struct file *file)
375483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
376483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
377c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
378c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
379483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode = 0;
380483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
381483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "open");
382483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
383483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
384483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_reset_powerOffTimer(usbvision);
385483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
386483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->user)
387483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		errCode = -EBUSY;
388483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	else {
3896f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		/* Allocate memory for the scratch ring buffer */
3906f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		errCode = usbvision_scratch_alloc(usbvision);
3916f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		if (isocMode==ISOC_MODE_COMPRESS) {
392c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			/* Allocate intermediate decompression buffers
393c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			   only if needed */
3946f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE			errCode = usbvision_decompress_alloc(usbvision);
395483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
396483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (errCode) {
397483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			/* Deallocate all buffers if trouble */
398483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_scratch_free(usbvision);
399483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_decompress_free(usbvision);
400483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
401483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
402483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
403483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* If so far no errors then we shall start the camera */
404483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!errCode) {
405483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		down(&usbvision->lock);
406483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->power == 0) {
407483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_power_on(usbvision);
4081ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE			usbvision_i2c_register(usbvision);
409483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
410483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
411483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		/* Send init sequence only once, it's large! */
412483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (!usbvision->initialized) {
413483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			int setup_ok = 0;
414483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			setup_ok = usbvision_setup(usbvision,isocMode);
415483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			if (setup_ok)
416483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision->initialized = 1;
417483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			else
418483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				errCode = -EBUSY;
419483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
420483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
421483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (!errCode) {
422483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_begin_streaming(usbvision);
423483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			errCode = usbvision_init_isoc(usbvision);
424c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			/* device must be initialized before isoc transfer */
425483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_muxsel(usbvision,0);
426483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision->user++;
427c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
428483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			if (PowerOnAtOpen) {
4291ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE				usbvision_i2c_unregister(usbvision);
430483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision_power_off(usbvision);
431483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision->initialized = 0;
432483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			}
433483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
434483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		up(&usbvision->lock);
435483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
436483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
437483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (errCode) {
438483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
439483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
440483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* prepare queues */
441483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_empty_framequeues(usbvision);
442483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
443483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "success");
444483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
445483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
446483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
447483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
448483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_v4l2_close()
449483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
450483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This is part of Video 4 Linux API. The procedure
451483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * stops streaming and deallocates all buffers that were earlier
452483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * allocated in usbvision_v4l2_open().
453483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
454483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
455483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_v4l2_close(struct inode *inode, struct file *file)
456483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
457483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
458c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
459c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
460483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
461483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "close");
462483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
463483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
464483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_audio_off(usbvision);
465483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_restart_isoc(usbvision);
466483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_stop_isoc(usbvision);
467483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
468483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_decompress_free(usbvision);
46938284ba361d69eca34a3bfc553ebfac81fea2698Thierry MERLE	usbvision_frames_free(usbvision);
4706f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	usbvision_empty_framequeues(usbvision);
471483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_scratch_free(usbvision);
472483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
473483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->user--;
474483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
475483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (PowerOnAtOpen) {
476c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* power off in a little while
477c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		   to avoid off/on every close/open short sequences */
478483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_set_powerOffTimer(usbvision);
479483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->initialized = 0;
480483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
481483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
482483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
483483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
484483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->remove_pending) {
485de6a1b8edc48155249896f2600398e139f4860c6Dwaine Garden		printk(KERN_INFO "%s: Final disconnect\n", __FUNCTION__);
486483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_release(usbvision);
487483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
488483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
489483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "success");
490483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
491483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
492483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
493483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
494483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
495483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
496483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
497483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_ioctl()
498483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
499483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This is part of Video 4 Linux API. The procedure handles ioctl() calls.
500483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
501483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
502c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#ifdef CONFIG_VIDEO_ADV_DEBUG
503c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_register (struct file *file, void *priv,
504c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_register *reg)
505483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
506483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
507c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
508c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
509c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int errCode;
510483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
511c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!v4l2_chip_match_host(reg->match_type, reg->match_chip))
512c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
513c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* NT100x has a 8-bit register space */
514c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	errCode = usbvision_read_reg(usbvision, reg->reg&0xff);
515c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (errCode < 0) {
516c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: VIDIOC_DBG_G_REGISTER failed: error %d",
517c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, errCode);
518c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return errCode;
519c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
520bc147135bc410bdd9da684646af75a188d882d56Trent Piepho	reg->val = errCode;
521c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
522c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
523483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
524c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_register (struct file *file, void *priv,
525c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_register *reg)
526c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
527c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
528c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
529c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
530c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int errCode;
53162d50addf0774115adaa9e01e09099c3d7daa13dTrent Piepho
532c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!v4l2_chip_match_host(reg->match_type, reg->match_chip))
533c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
534c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* NT100x has a 8-bit register space */
535bc147135bc410bdd9da684646af75a188d882d56Trent Piepho	errCode = usbvision_write_reg(usbvision, reg->reg&0xff, reg->val);
536bc147135bc410bdd9da684646af75a188d882d56Trent Piepho	if (errCode < 0) {
537c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: VIDIOC_DBG_S_REGISTER failed: error %d",
538c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, errCode);
539c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return errCode;
540c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
541c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
542c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
543483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE#endif
544c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
545c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_querycap (struct file *file, void  *priv,
546c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					struct v4l2_capability *vc)
547c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
548c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
549c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
550c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
551c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
552c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strlcpy(vc->driver, "USBVision", sizeof(vc->driver));
553c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strlcpy(vc->card,
554c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision_device_data[usbvision->DevModel].ModelString,
555c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		sizeof(vc->card));
556c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strlcpy(vc->bus_info, usbvision->dev->dev.bus_id,
557c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		sizeof(vc->bus_info));
558c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vc->version = USBVISION_DRIVER_VERSION;
559c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vc->capabilities = V4L2_CAP_VIDEO_CAPTURE |
560c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_CAP_AUDIO |
561c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_CAP_READWRITE |
562c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_CAP_STREAMING |
563c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(usbvision->have_tuner ? V4L2_CAP_TUNER : 0);
564c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
565c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
566c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
567c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_enum_input (struct file *file, void *priv,
568c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_input *vi)
569c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
570c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
571c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
572c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
573c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int chan;
574c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
575c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((vi->index >= usbvision->video_inputs) || (vi->index < 0) )
576c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
577c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (usbvision->have_tuner) {
578c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		chan = vi->index;
579c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
580c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		chan = vi->index + 1; /*skip Television string*/
581c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
582c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Determine the requested input characteristics
583c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   specific for each usbvision card model */
584c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	switch(chan) {
585c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 0:
586c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
587c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "White Video Input");
588c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
589c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Television");
590c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->type = V4L2_INPUT_TYPE_TUNER;
591c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->audioset = 1;
592c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->tuner = chan;
593c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			vi->std = USBVISION_NORMS;
594483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
595c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
596c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 1:
597c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->type = V4L2_INPUT_TYPE_CAMERA;
598c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
599c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Green Video Input");
600c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
601c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Composite Video Input");
602483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
603c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->std = V4L2_STD_PAL;
604c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
605c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 2:
606c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->type = V4L2_INPUT_TYPE_CAMERA;
607c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
608c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "Yellow Video Input");
609c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
610c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			strcpy(vi->name, "S-Video Input");
611483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
612c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->std = V4L2_STD_PAL;
613c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
614c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	case 3:
615c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->type = V4L2_INPUT_TYPE_CAMERA;
616c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(vi->name, "Red Video Input");
617c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vi->std = V4L2_STD_PAL;
618c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		break;
619c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
620c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
621c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
622483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
623c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_input (struct file *file, void *priv, unsigned int *input)
624c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
625c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
626c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
627c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
628483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
629c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	*input = usbvision->ctl_input;
630c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
631c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
632483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
633c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_input (struct file *file, void *priv, unsigned int input)
634c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
635c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
636c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
637c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
638483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
639c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((input >= usbvision->video_inputs) || (input < 0) )
640c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
641483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
642c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	down(&usbvision->lock);
64366a17879e9f18a38c4ca5e6ba600a3f5b1b51188Thierry MERLE	usbvision_muxsel(usbvision, input);
644c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_set_input(usbvision);
645c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_set_output(usbvision,
646c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			     usbvision->curwidth,
647c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			     usbvision->curheight);
648c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	up(&usbvision->lock);
649c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
650c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
651483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
652c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_std (struct file *file, void *priv, v4l2_std_id *id)
653c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
654c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
655c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
656c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
657c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->tvnormId=*id;
658483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
659c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	down(&usbvision->lock);
660c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_S_STD,
661c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			 &usbvision->tvnormId);
662c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	up(&usbvision->lock);
66366a17879e9f18a38c4ca5e6ba600a3f5b1b51188Thierry MERLE	/* propagate the change to the decoder */
66466a17879e9f18a38c4ca5e6ba600a3f5b1b51188Thierry MERLE	usbvision_muxsel(usbvision, usbvision->ctl_input);
665483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
666c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
667c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
668483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
669c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_tuner (struct file *file, void *priv,
670c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_tuner *vt)
671c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
672c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
673c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
674c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
675483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
676c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!usbvision->have_tuner || vt->index)	// Only tuner 0
677c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
678c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->radio) {
679c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(vt->name, "Radio");
680c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vt->type = V4L2_TUNER_RADIO;
681c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
682c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(vt->name, "Television");
683c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
684c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Let clients fill in the remainder of this struct */
685c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision,VIDIOC_G_TUNER,vt);
686483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
687c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
688c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
689483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
690c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_tuner (struct file *file, void *priv,
691c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_tuner *vt)
692c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
693c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
694c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
695c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
696483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
697c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	// Only no or one tuner for now
698c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!usbvision->have_tuner || vt->index)
699c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
700c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* let clients handle this */
701c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision,VIDIOC_S_TUNER,vt);
702483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
703c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
704c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
705483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
706c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_frequency (struct file *file, void *priv,
707c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_frequency *freq)
708c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
709c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
710c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
711c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
712483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
713c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	freq->tuner = 0; // Only one tuner
714c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->radio) {
715c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		freq->type = V4L2_TUNER_RADIO;
716c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
717c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		freq->type = V4L2_TUNER_ANALOG_TV;
718c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
719c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	freq->frequency = usbvision->freq;
720483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
721c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
722c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
723483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
724c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_frequency (struct file *file, void *priv,
725c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_frequency *freq)
726c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
727c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
728c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
729c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
730483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
731c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	// Only no or one tuner for now
732c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!usbvision->have_tuner || freq->tuner)
733c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
734483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
735c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->freq = freq->frequency;
736c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_S_FREQUENCY, freq);
737483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
738c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
739c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
740483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
741c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_audio (struct file *file, void *priv, struct v4l2_audio *a)
742c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
743c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
744c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
745c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
746483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
747c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	memset(a,0,sizeof(*a));
748c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->radio) {
749c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(a->name,"Radio");
750c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
751c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		strcpy(a->name, "TV");
752c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
753483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
754c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
755c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
756483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
757c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_audio (struct file *file, void *fh,
758c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			  struct v4l2_audio *a)
759c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
760c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(a->index) {
761c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
762c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
763483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
764c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
765c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
766483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
767c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_queryctrl (struct file *file, void *priv,
768c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			    struct v4l2_queryctrl *ctrl)
769c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
770c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
771c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
772c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
773c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int id=ctrl->id;
774483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
775c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	memset(ctrl,0,sizeof(*ctrl));
776c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	ctrl->id=id;
777483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
778c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_QUERYCTRL, ctrl);
779483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
780c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (!ctrl->type)
781c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
782483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
783c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
784c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
785483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
786c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_ctrl (struct file *file, void *priv,
787c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_control *ctrl)
788c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
789c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
790c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
791c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
792c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_G_CTRL, ctrl);
793483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
794c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
795c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
796c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
797c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_ctrl (struct file *file, void *priv,
798c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				struct v4l2_control *ctrl)
799c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
800c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
801c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
802c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
803c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision, VIDIOC_S_CTRL, ctrl);
804c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
805c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
806c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
807c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
808c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_reqbufs (struct file *file,
809c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			   void *priv, struct v4l2_requestbuffers *vr)
810c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
811c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
812c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
813c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
814c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int ret;
815c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
816c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	RESTRICT_TO_RANGE(vr->count,1,USBVISION_NUMFRAMES);
817c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
818c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Check input validity:
819c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   the user must do a VIDEO CAPTURE and MMAP method. */
820c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if((vr->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) ||
821c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   (vr->memory != V4L2_MEMORY_MMAP))
822c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
823c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
824c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->streaming == Stream_On) {
825c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if ((ret = usbvision_stream_interrupt(usbvision)))
826c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return ret;
827483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
828c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
829c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_frames_free(usbvision);
830c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_empty_framequeues(usbvision);
831c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vr->count = usbvision_frames_alloc(usbvision,vr->count);
832c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
833c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->curFrame = NULL;
834c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
835483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
836483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
837483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
838c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_querybuf (struct file *file,
839c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			    void *priv, struct v4l2_buffer *vb)
840483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
841c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
842c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
843c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
844c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usbvision_frame *frame;
845c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
846c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* FIXME : must control
847c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   that buffers are mapped (VIDIOC_REQBUFS has been called) */
848c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
849c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
850c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
851c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->index>=usbvision->num_frames)  {
852c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
853c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
854c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Updating the corresponding frame state */
855c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->flags = 0;
856c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame = &usbvision->frame[vb->index];
857c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(frame->grabstate >= FrameState_Ready)
858c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vb->flags |= V4L2_BUF_FLAG_QUEUED;
859c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(frame->grabstate >= FrameState_Done)
860c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vb->flags |= V4L2_BUF_FLAG_DONE;
861c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(frame->grabstate == FrameState_Unused)
862c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		vb->flags |= V4L2_BUF_FLAG_MAPPED;
863c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->memory = V4L2_MEMORY_MMAP;
864c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
865c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->m.offset = vb->index*PAGE_ALIGN(usbvision->max_frame_size);
866c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
867c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->memory = V4L2_MEMORY_MMAP;
868c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->field = V4L2_FIELD_NONE;
869c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->length = usbvision->curwidth*
870c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->curheight*
871c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->palette.bytes_per_pixel;
872c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->timestamp = usbvision->frame[vb->index].timestamp;
873c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->sequence = usbvision->frame[vb->index].sequence;
874c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
875483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
876483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
877c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_qbuf (struct file *file, void *priv, struct v4l2_buffer *vb)
878c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
879c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
880c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
881c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
882c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usbvision_frame *frame;
883c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	unsigned long lock_flags;
884c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
885c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* FIXME : works only on VIDEO_CAPTURE MODE, MMAP. */
886c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
887c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
888c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
889c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vb->index>=usbvision->num_frames)  {
890c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
891c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
892c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
893c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame = &usbvision->frame[vb->index];
894c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
895c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (frame->grabstate != FrameState_Unused) {
896c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EAGAIN;
897c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
898c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
899c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Mark it as ready and enqueue frame */
900c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->grabstate = FrameState_Ready;
901c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->scanstate = ScanState_Scanning;
902c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->scanlength = 0;	/* Accumulated in usbvision_parse_data() */
903c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
904c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->flags &= ~V4L2_BUF_FLAG_DONE;
905c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
906c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* set v4l2_format index */
907c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	frame->v4l2_format = usbvision->palette;
908c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
909c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
910c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	list_add_tail(&usbvision->frame[vb->index].frame, &usbvision->inqueue);
911c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
912c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
913c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
914c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
915c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
916c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_dqbuf (struct file *file, void *priv, struct v4l2_buffer *vb)
917c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
918c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
919c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
920c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
921c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int ret;
922c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usbvision_frame *f;
923c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	unsigned long lock_flags;
924c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
925c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (vb->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
926c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
927c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
928c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (list_empty(&(usbvision->outqueue))) {
929c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (usbvision->streaming == Stream_Idle)
930c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return -EINVAL;
931c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		ret = wait_event_interruptible
932c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			(usbvision->wait_frame,
933c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			 !list_empty(&(usbvision->outqueue)));
934c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (ret)
935c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return ret;
936c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
937c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
938c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
939c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	f = list_entry(usbvision->outqueue.next,
940c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       struct usbvision_frame, frame);
941c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	list_del(usbvision->outqueue.next);
942c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
943c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
944c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	f->grabstate = FrameState_Unused;
945c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
946c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->memory = V4L2_MEMORY_MMAP;
947c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->flags = V4L2_BUF_FLAG_MAPPED |
948c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_BUF_FLAG_QUEUED |
949c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		V4L2_BUF_FLAG_DONE;
950c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->index = f->index;
951c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->sequence = f->sequence;
952c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->timestamp = f->timestamp;
953c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->field = V4L2_FIELD_NONE;
954c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vb->bytesused = f->scanlength;
955c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
956c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
957c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
958c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
959c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_streamon(struct file *file, void *priv, enum v4l2_buf_type i)
960c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
961c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
962c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
963c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
964c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
965c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
966c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->streaming = Stream_On;
967c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	call_i2c_clients(usbvision,VIDIOC_STREAMON , &b);
968c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
969c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
970c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
971c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
972c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_streamoff(struct file *file,
973c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			    void *priv, enum v4l2_buf_type type)
974c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
975c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
976c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
977c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
978c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
979c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
980c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
981c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
982c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
983c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->streaming == Stream_On) {
984c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision_stream_interrupt(usbvision);
985c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* Stop all video streamings */
986c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		call_i2c_clients(usbvision,VIDIOC_STREAMOFF , &b);
987c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
988c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_empty_framequeues(usbvision);
989c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
990c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
991c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
992c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
993c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_enum_fmt_cap (struct file *file, void  *priv,
994c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					struct v4l2_fmtdesc *vfd)
995c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
996c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(vfd->index>=USBVISION_SUPPORTED_PALETTES-1) {
997c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
998c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
999c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vfd->flags = 0;
1000c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vfd->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1001c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	strcpy(vfd->description,usbvision_v4l2_format[vfd->index].desc);
1002c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vfd->pixelformat = usbvision_v4l2_format[vfd->index].format;
1003c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	memset(vfd->reserved, 0, sizeof(vfd->reserved));
1004c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1005c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1006c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1007c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_g_fmt_cap (struct file *file, void *priv,
1008c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					struct v4l2_format *vf)
1009c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1010c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
1011c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1012c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1013c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.width = usbvision->curwidth;
1014c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.height = usbvision->curheight;
1015c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.pixelformat = usbvision->palette.format;
1016c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.bytesperline =
1017c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->curwidth*usbvision->palette.bytes_per_pixel;
1018c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*usbvision->curheight;
1019c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
1020c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.field = V4L2_FIELD_NONE; /* Always progressive image */
1021c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1022c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1023c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1024c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1025c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_try_fmt_cap (struct file *file, void *priv,
1026c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			       struct v4l2_format *vf)
1027c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1028c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
1029c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1030c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1031c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int formatIdx;
1032c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1033c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Find requested format in available ones */
1034c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	for(formatIdx=0;formatIdx<USBVISION_SUPPORTED_PALETTES;formatIdx++) {
1035c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if(vf->fmt.pix.pixelformat ==
1036c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		   usbvision_v4l2_format[formatIdx].format) {
1037c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			usbvision->palette = usbvision_v4l2_format[formatIdx];
1038c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			break;
1039c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		}
1040c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1041c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* robustness */
1042c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(formatIdx == USBVISION_SUPPORTED_PALETTES) {
1043c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return -EINVAL;
1044c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1045c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	RESTRICT_TO_RANGE(vf->fmt.pix.width, MIN_FRAME_WIDTH, MAX_FRAME_WIDTH);
1046c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	RESTRICT_TO_RANGE(vf->fmt.pix.height, MIN_FRAME_HEIGHT, MAX_FRAME_HEIGHT);
1047c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1048c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.bytesperline = vf->fmt.pix.width*
1049c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->palette.bytes_per_pixel;
1050c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*vf->fmt.pix.height;
1051c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1052c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1053c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1054c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1055c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLEstatic int vidioc_s_fmt_cap(struct file *file, void *priv,
1056c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			       struct v4l2_format *vf)
1057c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE{
1058c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct video_device *dev = video_devdata(file);
1059c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1060c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1061c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int ret;
1062c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1063c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if( 0 != (ret=vidioc_try_fmt_cap (file, priv, vf)) ) {
1064c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		return ret;
1065c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1066c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1067c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* stop io in case it is already in progress */
1068c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if(usbvision->streaming == Stream_On) {
1069c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if ((ret = usbvision_stream_interrupt(usbvision)))
1070c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			return ret;
1071c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	}
1072c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_frames_free(usbvision);
1073c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_empty_framequeues(usbvision);
1074c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1075c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->curFrame = NULL;
1076c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1077c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* by now we are committed to the new data... */
1078c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	down(&usbvision->lock);
1079c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_set_output(usbvision, vf->fmt.pix.width, vf->fmt.pix.height);
1080c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	up(&usbvision->lock);
1081c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1082c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return 0;
1083c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE}
1084483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
10858a5ab4157b3933d4fa29a1612879ab08f681041aAl Virostatic ssize_t usbvision_v4l2_read(struct file *file, char __user *buf,
1086483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		      size_t count, loff_t *ppos)
1087483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1088483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1089c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1090c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1091483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int noblock = file->f_flags & O_NONBLOCK;
1092483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	unsigned long lock_flags;
1093483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1094483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int ret,i;
1095483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usbvision_frame *frame;
1096483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1097c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	PDEBUG(DBG_IO, "%s: %ld bytes, noblock=%d", __FUNCTION__,
1098c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       (unsigned long)count, noblock);
1099483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1100483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!USBVISION_IS_OPERATIONAL(usbvision) || (buf == NULL))
1101483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EFAULT;
1102483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1103c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* This entry point is compatible with the mmap routines
1104c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   so that a user can do either VIDIOC_QBUF/VIDIOC_DQBUF
1105c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   to get frames or call read on the device. */
11066f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	if(!usbvision->num_frames) {
1107c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* First, allocate some frames to work with
1108c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		   if this has not been done with VIDIOC_REQBUF */
11096f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision_frames_free(usbvision);
11106f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision_empty_framequeues(usbvision);
11116f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision_frames_alloc(usbvision,USBVISION_NUMFRAMES);
11126f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	}
11136f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE
11146f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	if(usbvision->streaming != Stream_On) {
11156f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		/* no stream is running, make it running ! */
11166f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		usbvision->streaming = Stream_On;
11176f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE		call_i2c_clients(usbvision,VIDIOC_STREAMON , NULL);
11186f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	}
1119483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1120c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* Then, enqueue as many frames as possible
1121c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	   (like a user of VIDIOC_QBUF would do) */
11226f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	for(i=0;i<usbvision->num_frames;i++) {
1123483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		frame = &usbvision->frame[i];
1124483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if(frame->grabstate == FrameState_Unused) {
1125483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			/* Mark it as ready and enqueue frame */
1126483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			frame->grabstate = FrameState_Ready;
1127483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			frame->scanstate = ScanState_Scanning;
1128c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			/* Accumulated in usbvision_parse_data() */
1129c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			frame->scanlength = 0;
1130483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1131483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			/* set v4l2_format index */
1132483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			frame->v4l2_format = usbvision->palette;
1133483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1134483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
1135483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			list_add_tail(&frame->frame, &usbvision->inqueue);
1136c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			spin_unlock_irqrestore(&usbvision->queue_lock,
1137c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					       lock_flags);
1138483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1139483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1140483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1141483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* Then try to steal a frame (like a VIDIOC_DQBUF would do) */
1142483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (list_empty(&(usbvision->outqueue))) {
1143483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if(noblock)
1144483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			return -EAGAIN;
1145483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1146483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		ret = wait_event_interruptible
1147483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			(usbvision->wait_frame,
1148483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			 !list_empty(&(usbvision->outqueue)));
1149483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (ret)
1150483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			return ret;
1151483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1152483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1153483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
1154483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	frame = list_entry(usbvision->outqueue.next,
1155483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			   struct usbvision_frame, frame);
1156483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	list_del(usbvision->outqueue.next);
1157483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
1158483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1159483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* An error returns an empty frame */
1160483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (frame->grabstate == FrameState_Error) {
1161483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		frame->bytes_read = 0;
1162483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return 0;
1163483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1164483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1165c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	PDEBUG(DBG_IO, "%s: frmx=%d, bytes_read=%ld, scanlength=%ld",
1166c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       __FUNCTION__,
1167c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       frame->index, frame->bytes_read, frame->scanlength);
1168483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1169483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* copy bytes to user space; we allow for partials reads */
1170483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if ((count + frame->bytes_read) > (unsigned long)frame->scanlength)
1171483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		count = frame->scanlength - frame->bytes_read;
1172483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1173483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (copy_to_user(buf, frame->data + frame->bytes_read, count)) {
1174483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EFAULT;
1175483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1176483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1177483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	frame->bytes_read += count;
1178c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	PDEBUG(DBG_IO, "%s: {copy} count used=%ld, new bytes_read=%ld",
1179c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       __FUNCTION__,
1180c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       (unsigned long)count, frame->bytes_read);
1181483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1182c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* For now, forget the frame if it has not been read in one shot. */
1183483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/* 	if (frame->bytes_read >= frame->scanlength) {// All data has been read */
1184483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		frame->bytes_read = 0;
1185483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1186483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		/* Mark it as available to be used again. */
1187c430ca1e16b2b4b30f567806c73e270caea8db1dThierry MERLE		frame->grabstate = FrameState_Unused;
1188483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/* 	} */
1189483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1190483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return count;
1191483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1192483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1193483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_v4l2_mmap(struct file *file, struct vm_area_struct *vma)
1194483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1195483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	unsigned long size = vma->vm_end - vma->vm_start,
1196483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		start = vma->vm_start;
1197483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	void *pos;
1198483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	u32 i;
1199483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1200483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1201c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1202c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1203483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
12046f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	PDEBUG(DBG_MMAP, "mmap");
12056f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE
1206483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
1207483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1208483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!USBVISION_IS_OPERATIONAL(usbvision)) {
1209483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		up(&usbvision->lock);
1210483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EFAULT;
1211483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1212483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1213483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!(vma->vm_flags & VM_WRITE) ||
12146f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	    size != PAGE_ALIGN(usbvision->max_frame_size)) {
1215483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		up(&usbvision->lock);
1216483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EINVAL;
1217483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1218483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
12196f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	for (i = 0; i < usbvision->num_frames; i++) {
1220c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (((PAGE_ALIGN(usbvision->max_frame_size)*i) >> PAGE_SHIFT) ==
1221c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    vma->vm_pgoff)
1222483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			break;
1223483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
12246f78e186fe5d29dbff5e34f950adb573c4808de4Thierry MERLE	if (i == usbvision->num_frames) {
1225c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_MMAP,
1226c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       "mmap: user supplied mapping address is out of range");
1227483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		up(&usbvision->lock);
1228483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -EINVAL;
1229483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1230483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1231483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* VM_IO is eventually going to replace PageReserved altogether */
1232483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vma->vm_flags |= VM_IO;
1233483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vma->vm_flags |= VM_RESERVED;	/* avoid to swap out this VMA */
1234483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1235483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	pos = usbvision->frame[i].data;
1236483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	while (size > 0) {
1237483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1238483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (vm_insert_page(vma, start, vmalloc_to_page(pos))) {
1239c876a3468d0f136710af81595177889953d1ff71Thierry MERLE			PDEBUG(DBG_MMAP, "mmap: vm_insert_page failed");
1240483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			up(&usbvision->lock);
1241483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			return -EAGAIN;
1242483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1243483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		start += PAGE_SIZE;
1244483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		pos += PAGE_SIZE;
1245483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		size -= PAGE_SIZE;
1246483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1247483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1248483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
1249483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
1250483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1251483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1252483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1253483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1254483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Here comes the stuff for radio on usbvision based devices
1255483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1256483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1257483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_radio_open(struct inode *inode, struct file *file)
1258483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1259483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1260c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1261c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1262483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode = 0;
1263483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1264483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "%s:", __FUNCTION__);
1265483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1266483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
1267483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1268483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->user) {
1269483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: Someone tried to open an already opened USBVision Radio!", __FUNCTION__);
1270483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		errCode = -EBUSY;
1271483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1272483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	else {
1273483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if(PowerOnAtOpen) {
1274483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_reset_powerOffTimer(usbvision);
1275483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			if (usbvision->power == 0) {
1276483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				usbvision_power_on(usbvision);
12771ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE				usbvision_i2c_register(usbvision);
1278483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			}
1279483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1280483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
12812a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		/* Alternate interface 1 is is the biggest frame size */
12822a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		errCode = usbvision_set_alternate(usbvision);
12832a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		if (errCode < 0) {
12842a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE			usbvision->last_error = errCode;
12852a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE			return -EBUSY;
12862a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		}
12872a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1288483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		// If so far no errors then we shall start the radio
1289483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->radio = 1;
1290483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		call_i2c_clients(usbvision,AUDC_SET_RADIO,&usbvision->tuner_type);
1291483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_set_audio(usbvision, USBVISION_AUDIO_RADIO);
1292483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->user++;
1293483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1294483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1295483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (errCode) {
1296483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (PowerOnAtOpen) {
12971ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE			usbvision_i2c_unregister(usbvision);
1298483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision_power_off(usbvision);
1299483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			usbvision->initialized = 0;
1300483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1301483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1302483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
1303483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
1304483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1305483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1306483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1307483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_radio_close(struct inode *inode, struct file *file)
1308483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1309483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *dev = video_devdata(file);
1310c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	struct usb_usbvision *usbvision =
1311c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		(struct usb_usbvision *) video_get_drvdata(dev);
1312483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode = 0;
1313483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1314483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "");
1315483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1316483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
1317483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
13182a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	/* Set packet size to 0 */
13192a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->ifaceAlt=0;
13202a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	errCode = usb_set_interface(usbvision->dev, usbvision->iface,
13212a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE				    usbvision->ifaceAlt);
13222a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1323483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_audio_off(usbvision);
1324483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->radio=0;
1325483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->user--;
1326483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1327483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (PowerOnAtOpen) {
1328483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_set_powerOffTimer(usbvision);
1329483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->initialized = 0;
1330483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1331483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1332483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
1333483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1334483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->remove_pending) {
1335de6a1b8edc48155249896f2600398e139f4860c6Dwaine Garden		printk(KERN_INFO "%s: Final disconnect\n", __FUNCTION__);
1336483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_release(usbvision);
1337483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1338483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1339483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1340483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO, "success");
1341483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1342483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
1343483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1344483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1345483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1346483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Here comes the stuff for vbi on usbvision based devices
1347483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1348483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1349483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_vbi_open(struct inode *inode, struct file *file)
1350483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1351483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* TODO */
1352c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return -ENODEV;
1353483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1354483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1355483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1356483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_vbi_close(struct inode *inode, struct file *file)
1357483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1358483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* TODO */
1359c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return -ENODEV;
1360483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1361483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1362483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_do_vbi_ioctl(struct inode *inode, struct file *file,
1363483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE				 unsigned int cmd, void *arg)
1364483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1365483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* TODO */
1366c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	return -ENOIOCTLCMD;
1367483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1368483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1369483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int usbvision_vbi_ioctl(struct inode *inode, struct file *file,
1370483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		       unsigned int cmd, unsigned long arg)
1371483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1372483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return video_usercopy(inode, file, cmd, arg, usbvision_do_vbi_ioctl);
1373483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1374483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1375483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1376483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//
1377483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Video registration stuff
1378483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//
1379483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1380483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Video template
1381fa027c2a0a0d6d1df6b29ee99048502c93da0dd4Arjan van de Venstatic const struct file_operations usbvision_fops = {
1382483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1383483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.open		= usbvision_v4l2_open,
1384483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= usbvision_v4l2_close,
1385483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.read		= usbvision_v4l2_read,
1386483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.mmap		= usbvision_v4l2_mmap,
1387c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.ioctl		= video_ioctl2,
1388483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.llseek		= no_llseek,
1389c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/* 	.poll          = video_poll, */
1390c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.compat_ioctl  = v4l_compat_ioctl32,
1391483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1392483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device usbvision_video_template = {
1393483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1394483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.type		= VID_TYPE_TUNER | VID_TYPE_CAPTURE,
1395483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.hardware	= VID_HARDWARE_USBVISION,
1396483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.fops		= &usbvision_fops,
1397483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name           = "usbvision-video",
1398483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= video_device_release,
1399483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.minor		= -1,
1400c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_querycap      = vidioc_querycap,
1401c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_enum_fmt_cap  = vidioc_enum_fmt_cap,
1402c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_fmt_cap     = vidioc_g_fmt_cap,
1403c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_try_fmt_cap   = vidioc_try_fmt_cap,
1404c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_fmt_cap     = vidioc_s_fmt_cap,
1405c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_reqbufs       = vidioc_reqbufs,
1406c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_querybuf      = vidioc_querybuf,
1407c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_qbuf          = vidioc_qbuf,
1408c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_dqbuf         = vidioc_dqbuf,
1409c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_std         = vidioc_s_std,
1410c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_enum_input    = vidioc_enum_input,
1411c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_input       = vidioc_g_input,
1412c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_input       = vidioc_s_input,
1413c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_queryctrl     = vidioc_queryctrl,
1414c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_audio       = vidioc_g_audio,
1415ed4d6375a1498009a9e68d93661207351d36874fAl Viro	.vidioc_s_audio       = vidioc_s_audio,
1416c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_ctrl        = vidioc_g_ctrl,
1417c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_ctrl        = vidioc_s_ctrl,
1418c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_streamon      = vidioc_streamon,
1419c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_streamoff     = vidioc_streamoff,
1420c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#ifdef CONFIG_VIDEO_V4L1_COMPAT
1421c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*  	.vidiocgmbuf          = vidiocgmbuf, */
1422c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#endif
1423c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_tuner       = vidioc_g_tuner,
1424c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_tuner       = vidioc_s_tuner,
1425c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_frequency   = vidioc_g_frequency,
1426c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_frequency   = vidioc_s_frequency,
1427c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#ifdef CONFIG_VIDEO_ADV_DEBUG
1428c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_register    = vidioc_g_register,
1429c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_register    = vidioc_s_register,
1430c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE#endif
1431c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.tvnorms              = USBVISION_NORMS,
1432c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.current_norm         = V4L2_STD_PAL
1433483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1434483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1435483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1436483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// Radio template
1437fa027c2a0a0d6d1df6b29ee99048502c93da0dd4Arjan van de Venstatic const struct file_operations usbvision_radio_fops = {
1438483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1439483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.open		= usbvision_radio_open,
1440483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= usbvision_radio_close,
1441c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.ioctl		= video_ioctl2,
1442483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.llseek		= no_llseek,
1443c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.compat_ioctl  = v4l_compat_ioctl32,
1444483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1445483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1446483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device usbvision_radio_template=
1447483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1448483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1449483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.type		= VID_TYPE_TUNER,
1450483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.hardware	= VID_HARDWARE_USBVISION,
1451483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.fops		= &usbvision_radio_fops,
1452483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name           = "usbvision-radio",
1453c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.release	= video_device_release,
1454483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.minor		= -1,
1455c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_querycap      = vidioc_querycap,
1456c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_enum_input    = vidioc_enum_input,
1457c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_input       = vidioc_g_input,
1458c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_input       = vidioc_s_input,
1459c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_queryctrl     = vidioc_queryctrl,
1460c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_audio       = vidioc_g_audio,
1461ed4d6375a1498009a9e68d93661207351d36874fAl Viro	.vidioc_s_audio       = vidioc_s_audio,
1462c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_ctrl        = vidioc_g_ctrl,
1463c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_ctrl        = vidioc_s_ctrl,
1464c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_tuner       = vidioc_g_tuner,
1465c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_tuner       = vidioc_s_tuner,
1466c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_g_frequency   = vidioc_g_frequency,
1467c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.vidioc_s_frequency   = vidioc_s_frequency,
1468c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE
1469c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.tvnorms              = USBVISION_NORMS,
1470c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.current_norm         = V4L2_STD_PAL
1471483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1472483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1473483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// vbi template
1474fa027c2a0a0d6d1df6b29ee99048502c93da0dd4Arjan van de Venstatic const struct file_operations usbvision_vbi_fops = {
1475483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1476483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.open		= usbvision_vbi_open,
1477483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= usbvision_vbi_close,
1478483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.ioctl		= usbvision_vbi_ioctl,
1479483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.llseek		= no_llseek,
1480c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	.compat_ioctl  = v4l_compat_ioctl32,
1481483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1482483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1483483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device usbvision_vbi_template=
1484483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1485483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.owner             = THIS_MODULE,
1486483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.type		= VID_TYPE_TUNER,
1487483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.hardware	= VID_HARDWARE_USBVISION,
1488483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.fops		= &usbvision_vbi_fops,
1489483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.release	= video_device_release,
1490483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name           = "usbvision-vbi",
1491483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.minor		= -1,
1492483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1493483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1494483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1495483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct video_device *usbvision_vdev_init(struct usb_usbvision *usbvision,
1496483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE					struct video_device *vdev_template,
1497483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE					char *name)
1498483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1499483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_device *usb_dev = usbvision->dev;
1500483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct video_device *vdev;
1501483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1502483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usb_dev == NULL) {
1503483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: usbvision->dev is not set", __FUNCTION__);
1504483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return NULL;
1505483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1506483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1507483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vdev = video_device_alloc();
1508483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (NULL == vdev) {
1509483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return NULL;
1510483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1511483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	*vdev = *vdev_template;
1512483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE//	vdev->minor   = -1;
1513483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	vdev->dev     = &usb_dev->dev;
1514483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	snprintf(vdev->name, sizeof(vdev->name), "%s", name);
1515483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	video_set_drvdata(vdev, usbvision);
1516483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return vdev;
1517483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1518483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1519483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// unregister video4linux devices
1520483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_unregister_video(struct usb_usbvision *usbvision)
1521483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1522483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// vbi Device:
1523483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->vbi) {
1524c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_PROBE, "unregister /dev/vbi%d [v4l2]",
1525c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->vbi->minor & 0x1f);
1526483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->vbi->minor != -1) {
1527483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_unregister_device(usbvision->vbi);
1528c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
1529483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_device_release(usbvision->vbi);
1530483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1531483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->vbi = NULL;
1532483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1533483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1534483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Radio Device:
1535483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->rdev) {
1536c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_PROBE, "unregister /dev/radio%d [v4l2]",
1537c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->rdev->minor & 0x1f);
1538483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->rdev->minor != -1) {
1539483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_unregister_device(usbvision->rdev);
1540c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
1541483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_device_release(usbvision->rdev);
1542483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1543483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->rdev = NULL;
1544483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1545483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1546483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Video Device:
1547483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->vdev) {
1548c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		PDEBUG(DBG_PROBE, "unregister /dev/video%d [v4l2]",
1549c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->vdev->minor & 0x1f);
1550483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->vdev->minor != -1) {
1551483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_unregister_device(usbvision->vdev);
1552c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		} else {
1553483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			video_device_release(usbvision->vdev);
1554483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1555483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->vdev = NULL;
1556483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1557483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1558483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1559483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE// register video4linux devices
1560483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int __devinit usbvision_register_video(struct usb_usbvision *usbvision)
1561483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1562483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Video Device:
1563c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->vdev = usbvision_vdev_init(usbvision,
1564c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					      &usbvision_video_template,
1565c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					      "USBVision Video");
1566483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->vdev == NULL) {
1567483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1568483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1569c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if (video_register_device(usbvision->vdev,
1570c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				  VFL_TYPE_GRABBER,
1571c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE				  video_nr)<0) {
1572483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1573483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1574c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	printk(KERN_INFO "USBVision[%d]: registered USBVision Video device /dev/video%d [v4l2]\n",
1575c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	       usbvision->nr,usbvision->vdev->minor & 0x1f);
1576483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1577483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// Radio Device:
1578483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision_device_data[usbvision->DevModel].Radio) {
1579483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		// usbvision has radio
1580c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->rdev = usbvision_vdev_init(usbvision,
1581c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						      &usbvision_radio_template,
1582c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						      "USBVision Radio");
1583483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->rdev == NULL) {
1584483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1585483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1586c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (video_register_device(usbvision->rdev,
1587c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  VFL_TYPE_RADIO,
1588c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  radio_nr)<0) {
1589483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1590483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1591c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		printk(KERN_INFO "USBVision[%d]: registered USBVision Radio device /dev/radio%d [v4l2]\n",
1592c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->nr, usbvision->rdev->minor & 0x1f);
1593483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1594483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// vbi Device:
1595483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision_device_data[usbvision->DevModel].vbi) {
1596c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->vbi = usbvision_vdev_init(usbvision,
1597c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						     &usbvision_vbi_template,
1598c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE						     "USBVision VBI");
1599483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		if (usbvision->vdev == NULL) {
1600483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1601483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1602c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		if (video_register_device(usbvision->vbi,
1603c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  VFL_TYPE_VBI,
1604c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE					  vbi_nr)<0) {
1605483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE			goto err_exit;
1606483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		}
1607c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		printk(KERN_INFO "USBVision[%d]: registered USBVision VBI device /dev/vbi%d [v4l2] (Not Working Yet!)\n",
1608c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       usbvision->nr,usbvision->vbi->minor & 0x1f);
1609483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1610483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// all done
1611483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
1612483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1613483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE err_exit:
1614483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	err("USBVision[%d]: video_register_device() failed", usbvision->nr);
1615483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_unregister_video(usbvision);
1616483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return -1;
1617483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1618483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1619483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1620483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_alloc()
1621483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1622c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE * This code allocates the struct usb_usbvision.
1623c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE * It is filled with default values.
1624483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1625483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Returns NULL on error, a pointer to usb_usbvision else.
1626483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1627483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1628483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct usb_usbvision *usbvision_alloc(struct usb_device *dev)
1629483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1630483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision;
1631483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1632c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((usbvision = kzalloc(sizeof(struct usb_usbvision), GFP_KERNEL)) ==
1633c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	    NULL) {
1634483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1635483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1636483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1637483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->dev = dev;
1638483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1639483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	init_MUTEX(&usbvision->lock);	/* to 1 == available */
1640483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1641483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// prepare control urb for control messages during interrupts
1642483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->ctrlUrb = usb_alloc_urb(USBVISION_URB_FRAMES, GFP_KERNEL);
1643483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->ctrlUrb == NULL) {
1644483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		goto err_exit;
1645483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1646483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	init_waitqueue_head(&usbvision->ctrlUrb_wq);
1647483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	init_MUTEX(&usbvision->ctrlUrbLock);	/* to 1 == available */
1648483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1649483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_init_powerOffTimer(usbvision);
1650483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1651483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return usbvision;
1652483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1653483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEerr_exit:
1654483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision && usbvision->ctrlUrb) {
1655483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usb_free_urb(usbvision->ctrlUrb);
1656483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1657483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision) {
1658483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		kfree(usbvision);
1659483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1660483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return NULL;
1661483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1662483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1663483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1664483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_release()
1665483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1666483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This code does final release of struct usb_usbvision. This happens
1667483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * after the device is disconnected -and- all clients closed their files.
1668483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1669483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1670483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_release(struct usb_usbvision *usbvision)
1671483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1672483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "");
1673483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1674483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
1675483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1676483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_reset_powerOffTimer(usbvision);
1677483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1678483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->initialized = 0;
1679483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1680483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
1681483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1682483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_remove_sysfs(usbvision->vdev);
1683483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_unregister_video(usbvision);
1684483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1685483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->ctrlUrb) {
1686483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usb_free_urb(usbvision->ctrlUrb);
1687483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1688483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1689483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	kfree(usbvision);
1690483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1691483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "success");
1692483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1693483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1694483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1695c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE/*********************** usb interface **********************************/
1696483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1697483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void usbvision_configure_video(struct usb_usbvision *usbvision)
1698483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1699c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	int model;
1700483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1701483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision == NULL)
1702483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return;
1703483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1704483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	model = usbvision->DevModel;
1705483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->palette = usbvision_v4l2_format[2]; // V4L2_PIX_FMT_RGB24;
1706483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1707c682b3a7fb8ec69ac73511bbb6a378e40aa35f35Trent Piepho	if (usbvision_device_data[usbvision->DevModel].Vin_Reg2_override) {
1708c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision->Vin_Reg2_Preset =
1709c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE			usbvision_device_data[usbvision->DevModel].Vin_Reg2;
1710483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	} else {
1711483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->Vin_Reg2_Preset = 0;
1712483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1713483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1714c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision->tvnormId = usbvision_device_data[model].VideoNorm;
1715483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1716483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->video_inputs = usbvision_device_data[model].VideoChannels;
1717483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->ctl_input = 0;
1718483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1719483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* This should be here to make i2c clients to be able to register */
1720c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	/* first switch off audio */
1721c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	usbvision_audio_off(usbvision);
1722483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (!PowerOnAtOpen) {
1723c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		/* and then power up the noisy tuner */
1724c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		usbvision_power_on(usbvision);
17251ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE		usbvision_i2c_register(usbvision);
1726483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1727483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1728483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1729483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1730483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_probe()
1731483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1732483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This procedure queries device descriptor and accepts the interface
1733483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * if it looks like USBVISION video device
1734483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1735483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1736659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehabstatic int __devinit usbvision_probe(struct usb_interface *intf,
1737659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				     const struct usb_device_id *devid)
1738483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
17392a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	struct usb_device *dev = usb_get_dev(interface_to_usbdev(intf));
17402a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	struct usb_interface *uif;
1741483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	__u8 ifnum = intf->altsetting->desc.bInterfaceNumber;
1742483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	const struct usb_host_interface *interface;
1743483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = NULL;
1744483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	const struct usb_endpoint_descriptor *endpoint;
17452a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	int model,i;
1746483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1747483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "VID=%#04x, PID=%#04x, ifnum=%u",
1748659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				dev->descriptor.idVendor,
1749659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				dev->descriptor.idProduct, ifnum);
17502a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1751659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab	model = devid->driver_info;
1752f8a389db502f7b287903b209f925df5570ff5478Mauro Carvalho Chehab	if ( (model<0) || (model>=usbvision_device_data_size) ) {
1753672d013bed5e144ac641db343251e35d3212c9adThierry MERLE		PDEBUG(DBG_PROBE, "model out of bounds %d",model);
1754f8a389db502f7b287903b209f925df5570ff5478Mauro Carvalho Chehab		return -ENODEV;
1755f8a389db502f7b287903b209f925df5570ff5478Mauro Carvalho Chehab	}
1756659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab	printk(KERN_INFO "%s: %s found\n", __FUNCTION__,
1757659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab				usbvision_device_data[model].ModelString);
1758483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1759483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision_device_data[model].Interface >= 0) {
1760483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		interface = &dev->actconfig->interface[usbvision_device_data[model].Interface]->altsetting[0];
1761c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
1762483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		interface = &dev->actconfig->interface[ifnum]->altsetting[0];
1763483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1764483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	endpoint = &interface->endpoint[1].desc;
1765c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) !=
1766c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	    USB_ENDPOINT_XFER_ISOC) {
1767c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: interface %d. has non-ISO endpoint!",
1768c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, ifnum);
1769c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: Endpoint attributes %d",
1770c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, endpoint->bmAttributes);
1771483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -ENODEV;
1772483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1773c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	if ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) ==
1774c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	    USB_DIR_OUT) {
1775c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		err("%s: interface %d. has ISO OUT endpoint!",
1776c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		    __FUNCTION__, ifnum);
1777483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -ENODEV;
1778483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1779483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1780483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if ((usbvision = usbvision_alloc(dev)) == NULL) {
1781483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: couldn't allocate USBVision struct", __FUNCTION__);
1782483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return -ENOMEM;
1783483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1784659ae56dcd5a50e4560cb526a0e0dc881418dad4Mauro Carvalho Chehab
1785483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (dev->descriptor.bNumConfigurations > 1) {
1786483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->bridgeType = BRIDGE_NT1004;
1787c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else if (model == DAZZLE_DVC_90_REV_1_SECAM) {
1788483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->bridgeType = BRIDGE_NT1005;
1789c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
1790483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->bridgeType = BRIDGE_NT1003;
1791483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1792483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "bridgeType %d", usbvision->bridgeType);
1793483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1794483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
1795483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
17962a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	/* compute alternate max packet sizes */
17972a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	uif = dev->actconfig->interface[0];
17982a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
17992a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->num_alt=uif->num_altsetting;
18002a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	PDEBUG(DBG_PROBE, "Alternate settings: %i",usbvision->num_alt);
18012a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->alt_max_pkt_size = kmalloc(32*
18022a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE					      usbvision->num_alt,GFP_KERNEL);
18032a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	if (usbvision->alt_max_pkt_size == NULL) {
18042a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		err("usbvision: out of memory!\n");
18052a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		return -ENOMEM;
18062a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	}
18072a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
18082a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	for (i = 0; i < usbvision->num_alt ; i++) {
18092a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		u16 tmp = le16_to_cpu(uif->altsetting[i].endpoint[1].desc.
18102a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE				      wMaxPacketSize);
18112a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		usbvision->alt_max_pkt_size[i] =
18122a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE			(tmp & 0x07ff) * (((tmp & 0x1800) >> 11) + 1);
18132a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		PDEBUG(DBG_PROBE, "Alternate setting %i, max size= %i",i,
18142a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE		       usbvision->alt_max_pkt_size[i]);
18152a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	}
18162a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
18172a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE
1818483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->nr = usbvision_nr++;
1819483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1820483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->have_tuner = usbvision_device_data[model].Tuner;
1821483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->have_tuner) {
1822483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision->tuner_type = usbvision_device_data[model].TunerType;
1823483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1824483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1825483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->tuner_addr = ADDR_UNSET;
1826483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1827483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->DevModel = model;
1828483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->remove_pending = 0;
1829483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->iface = ifnum;
18302a9f8b5d25beacd034369fca416b548cbf931561Thierry MERLE	usbvision->ifaceAlt = 0;
1831483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->video_endp = endpoint->bEndpointAddress;
1832483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->isocPacketSize = 0;
1833483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->usb_bandwidth = 0;
1834483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->user = 0;
1835483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->streaming = Stream_Off;
1836483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_register_video(usbvision);
1837483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_configure_video(usbvision);
1838483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
1839483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1840483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1841483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usb_set_intfdata (intf, usbvision);
1842483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_create_sysfs(usbvision->vdev);
1843483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1844483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "success");
1845483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return 0;
1846483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1847483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1848483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1849483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1850483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_disconnect()
1851483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1852483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This procedure stops all driver activity, deallocates interface-private
1853483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * structure (pointed by 'ptr') and after that driver should be removable
1854483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * with no ill consequences.
1855483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1856483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1857483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void __devexit usbvision_disconnect(struct usb_interface *intf)
1858483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1859483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	struct usb_usbvision *usbvision = usb_get_intfdata(intf);
1860483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1861483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "");
1862483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1863483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision == NULL) {
1864483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		err("%s: usb_get_intfdata() failed", __FUNCTION__);
1865483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		return;
1866483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1867483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usb_set_intfdata (intf, NULL);
1868483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1869483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	down(&usbvision->lock);
1870483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1871483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	// At this time we ask to cancel outstanding URBs
1872483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision_stop_isoc(usbvision);
1873483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1874483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->power) {
18751ff16c2091a557f8080eb62c087465a87e4330e9Thierry MERLE		usbvision_i2c_unregister(usbvision);
1876483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_power_off(usbvision);
1877483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1878483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->remove_pending = 1;	// Now all ISO data will be ignored
1879483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1880483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usb_put_dev(usbvision->dev);
1881483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	usbvision->dev = NULL;	// USB device is no more
1882483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1883483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	up(&usbvision->lock);
1884483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1885483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (usbvision->user) {
1886c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		printk(KERN_INFO "%s: In use, disconnect pending\n",
1887c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE		       __FUNCTION__);
1888483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		wake_up_interruptible(&usbvision->wait_frame);
1889483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		wake_up_interruptible(&usbvision->wait_stream);
1890c5f48367fe54c46805774eeea8e828de54a5ad7bThierry MERLE	} else {
1891483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_release(usbvision);
1892483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1893483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1894483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "success");
1895483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1896483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1897483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1898483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic struct usb_driver usbvision_driver = {
1899483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.name		= "usbvision",
1900483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.id_table	= usbvision_table,
1901483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.probe		= usbvision_probe,
1902483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	.disconnect	= usbvision_disconnect
1903483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE};
1904483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1905483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1906483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * usbvision_init()
1907483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1908483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * This code is run to initialize the driver.
1909483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE *
1910483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1911483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic int __init usbvision_init(void)
1912483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1913483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	int errCode;
1914483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1915483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "");
1916483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1917483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_IO,  "IO      debugging is enabled [video]");
1918483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	PDEBUG(DBG_PROBE, "PROBE   debugging is enabled [video]");
1919c876a3468d0f136710af81595177889953d1ff71Thierry MERLE	PDEBUG(DBG_MMAP, "MMAP    debugging is enabled [video]");
1920483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1921483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	/* disable planar mode support unless compression enabled */
1922483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (isocMode != ISOC_MODE_COMPRESS ) {
1923483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		// FIXME : not the right way to set supported flag
1924483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_v4l2_format[6].supported = 0; // V4L2_PIX_FMT_YVU420
1925483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		usbvision_v4l2_format[7].supported = 0; // V4L2_PIX_FMT_YUV422P
1926483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1927483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1928483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	errCode = usb_register(&usbvision_driver);
1929483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1930483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	if (errCode == 0) {
1931de6a1b8edc48155249896f2600398e139f4860c6Dwaine Garden		printk(KERN_INFO DRIVER_DESC " : " USBVISION_VERSION_STRING "\n");
1932483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE		PDEBUG(DBG_PROBE, "success");
1933483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	}
1934483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE	return errCode;
1935483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1936483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1937483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEstatic void __exit usbvision_exit(void)
1938483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE{
1939483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE PDEBUG(DBG_PROBE, "");
1940483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1941483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE usb_deregister(&usbvision_driver);
1942483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE PDEBUG(DBG_PROBE, "success");
1943483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE}
1944483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1945483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_init(usbvision_init);
1946483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLEmodule_exit(usbvision_exit);
1947483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE
1948483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE/*
1949483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Overrides for Emacs so that we follow Linus's tabbing style.
1950483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * ---------------------------------------------------------------------------
1951483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * Local variables:
1952483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * c-basic-offset: 8
1953483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE * End:
1954483dfdb64fd4a9f240c84e0e225a90c044d65402Thierry MERLE */
1955