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