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