10c0d06caSMauro Carvalho Chehab /* 20c0d06caSMauro Carvalho Chehab em28xx-video.c - driver for Empia EM2800/EM2820/2840 USB 30c0d06caSMauro Carvalho Chehab video capture devices 40c0d06caSMauro Carvalho Chehab 50c0d06caSMauro Carvalho Chehab Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it> 60c0d06caSMauro Carvalho Chehab Markus Rechberger <mrechberger@gmail.com> 70c0d06caSMauro Carvalho Chehab Mauro Carvalho Chehab <mchehab@infradead.org> 80c0d06caSMauro Carvalho Chehab Sascha Sommer <saschasommer@freenet.de> 90c0d06caSMauro Carvalho Chehab 100c0d06caSMauro Carvalho Chehab Some parts based on SN9C10x PC Camera Controllers GPL driver made 110c0d06caSMauro Carvalho Chehab by Luca Risolia <luca.risolia@studio.unibo.it> 120c0d06caSMauro Carvalho Chehab 130c0d06caSMauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 140c0d06caSMauro Carvalho Chehab it under the terms of the GNU General Public License as published by 150c0d06caSMauro Carvalho Chehab the Free Software Foundation; either version 2 of the License, or 160c0d06caSMauro Carvalho Chehab (at your option) any later version. 170c0d06caSMauro Carvalho Chehab 180c0d06caSMauro Carvalho Chehab This program is distributed in the hope that it will be useful, 190c0d06caSMauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 200c0d06caSMauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 210c0d06caSMauro Carvalho Chehab GNU General Public License for more details. 220c0d06caSMauro Carvalho Chehab 230c0d06caSMauro Carvalho Chehab You should have received a copy of the GNU General Public License 240c0d06caSMauro Carvalho Chehab along with this program; if not, write to the Free Software 250c0d06caSMauro Carvalho Chehab Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 260c0d06caSMauro Carvalho Chehab */ 270c0d06caSMauro Carvalho Chehab 280c0d06caSMauro Carvalho Chehab #include <linux/init.h> 290c0d06caSMauro Carvalho Chehab #include <linux/list.h> 300c0d06caSMauro Carvalho Chehab #include <linux/module.h> 310c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 320c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 330c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 340c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 350c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 360c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 370c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 380c0d06caSMauro Carvalho Chehab 390c0d06caSMauro Carvalho Chehab #include "em28xx.h" 400c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 410c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 420c0d06caSMauro Carvalho Chehab #include <media/v4l2-chip-ident.h> 430c0d06caSMauro Carvalho Chehab #include <media/msp3400.h> 440c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 450c0d06caSMauro Carvalho Chehab 460c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 470c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 480c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 490c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 500c0d06caSMauro Carvalho Chehab 510c0d06caSMauro Carvalho Chehab #define DRIVER_DESC "Empia em28xx based USB video device driver" 520c0d06caSMauro Carvalho Chehab 530c0d06caSMauro Carvalho Chehab #define EM28XX_VERSION "0.1.3" 540c0d06caSMauro Carvalho Chehab 550c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 560c0d06caSMauro Carvalho Chehab if (video_debug) \ 570c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 580c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 590c0d06caSMauro Carvalho Chehab 600c0d06caSMauro Carvalho Chehab static unsigned int isoc_debug; 610c0d06caSMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 620c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 630c0d06caSMauro Carvalho Chehab 640c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 650c0d06caSMauro Carvalho Chehab do {\ 660c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 670c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 680c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 690c0d06caSMauro Carvalho Chehab } \ 700c0d06caSMauro Carvalho Chehab } while (0) 710c0d06caSMauro Carvalho Chehab 720c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 730c0d06caSMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC); 740c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 750c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 760c0d06caSMauro Carvalho Chehab 770c0d06caSMauro Carvalho Chehab static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 780c0d06caSMauro Carvalho Chehab static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 790c0d06caSMauro Carvalho Chehab static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 800c0d06caSMauro Carvalho Chehab 810c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 820c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 830c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 840c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 850c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 860c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 870c0d06caSMauro Carvalho Chehab 880c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 890c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 900c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 910c0d06caSMauro Carvalho Chehab 920c0d06caSMauro Carvalho Chehab /* supported video standards */ 930c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 940c0d06caSMauro Carvalho Chehab { 950c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 960c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 970c0d06caSMauro Carvalho Chehab .depth = 16, 980c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 990c0d06caSMauro Carvalho Chehab }, { 1000c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1010c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1020c0d06caSMauro Carvalho Chehab .depth = 16, 1030c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1040c0d06caSMauro Carvalho Chehab }, { 1050c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1060c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1070c0d06caSMauro Carvalho Chehab .depth = 8, 1080c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1090c0d06caSMauro Carvalho Chehab }, { 1100c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1110c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1120c0d06caSMauro Carvalho Chehab .depth = 8, 1130c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1140c0d06caSMauro Carvalho Chehab }, { 1150c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1160c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1170c0d06caSMauro Carvalho Chehab .depth = 8, 1180c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1190c0d06caSMauro Carvalho Chehab }, { 1200c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1210c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1220c0d06caSMauro Carvalho Chehab .depth = 12, 1230c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1240c0d06caSMauro Carvalho Chehab }, 1250c0d06caSMauro Carvalho Chehab }; 1260c0d06caSMauro Carvalho Chehab 1270c0d06caSMauro Carvalho Chehab /* supported controls */ 1280c0d06caSMauro Carvalho Chehab /* Common to all boards */ 1290c0d06caSMauro Carvalho Chehab static struct v4l2_queryctrl ac97_qctrl[] = { 1300c0d06caSMauro Carvalho Chehab { 1310c0d06caSMauro Carvalho Chehab .id = V4L2_CID_AUDIO_VOLUME, 1320c0d06caSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_INTEGER, 1330c0d06caSMauro Carvalho Chehab .name = "Volume", 1340c0d06caSMauro Carvalho Chehab .minimum = 0x0, 1350c0d06caSMauro Carvalho Chehab .maximum = 0x1f, 1360c0d06caSMauro Carvalho Chehab .step = 0x1, 1370c0d06caSMauro Carvalho Chehab .default_value = 0x1f, 1380c0d06caSMauro Carvalho Chehab .flags = V4L2_CTRL_FLAG_SLIDER, 1390c0d06caSMauro Carvalho Chehab }, { 1400c0d06caSMauro Carvalho Chehab .id = V4L2_CID_AUDIO_MUTE, 1410c0d06caSMauro Carvalho Chehab .type = V4L2_CTRL_TYPE_BOOLEAN, 1420c0d06caSMauro Carvalho Chehab .name = "Mute", 1430c0d06caSMauro Carvalho Chehab .minimum = 0, 1440c0d06caSMauro Carvalho Chehab .maximum = 1, 1450c0d06caSMauro Carvalho Chehab .step = 1, 1460c0d06caSMauro Carvalho Chehab .default_value = 1, 1470c0d06caSMauro Carvalho Chehab .flags = 0, 1480c0d06caSMauro Carvalho Chehab } 1490c0d06caSMauro Carvalho Chehab }; 1500c0d06caSMauro Carvalho Chehab 1510c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1520c0d06caSMauro Carvalho Chehab DMA and thread functions 1530c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 1540c0d06caSMauro Carvalho Chehab 1550c0d06caSMauro Carvalho Chehab /* 1560c0d06caSMauro Carvalho Chehab * Announces that a buffer were filled and request the next 1570c0d06caSMauro Carvalho Chehab */ 1580c0d06caSMauro Carvalho Chehab static inline void buffer_filled(struct em28xx *dev, 1590c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *dma_q, 1600c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 1610c0d06caSMauro Carvalho Chehab { 1620c0d06caSMauro Carvalho Chehab /* Advice that buffer was filled */ 1630c0d06caSMauro Carvalho Chehab em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->vb.i); 1640c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_DONE; 1650c0d06caSMauro Carvalho Chehab buf->vb.field_count++; 1660c0d06caSMauro Carvalho Chehab do_gettimeofday(&buf->vb.ts); 1670c0d06caSMauro Carvalho Chehab 1680c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vid_buf = NULL; 1690c0d06caSMauro Carvalho Chehab 1700c0d06caSMauro Carvalho Chehab list_del(&buf->vb.queue); 1710c0d06caSMauro Carvalho Chehab wake_up(&buf->vb.done); 1720c0d06caSMauro Carvalho Chehab } 1730c0d06caSMauro Carvalho Chehab 1740c0d06caSMauro Carvalho Chehab static inline void vbi_buffer_filled(struct em28xx *dev, 1750c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *dma_q, 1760c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 1770c0d06caSMauro Carvalho Chehab { 1780c0d06caSMauro Carvalho Chehab /* Advice that buffer was filled */ 1790c0d06caSMauro Carvalho Chehab em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->vb.i); 1800c0d06caSMauro Carvalho Chehab 1810c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_DONE; 1820c0d06caSMauro Carvalho Chehab buf->vb.field_count++; 1830c0d06caSMauro Carvalho Chehab do_gettimeofday(&buf->vb.ts); 1840c0d06caSMauro Carvalho Chehab 1850c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vbi_buf = NULL; 1860c0d06caSMauro Carvalho Chehab 1870c0d06caSMauro Carvalho Chehab list_del(&buf->vb.queue); 1880c0d06caSMauro Carvalho Chehab wake_up(&buf->vb.done); 1890c0d06caSMauro Carvalho Chehab } 1900c0d06caSMauro Carvalho Chehab 1910c0d06caSMauro Carvalho Chehab /* 1920c0d06caSMauro Carvalho Chehab * Identify the buffer header type and properly handles 1930c0d06caSMauro Carvalho Chehab */ 1940c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 1950c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *dma_q, 1960c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 1970c0d06caSMauro Carvalho Chehab unsigned char *p, 1980c0d06caSMauro Carvalho Chehab unsigned char *outp, unsigned long len) 1990c0d06caSMauro Carvalho Chehab { 2000c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 2010c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 2020c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 2030c0d06caSMauro Carvalho Chehab 2040c0d06caSMauro Carvalho Chehab if (dma_q->pos + len > buf->vb.size) 2050c0d06caSMauro Carvalho Chehab len = buf->vb.size - dma_q->pos; 2060c0d06caSMauro Carvalho Chehab 2070c0d06caSMauro Carvalho Chehab startread = p; 2080c0d06caSMauro Carvalho Chehab remain = len; 2090c0d06caSMauro Carvalho Chehab 2100c0d06caSMauro Carvalho Chehab if (dev->progressive) 2110c0d06caSMauro Carvalho Chehab fieldstart = outp; 2120c0d06caSMauro Carvalho Chehab else { 2130c0d06caSMauro Carvalho Chehab /* Interlaces two half frames */ 2140c0d06caSMauro Carvalho Chehab if (buf->top_field) 2150c0d06caSMauro Carvalho Chehab fieldstart = outp; 2160c0d06caSMauro Carvalho Chehab else 2170c0d06caSMauro Carvalho Chehab fieldstart = outp + bytesperline; 2180c0d06caSMauro Carvalho Chehab } 2190c0d06caSMauro Carvalho Chehab 2200c0d06caSMauro Carvalho Chehab linesdone = dma_q->pos / bytesperline; 2210c0d06caSMauro Carvalho Chehab currlinedone = dma_q->pos % bytesperline; 2220c0d06caSMauro Carvalho Chehab 2230c0d06caSMauro Carvalho Chehab if (dev->progressive) 2240c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 2250c0d06caSMauro Carvalho Chehab else 2260c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 2270c0d06caSMauro Carvalho Chehab 2280c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 2290c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 2300c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 2310c0d06caSMauro Carvalho Chehab 2320c0d06caSMauro Carvalho Chehab if ((char *)startwrite + lencopy > (char *)outp + buf->vb.size) { 2330c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 2340c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 2350c0d06caSMauro Carvalho Chehab ((char *)outp + buf->vb.size)); 2360c0d06caSMauro Carvalho Chehab remain = (char *)outp + buf->vb.size - (char *)startwrite; 2370c0d06caSMauro Carvalho Chehab lencopy = remain; 2380c0d06caSMauro Carvalho Chehab } 2390c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2400c0d06caSMauro Carvalho Chehab return; 2410c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2420c0d06caSMauro Carvalho Chehab 2430c0d06caSMauro Carvalho Chehab remain -= lencopy; 2440c0d06caSMauro Carvalho Chehab 2450c0d06caSMauro Carvalho Chehab while (remain > 0) { 2460c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 2470c0d06caSMauro Carvalho Chehab startread += lencopy; 2480c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 2490c0d06caSMauro Carvalho Chehab lencopy = remain; 2500c0d06caSMauro Carvalho Chehab else 2510c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 2520c0d06caSMauro Carvalho Chehab 2530c0d06caSMauro Carvalho Chehab if ((char *)startwrite + lencopy > (char *)outp + 2540c0d06caSMauro Carvalho Chehab buf->vb.size) { 2550c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 2560c0d06caSMauro Carvalho Chehab "(2)\n", 2570c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 2580c0d06caSMauro Carvalho Chehab ((char *)outp + buf->vb.size)); 2590c0d06caSMauro Carvalho Chehab lencopy = remain = (char *)outp + buf->vb.size - 2600c0d06caSMauro Carvalho Chehab (char *)startwrite; 2610c0d06caSMauro Carvalho Chehab } 2620c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2630c0d06caSMauro Carvalho Chehab break; 2640c0d06caSMauro Carvalho Chehab 2650c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2660c0d06caSMauro Carvalho Chehab 2670c0d06caSMauro Carvalho Chehab remain -= lencopy; 2680c0d06caSMauro Carvalho Chehab } 2690c0d06caSMauro Carvalho Chehab 2700c0d06caSMauro Carvalho Chehab dma_q->pos += len; 2710c0d06caSMauro Carvalho Chehab } 2720c0d06caSMauro Carvalho Chehab 2730c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 2740c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *dma_q, 2750c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 2760c0d06caSMauro Carvalho Chehab unsigned char *p, 2770c0d06caSMauro Carvalho Chehab unsigned char *outp, unsigned long len) 2780c0d06caSMauro Carvalho Chehab { 2790c0d06caSMauro Carvalho Chehab void *startwrite, *startread; 2800c0d06caSMauro Carvalho Chehab int offset; 2810c0d06caSMauro Carvalho Chehab int bytesperline; 2820c0d06caSMauro Carvalho Chehab 2830c0d06caSMauro Carvalho Chehab if (dev == NULL) { 2840c0d06caSMauro Carvalho Chehab em28xx_isocdbg("dev is null\n"); 2850c0d06caSMauro Carvalho Chehab return; 2860c0d06caSMauro Carvalho Chehab } 2870c0d06caSMauro Carvalho Chehab bytesperline = dev->vbi_width; 2880c0d06caSMauro Carvalho Chehab 2890c0d06caSMauro Carvalho Chehab if (dma_q == NULL) { 2900c0d06caSMauro Carvalho Chehab em28xx_isocdbg("dma_q is null\n"); 2910c0d06caSMauro Carvalho Chehab return; 2920c0d06caSMauro Carvalho Chehab } 2930c0d06caSMauro Carvalho Chehab if (buf == NULL) { 2940c0d06caSMauro Carvalho Chehab return; 2950c0d06caSMauro Carvalho Chehab } 2960c0d06caSMauro Carvalho Chehab if (p == NULL) { 2970c0d06caSMauro Carvalho Chehab em28xx_isocdbg("p is null\n"); 2980c0d06caSMauro Carvalho Chehab return; 2990c0d06caSMauro Carvalho Chehab } 3000c0d06caSMauro Carvalho Chehab if (outp == NULL) { 3010c0d06caSMauro Carvalho Chehab em28xx_isocdbg("outp is null\n"); 3020c0d06caSMauro Carvalho Chehab return; 3030c0d06caSMauro Carvalho Chehab } 3040c0d06caSMauro Carvalho Chehab 3050c0d06caSMauro Carvalho Chehab if (dma_q->pos + len > buf->vb.size) 3060c0d06caSMauro Carvalho Chehab len = buf->vb.size - dma_q->pos; 3070c0d06caSMauro Carvalho Chehab 3080c0d06caSMauro Carvalho Chehab startread = p; 3090c0d06caSMauro Carvalho Chehab 3100c0d06caSMauro Carvalho Chehab startwrite = outp + dma_q->pos; 3110c0d06caSMauro Carvalho Chehab offset = dma_q->pos; 3120c0d06caSMauro Carvalho Chehab 3130c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 3140c0d06caSMauro Carvalho Chehab if (buf->top_field == 0) { 3150c0d06caSMauro Carvalho Chehab startwrite += bytesperline * dev->vbi_height; 3160c0d06caSMauro Carvalho Chehab offset += bytesperline * dev->vbi_height; 3170c0d06caSMauro Carvalho Chehab } 3180c0d06caSMauro Carvalho Chehab 3190c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, len); 3200c0d06caSMauro Carvalho Chehab dma_q->pos += len; 3210c0d06caSMauro Carvalho Chehab } 3220c0d06caSMauro Carvalho Chehab 3230c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 3240c0d06caSMauro Carvalho Chehab int packet, int status) 3250c0d06caSMauro Carvalho Chehab { 3260c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 3270c0d06caSMauro Carvalho Chehab 3280c0d06caSMauro Carvalho Chehab switch (status) { 3290c0d06caSMauro Carvalho Chehab case -ENOENT: 3300c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 3310c0d06caSMauro Carvalho Chehab break; 3320c0d06caSMauro Carvalho Chehab case -ECONNRESET: 3330c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 3340c0d06caSMauro Carvalho Chehab break; 3350c0d06caSMauro Carvalho Chehab case -ENOSR: 3360c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 3370c0d06caSMauro Carvalho Chehab break; 3380c0d06caSMauro Carvalho Chehab case -EPIPE: 3390c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 3400c0d06caSMauro Carvalho Chehab break; 3410c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 3420c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 3430c0d06caSMauro Carvalho Chehab break; 3440c0d06caSMauro Carvalho Chehab case -EPROTO: 3450c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 3460c0d06caSMauro Carvalho Chehab break; 3470c0d06caSMauro Carvalho Chehab case -EILSEQ: 3480c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 3490c0d06caSMauro Carvalho Chehab break; 3500c0d06caSMauro Carvalho Chehab case -ETIME: 3510c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 3520c0d06caSMauro Carvalho Chehab break; 3530c0d06caSMauro Carvalho Chehab } 3540c0d06caSMauro Carvalho Chehab if (packet < 0) { 3550c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 3560c0d06caSMauro Carvalho Chehab } else { 3570c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 3580c0d06caSMauro Carvalho Chehab packet, status, errmsg); 3590c0d06caSMauro Carvalho Chehab } 3600c0d06caSMauro Carvalho Chehab } 3610c0d06caSMauro Carvalho Chehab 3620c0d06caSMauro Carvalho Chehab /* 3630c0d06caSMauro Carvalho Chehab * video-buf generic routine to get the next available buffer 3640c0d06caSMauro Carvalho Chehab */ 3650c0d06caSMauro Carvalho Chehab static inline void get_next_buf(struct em28xx_dmaqueue *dma_q, 3660c0d06caSMauro Carvalho Chehab struct em28xx_buffer **buf) 3670c0d06caSMauro Carvalho Chehab { 3680c0d06caSMauro Carvalho Chehab struct em28xx *dev = container_of(dma_q, struct em28xx, vidq); 3690c0d06caSMauro Carvalho Chehab char *outp; 3700c0d06caSMauro Carvalho Chehab 3710c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 3720c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 3730c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vid_buf = NULL; 3740c0d06caSMauro Carvalho Chehab *buf = NULL; 3750c0d06caSMauro Carvalho Chehab return; 3760c0d06caSMauro Carvalho Chehab } 3770c0d06caSMauro Carvalho Chehab 3780c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 3790c0d06caSMauro Carvalho Chehab *buf = list_entry(dma_q->active.next, struct em28xx_buffer, vb.queue); 3800c0d06caSMauro Carvalho Chehab 3810c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 3820c0d06caSMauro Carvalho Chehab outp = videobuf_to_vmalloc(&(*buf)->vb); 3830c0d06caSMauro Carvalho Chehab memset(outp, 0, (*buf)->vb.size); 3840c0d06caSMauro Carvalho Chehab 3850c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vid_buf = *buf; 3860c0d06caSMauro Carvalho Chehab 3870c0d06caSMauro Carvalho Chehab return; 3880c0d06caSMauro Carvalho Chehab } 3890c0d06caSMauro Carvalho Chehab 3900c0d06caSMauro Carvalho Chehab /* 3910c0d06caSMauro Carvalho Chehab * video-buf generic routine to get the next available VBI buffer 3920c0d06caSMauro Carvalho Chehab */ 3930c0d06caSMauro Carvalho Chehab static inline void vbi_get_next_buf(struct em28xx_dmaqueue *dma_q, 3940c0d06caSMauro Carvalho Chehab struct em28xx_buffer **buf) 3950c0d06caSMauro Carvalho Chehab { 3960c0d06caSMauro Carvalho Chehab struct em28xx *dev = container_of(dma_q, struct em28xx, vbiq); 3970c0d06caSMauro Carvalho Chehab char *outp; 3980c0d06caSMauro Carvalho Chehab 3990c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 4000c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 4010c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vbi_buf = NULL; 4020c0d06caSMauro Carvalho Chehab *buf = NULL; 4030c0d06caSMauro Carvalho Chehab return; 4040c0d06caSMauro Carvalho Chehab } 4050c0d06caSMauro Carvalho Chehab 4060c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 4070c0d06caSMauro Carvalho Chehab *buf = list_entry(dma_q->active.next, struct em28xx_buffer, vb.queue); 4080c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 4090c0d06caSMauro Carvalho Chehab outp = videobuf_to_vmalloc(&(*buf)->vb); 4100c0d06caSMauro Carvalho Chehab memset(outp, 0x00, (*buf)->vb.size); 4110c0d06caSMauro Carvalho Chehab 4120c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vbi_buf = *buf; 4130c0d06caSMauro Carvalho Chehab 4140c0d06caSMauro Carvalho Chehab return; 4150c0d06caSMauro Carvalho Chehab } 4160c0d06caSMauro Carvalho Chehab 4170c0d06caSMauro Carvalho Chehab /* 4180c0d06caSMauro Carvalho Chehab * Controls the isoc copy of each urb packet 4190c0d06caSMauro Carvalho Chehab */ 4200c0d06caSMauro Carvalho Chehab static inline int em28xx_isoc_copy(struct em28xx *dev, struct urb *urb) 4210c0d06caSMauro Carvalho Chehab { 4220c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf; 4230c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *dma_q = &dev->vidq; 4240c0d06caSMauro Carvalho Chehab unsigned char *outp = NULL; 4250c0d06caSMauro Carvalho Chehab int i, len = 0, rc = 1; 4260c0d06caSMauro Carvalho Chehab unsigned char *p; 4270c0d06caSMauro Carvalho Chehab 4280c0d06caSMauro Carvalho Chehab if (!dev) 4290c0d06caSMauro Carvalho Chehab return 0; 4300c0d06caSMauro Carvalho Chehab 4310c0d06caSMauro Carvalho Chehab if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED)) 4320c0d06caSMauro Carvalho Chehab return 0; 4330c0d06caSMauro Carvalho Chehab 4340c0d06caSMauro Carvalho Chehab if (urb->status < 0) { 4350c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 4360c0d06caSMauro Carvalho Chehab if (urb->status == -ENOENT) 4370c0d06caSMauro Carvalho Chehab return 0; 4380c0d06caSMauro Carvalho Chehab } 4390c0d06caSMauro Carvalho Chehab 4400c0d06caSMauro Carvalho Chehab buf = dev->isoc_ctl.vid_buf; 4410c0d06caSMauro Carvalho Chehab if (buf != NULL) 4420c0d06caSMauro Carvalho Chehab outp = videobuf_to_vmalloc(&buf->vb); 4430c0d06caSMauro Carvalho Chehab 4440c0d06caSMauro Carvalho Chehab for (i = 0; i < urb->number_of_packets; i++) { 4450c0d06caSMauro Carvalho Chehab int status = urb->iso_frame_desc[i].status; 4460c0d06caSMauro Carvalho Chehab 4470c0d06caSMauro Carvalho Chehab if (status < 0) { 4480c0d06caSMauro Carvalho Chehab print_err_status(dev, i, status); 4490c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 4500c0d06caSMauro Carvalho Chehab continue; 4510c0d06caSMauro Carvalho Chehab } 4520c0d06caSMauro Carvalho Chehab 4530c0d06caSMauro Carvalho Chehab len = urb->iso_frame_desc[i].actual_length - 4; 4540c0d06caSMauro Carvalho Chehab 4550c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].actual_length <= 0) { 4560c0d06caSMauro Carvalho Chehab /* em28xx_isocdbg("packet %d is empty",i); - spammy */ 4570c0d06caSMauro Carvalho Chehab continue; 4580c0d06caSMauro Carvalho Chehab } 4590c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].actual_length > 4600c0d06caSMauro Carvalho Chehab dev->max_pkt_size) { 4610c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 4620c0d06caSMauro Carvalho Chehab continue; 4630c0d06caSMauro Carvalho Chehab } 4640c0d06caSMauro Carvalho Chehab 4650c0d06caSMauro Carvalho Chehab p = urb->transfer_buffer + urb->iso_frame_desc[i].offset; 4660c0d06caSMauro Carvalho Chehab 4670c0d06caSMauro Carvalho Chehab /* FIXME: incomplete buffer checks where removed to make 4680c0d06caSMauro Carvalho Chehab logic simpler. Impacts of those changes should be evaluated 4690c0d06caSMauro Carvalho Chehab */ 4700c0d06caSMauro Carvalho Chehab if (p[0] == 0x33 && p[1] == 0x95 && p[2] == 0x00) { 4710c0d06caSMauro Carvalho Chehab em28xx_isocdbg("VBI HEADER!!!\n"); 4720c0d06caSMauro Carvalho Chehab /* FIXME: Should add vbi copy */ 4730c0d06caSMauro Carvalho Chehab continue; 4740c0d06caSMauro Carvalho Chehab } 4750c0d06caSMauro Carvalho Chehab if (p[0] == 0x22 && p[1] == 0x5a) { 4760c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Video frame %d, length=%i, %s\n", p[2], 4770c0d06caSMauro Carvalho Chehab len, (p[2] & 1) ? "odd" : "even"); 4780c0d06caSMauro Carvalho Chehab 4790c0d06caSMauro Carvalho Chehab if (dev->progressive || !(p[2] & 1)) { 4800c0d06caSMauro Carvalho Chehab if (buf != NULL) 4810c0d06caSMauro Carvalho Chehab buffer_filled(dev, dma_q, buf); 4820c0d06caSMauro Carvalho Chehab get_next_buf(dma_q, &buf); 4830c0d06caSMauro Carvalho Chehab if (buf == NULL) 4840c0d06caSMauro Carvalho Chehab outp = NULL; 4850c0d06caSMauro Carvalho Chehab else 4860c0d06caSMauro Carvalho Chehab outp = videobuf_to_vmalloc(&buf->vb); 4870c0d06caSMauro Carvalho Chehab } 4880c0d06caSMauro Carvalho Chehab 4890c0d06caSMauro Carvalho Chehab if (buf != NULL) { 4900c0d06caSMauro Carvalho Chehab if (p[2] & 1) 4910c0d06caSMauro Carvalho Chehab buf->top_field = 0; 4920c0d06caSMauro Carvalho Chehab else 4930c0d06caSMauro Carvalho Chehab buf->top_field = 1; 4940c0d06caSMauro Carvalho Chehab } 4950c0d06caSMauro Carvalho Chehab 4960c0d06caSMauro Carvalho Chehab dma_q->pos = 0; 4970c0d06caSMauro Carvalho Chehab } 4980c0d06caSMauro Carvalho Chehab if (buf != NULL) { 4990c0d06caSMauro Carvalho Chehab if (p[0] != 0x88 && p[0] != 0x22) { 5000c0d06caSMauro Carvalho Chehab em28xx_isocdbg("frame is not complete\n"); 5010c0d06caSMauro Carvalho Chehab len += 4; 5020c0d06caSMauro Carvalho Chehab } else { 5030c0d06caSMauro Carvalho Chehab p += 4; 5040c0d06caSMauro Carvalho Chehab } 5050c0d06caSMauro Carvalho Chehab em28xx_copy_video(dev, dma_q, buf, p, outp, len); 5060c0d06caSMauro Carvalho Chehab } 5070c0d06caSMauro Carvalho Chehab } 5080c0d06caSMauro Carvalho Chehab return rc; 5090c0d06caSMauro Carvalho Chehab } 5100c0d06caSMauro Carvalho Chehab 5110c0d06caSMauro Carvalho Chehab /* Version of isoc handler that takes into account a mixture of video and 5120c0d06caSMauro Carvalho Chehab VBI data */ 5130c0d06caSMauro Carvalho Chehab static inline int em28xx_isoc_copy_vbi(struct em28xx *dev, struct urb *urb) 5140c0d06caSMauro Carvalho Chehab { 5150c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, *vbi_buf; 5160c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *dma_q = &dev->vidq; 5170c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 5180c0d06caSMauro Carvalho Chehab unsigned char *outp = NULL; 5190c0d06caSMauro Carvalho Chehab unsigned char *vbioutp = NULL; 5200c0d06caSMauro Carvalho Chehab int i, len = 0, rc = 1; 5210c0d06caSMauro Carvalho Chehab unsigned char *p; 5220c0d06caSMauro Carvalho Chehab int vbi_size; 5230c0d06caSMauro Carvalho Chehab 5240c0d06caSMauro Carvalho Chehab if (!dev) 5250c0d06caSMauro Carvalho Chehab return 0; 5260c0d06caSMauro Carvalho Chehab 5270c0d06caSMauro Carvalho Chehab if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED)) 5280c0d06caSMauro Carvalho Chehab return 0; 5290c0d06caSMauro Carvalho Chehab 5300c0d06caSMauro Carvalho Chehab if (urb->status < 0) { 5310c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 5320c0d06caSMauro Carvalho Chehab if (urb->status == -ENOENT) 5330c0d06caSMauro Carvalho Chehab return 0; 5340c0d06caSMauro Carvalho Chehab } 5350c0d06caSMauro Carvalho Chehab 5360c0d06caSMauro Carvalho Chehab buf = dev->isoc_ctl.vid_buf; 5370c0d06caSMauro Carvalho Chehab if (buf != NULL) 5380c0d06caSMauro Carvalho Chehab outp = videobuf_to_vmalloc(&buf->vb); 5390c0d06caSMauro Carvalho Chehab 5400c0d06caSMauro Carvalho Chehab vbi_buf = dev->isoc_ctl.vbi_buf; 5410c0d06caSMauro Carvalho Chehab if (vbi_buf != NULL) 5420c0d06caSMauro Carvalho Chehab vbioutp = videobuf_to_vmalloc(&vbi_buf->vb); 5430c0d06caSMauro Carvalho Chehab 5440c0d06caSMauro Carvalho Chehab for (i = 0; i < urb->number_of_packets; i++) { 5450c0d06caSMauro Carvalho Chehab int status = urb->iso_frame_desc[i].status; 5460c0d06caSMauro Carvalho Chehab 5470c0d06caSMauro Carvalho Chehab if (status < 0) { 5480c0d06caSMauro Carvalho Chehab print_err_status(dev, i, status); 5490c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 5500c0d06caSMauro Carvalho Chehab continue; 5510c0d06caSMauro Carvalho Chehab } 5520c0d06caSMauro Carvalho Chehab 5530c0d06caSMauro Carvalho Chehab len = urb->iso_frame_desc[i].actual_length; 5540c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].actual_length <= 0) { 5550c0d06caSMauro Carvalho Chehab /* em28xx_isocdbg("packet %d is empty",i); - spammy */ 5560c0d06caSMauro Carvalho Chehab continue; 5570c0d06caSMauro Carvalho Chehab } 5580c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].actual_length > 5590c0d06caSMauro Carvalho Chehab dev->max_pkt_size) { 5600c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 5610c0d06caSMauro Carvalho Chehab continue; 5620c0d06caSMauro Carvalho Chehab } 5630c0d06caSMauro Carvalho Chehab 5640c0d06caSMauro Carvalho Chehab p = urb->transfer_buffer + urb->iso_frame_desc[i].offset; 5650c0d06caSMauro Carvalho Chehab 5660c0d06caSMauro Carvalho Chehab /* capture type 0 = vbi start 5670c0d06caSMauro Carvalho Chehab capture type 1 = video start 5680c0d06caSMauro Carvalho Chehab capture type 2 = video in progress */ 5690c0d06caSMauro Carvalho Chehab if (p[0] == 0x33 && p[1] == 0x95) { 5700c0d06caSMauro Carvalho Chehab dev->capture_type = 0; 5710c0d06caSMauro Carvalho Chehab dev->vbi_read = 0; 5720c0d06caSMauro Carvalho Chehab em28xx_isocdbg("VBI START HEADER!!!\n"); 5730c0d06caSMauro Carvalho Chehab dev->cur_field = p[2]; 5740c0d06caSMauro Carvalho Chehab p += 4; 5750c0d06caSMauro Carvalho Chehab len -= 4; 5760c0d06caSMauro Carvalho Chehab } else if (p[0] == 0x88 && p[1] == 0x88 && 5770c0d06caSMauro Carvalho Chehab p[2] == 0x88 && p[3] == 0x88) { 5780c0d06caSMauro Carvalho Chehab /* continuation */ 5790c0d06caSMauro Carvalho Chehab p += 4; 5800c0d06caSMauro Carvalho Chehab len -= 4; 5810c0d06caSMauro Carvalho Chehab } else if (p[0] == 0x22 && p[1] == 0x5a) { 5820c0d06caSMauro Carvalho Chehab /* start video */ 5830c0d06caSMauro Carvalho Chehab p += 4; 5840c0d06caSMauro Carvalho Chehab len -= 4; 5850c0d06caSMauro Carvalho Chehab } 5860c0d06caSMauro Carvalho Chehab 5870c0d06caSMauro Carvalho Chehab vbi_size = dev->vbi_width * dev->vbi_height; 5880c0d06caSMauro Carvalho Chehab 5890c0d06caSMauro Carvalho Chehab if (dev->capture_type == 0) { 5900c0d06caSMauro Carvalho Chehab if (dev->vbi_read >= vbi_size) { 5910c0d06caSMauro Carvalho Chehab /* We've already read all the VBI data, so 5920c0d06caSMauro Carvalho Chehab treat the rest as video */ 5930c0d06caSMauro Carvalho Chehab em28xx_isocdbg("dev->vbi_read > vbi_size\n"); 5940c0d06caSMauro Carvalho Chehab } else if ((dev->vbi_read + len) < vbi_size) { 5950c0d06caSMauro Carvalho Chehab /* This entire frame is VBI data */ 5960c0d06caSMauro Carvalho Chehab if (dev->vbi_read == 0 && 5970c0d06caSMauro Carvalho Chehab (!(dev->cur_field & 1))) { 5980c0d06caSMauro Carvalho Chehab /* Brand new frame */ 5990c0d06caSMauro Carvalho Chehab if (vbi_buf != NULL) 6000c0d06caSMauro Carvalho Chehab vbi_buffer_filled(dev, 6010c0d06caSMauro Carvalho Chehab vbi_dma_q, 6020c0d06caSMauro Carvalho Chehab vbi_buf); 6030c0d06caSMauro Carvalho Chehab vbi_get_next_buf(vbi_dma_q, &vbi_buf); 6040c0d06caSMauro Carvalho Chehab if (vbi_buf == NULL) 6050c0d06caSMauro Carvalho Chehab vbioutp = NULL; 6060c0d06caSMauro Carvalho Chehab else 6070c0d06caSMauro Carvalho Chehab vbioutp = videobuf_to_vmalloc( 6080c0d06caSMauro Carvalho Chehab &vbi_buf->vb); 6090c0d06caSMauro Carvalho Chehab } 6100c0d06caSMauro Carvalho Chehab 6110c0d06caSMauro Carvalho Chehab if (dev->vbi_read == 0) { 6120c0d06caSMauro Carvalho Chehab vbi_dma_q->pos = 0; 6130c0d06caSMauro Carvalho Chehab if (vbi_buf != NULL) { 6140c0d06caSMauro Carvalho Chehab if (dev->cur_field & 1) 6150c0d06caSMauro Carvalho Chehab vbi_buf->top_field = 0; 6160c0d06caSMauro Carvalho Chehab else 6170c0d06caSMauro Carvalho Chehab vbi_buf->top_field = 1; 6180c0d06caSMauro Carvalho Chehab } 6190c0d06caSMauro Carvalho Chehab } 6200c0d06caSMauro Carvalho Chehab 6210c0d06caSMauro Carvalho Chehab dev->vbi_read += len; 6220c0d06caSMauro Carvalho Chehab em28xx_copy_vbi(dev, vbi_dma_q, vbi_buf, p, 6230c0d06caSMauro Carvalho Chehab vbioutp, len); 6240c0d06caSMauro Carvalho Chehab } else { 6250c0d06caSMauro Carvalho Chehab /* Some of this frame is VBI data and some is 6260c0d06caSMauro Carvalho Chehab video data */ 6270c0d06caSMauro Carvalho Chehab int vbi_data_len = vbi_size - dev->vbi_read; 6280c0d06caSMauro Carvalho Chehab dev->vbi_read += vbi_data_len; 6290c0d06caSMauro Carvalho Chehab em28xx_copy_vbi(dev, vbi_dma_q, vbi_buf, p, 6300c0d06caSMauro Carvalho Chehab vbioutp, vbi_data_len); 6310c0d06caSMauro Carvalho Chehab dev->capture_type = 1; 6320c0d06caSMauro Carvalho Chehab p += vbi_data_len; 6330c0d06caSMauro Carvalho Chehab len -= vbi_data_len; 6340c0d06caSMauro Carvalho Chehab } 6350c0d06caSMauro Carvalho Chehab } 6360c0d06caSMauro Carvalho Chehab 6370c0d06caSMauro Carvalho Chehab if (dev->capture_type == 1) { 6380c0d06caSMauro Carvalho Chehab dev->capture_type = 2; 6390c0d06caSMauro Carvalho Chehab if (dev->progressive || !(dev->cur_field & 1)) { 6400c0d06caSMauro Carvalho Chehab if (buf != NULL) 6410c0d06caSMauro Carvalho Chehab buffer_filled(dev, dma_q, buf); 6420c0d06caSMauro Carvalho Chehab get_next_buf(dma_q, &buf); 6430c0d06caSMauro Carvalho Chehab if (buf == NULL) 6440c0d06caSMauro Carvalho Chehab outp = NULL; 6450c0d06caSMauro Carvalho Chehab else 6460c0d06caSMauro Carvalho Chehab outp = videobuf_to_vmalloc(&buf->vb); 6470c0d06caSMauro Carvalho Chehab } 6480c0d06caSMauro Carvalho Chehab if (buf != NULL) { 6490c0d06caSMauro Carvalho Chehab if (dev->cur_field & 1) 6500c0d06caSMauro Carvalho Chehab buf->top_field = 0; 6510c0d06caSMauro Carvalho Chehab else 6520c0d06caSMauro Carvalho Chehab buf->top_field = 1; 6530c0d06caSMauro Carvalho Chehab } 6540c0d06caSMauro Carvalho Chehab 6550c0d06caSMauro Carvalho Chehab dma_q->pos = 0; 6560c0d06caSMauro Carvalho Chehab } 6570c0d06caSMauro Carvalho Chehab 6580c0d06caSMauro Carvalho Chehab if (buf != NULL && dev->capture_type == 2) { 6590c0d06caSMauro Carvalho Chehab if (len >= 4 && p[0] == 0x88 && p[1] == 0x88 && 6600c0d06caSMauro Carvalho Chehab p[2] == 0x88 && p[3] == 0x88) { 6610c0d06caSMauro Carvalho Chehab p += 4; 6620c0d06caSMauro Carvalho Chehab len -= 4; 6630c0d06caSMauro Carvalho Chehab } 6640c0d06caSMauro Carvalho Chehab if (len >= 4 && p[0] == 0x22 && p[1] == 0x5a) { 6650c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Video frame %d, len=%i, %s\n", 6660c0d06caSMauro Carvalho Chehab p[2], len, (p[2] & 1) ? 6670c0d06caSMauro Carvalho Chehab "odd" : "even"); 6680c0d06caSMauro Carvalho Chehab p += 4; 6690c0d06caSMauro Carvalho Chehab len -= 4; 6700c0d06caSMauro Carvalho Chehab } 6710c0d06caSMauro Carvalho Chehab 6720c0d06caSMauro Carvalho Chehab if (len > 0) 6730c0d06caSMauro Carvalho Chehab em28xx_copy_video(dev, dma_q, buf, p, outp, 6740c0d06caSMauro Carvalho Chehab len); 6750c0d06caSMauro Carvalho Chehab } 6760c0d06caSMauro Carvalho Chehab } 6770c0d06caSMauro Carvalho Chehab return rc; 6780c0d06caSMauro Carvalho Chehab } 6790c0d06caSMauro Carvalho Chehab 6800c0d06caSMauro Carvalho Chehab 6810c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 6820c0d06caSMauro Carvalho Chehab Videobuf operations 6830c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 6840c0d06caSMauro Carvalho Chehab 6850c0d06caSMauro Carvalho Chehab static int 6860c0d06caSMauro Carvalho Chehab buffer_setup(struct videobuf_queue *vq, unsigned int *count, unsigned int *size) 6870c0d06caSMauro Carvalho Chehab { 6880c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 6890c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 6900c0d06caSMauro Carvalho Chehab struct v4l2_frequency f; 6910c0d06caSMauro Carvalho Chehab 6920c0d06caSMauro Carvalho Chehab *size = (fh->dev->width * fh->dev->height * dev->format->depth + 7) 6930c0d06caSMauro Carvalho Chehab >> 3; 6940c0d06caSMauro Carvalho Chehab 6950c0d06caSMauro Carvalho Chehab if (0 == *count) 6960c0d06caSMauro Carvalho Chehab *count = EM28XX_DEF_BUF; 6970c0d06caSMauro Carvalho Chehab 6980c0d06caSMauro Carvalho Chehab if (*count < EM28XX_MIN_BUF) 6990c0d06caSMauro Carvalho Chehab *count = EM28XX_MIN_BUF; 7000c0d06caSMauro Carvalho Chehab 7010c0d06caSMauro Carvalho Chehab /* Ask tuner to go to analog or radio mode */ 7020c0d06caSMauro Carvalho Chehab memset(&f, 0, sizeof(f)); 7030c0d06caSMauro Carvalho Chehab f.frequency = dev->ctl_freq; 7040c0d06caSMauro Carvalho Chehab f.type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV; 7050c0d06caSMauro Carvalho Chehab 7060c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 7070c0d06caSMauro Carvalho Chehab 7080c0d06caSMauro Carvalho Chehab return 0; 7090c0d06caSMauro Carvalho Chehab } 7100c0d06caSMauro Carvalho Chehab 7110c0d06caSMauro Carvalho Chehab /* This is called *without* dev->slock held; please keep it that way */ 7120c0d06caSMauro Carvalho Chehab static void free_buffer(struct videobuf_queue *vq, struct em28xx_buffer *buf) 7130c0d06caSMauro Carvalho Chehab { 7140c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 7150c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 7160c0d06caSMauro Carvalho Chehab unsigned long flags = 0; 7170c0d06caSMauro Carvalho Chehab if (in_interrupt()) 7180c0d06caSMauro Carvalho Chehab BUG(); 7190c0d06caSMauro Carvalho Chehab 7200c0d06caSMauro Carvalho Chehab /* We used to wait for the buffer to finish here, but this didn't work 7210c0d06caSMauro Carvalho Chehab because, as we were keeping the state as VIDEOBUF_QUEUED, 7220c0d06caSMauro Carvalho Chehab videobuf_queue_cancel marked it as finished for us. 7230c0d06caSMauro Carvalho Chehab (Also, it could wedge forever if the hardware was misconfigured.) 7240c0d06caSMauro Carvalho Chehab 7250c0d06caSMauro Carvalho Chehab This should be safe; by the time we get here, the buffer isn't 7260c0d06caSMauro Carvalho Chehab queued anymore. If we ever start marking the buffers as 7270c0d06caSMauro Carvalho Chehab VIDEOBUF_ACTIVE, it won't be, though. 7280c0d06caSMauro Carvalho Chehab */ 7290c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&dev->slock, flags); 7300c0d06caSMauro Carvalho Chehab if (dev->isoc_ctl.vid_buf == buf) 7310c0d06caSMauro Carvalho Chehab dev->isoc_ctl.vid_buf = NULL; 7320c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&dev->slock, flags); 7330c0d06caSMauro Carvalho Chehab 7340c0d06caSMauro Carvalho Chehab videobuf_vmalloc_free(&buf->vb); 7350c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_NEEDS_INIT; 7360c0d06caSMauro Carvalho Chehab } 7370c0d06caSMauro Carvalho Chehab 7380c0d06caSMauro Carvalho Chehab static int 7390c0d06caSMauro Carvalho Chehab buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb, 7400c0d06caSMauro Carvalho Chehab enum v4l2_field field) 7410c0d06caSMauro Carvalho Chehab { 7420c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 7430c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 7440c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 7450c0d06caSMauro Carvalho Chehab int rc = 0, urb_init = 0; 7460c0d06caSMauro Carvalho Chehab 7470c0d06caSMauro Carvalho Chehab buf->vb.size = (fh->dev->width * fh->dev->height * dev->format->depth 7480c0d06caSMauro Carvalho Chehab + 7) >> 3; 7490c0d06caSMauro Carvalho Chehab 7500c0d06caSMauro Carvalho Chehab if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size) 7510c0d06caSMauro Carvalho Chehab return -EINVAL; 7520c0d06caSMauro Carvalho Chehab 7530c0d06caSMauro Carvalho Chehab buf->vb.width = dev->width; 7540c0d06caSMauro Carvalho Chehab buf->vb.height = dev->height; 7550c0d06caSMauro Carvalho Chehab buf->vb.field = field; 7560c0d06caSMauro Carvalho Chehab 7570c0d06caSMauro Carvalho Chehab if (VIDEOBUF_NEEDS_INIT == buf->vb.state) { 7580c0d06caSMauro Carvalho Chehab rc = videobuf_iolock(vq, &buf->vb, NULL); 7590c0d06caSMauro Carvalho Chehab if (rc < 0) 7600c0d06caSMauro Carvalho Chehab goto fail; 7610c0d06caSMauro Carvalho Chehab } 7620c0d06caSMauro Carvalho Chehab 7630c0d06caSMauro Carvalho Chehab if (!dev->isoc_ctl.analog_bufs.num_bufs) 7640c0d06caSMauro Carvalho Chehab urb_init = 1; 7650c0d06caSMauro Carvalho Chehab 7660c0d06caSMauro Carvalho Chehab if (urb_init) { 7670c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 7680c0d06caSMauro Carvalho Chehab rc = em28xx_init_isoc(dev, EM28XX_ANALOG_MODE, 7690c0d06caSMauro Carvalho Chehab EM28XX_NUM_PACKETS, 7700c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 7710c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 7720c0d06caSMauro Carvalho Chehab em28xx_isoc_copy_vbi); 7730c0d06caSMauro Carvalho Chehab else 7740c0d06caSMauro Carvalho Chehab rc = em28xx_init_isoc(dev, EM28XX_ANALOG_MODE, 7750c0d06caSMauro Carvalho Chehab EM28XX_NUM_PACKETS, 7760c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 7770c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 7780c0d06caSMauro Carvalho Chehab em28xx_isoc_copy); 7790c0d06caSMauro Carvalho Chehab if (rc < 0) 7800c0d06caSMauro Carvalho Chehab goto fail; 7810c0d06caSMauro Carvalho Chehab } 7820c0d06caSMauro Carvalho Chehab 7830c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_PREPARED; 7840c0d06caSMauro Carvalho Chehab return 0; 7850c0d06caSMauro Carvalho Chehab 7860c0d06caSMauro Carvalho Chehab fail: 7870c0d06caSMauro Carvalho Chehab free_buffer(vq, buf); 7880c0d06caSMauro Carvalho Chehab return rc; 7890c0d06caSMauro Carvalho Chehab } 7900c0d06caSMauro Carvalho Chehab 7910c0d06caSMauro Carvalho Chehab static void 7920c0d06caSMauro Carvalho Chehab buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb) 7930c0d06caSMauro Carvalho Chehab { 7940c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, 7950c0d06caSMauro Carvalho Chehab struct em28xx_buffer, 7960c0d06caSMauro Carvalho Chehab vb); 7970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 7980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 7990c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 8000c0d06caSMauro Carvalho Chehab 8010c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_QUEUED; 8020c0d06caSMauro Carvalho Chehab list_add_tail(&buf->vb.queue, &vidq->active); 8030c0d06caSMauro Carvalho Chehab 8040c0d06caSMauro Carvalho Chehab } 8050c0d06caSMauro Carvalho Chehab 8060c0d06caSMauro Carvalho Chehab static void buffer_release(struct videobuf_queue *vq, 8070c0d06caSMauro Carvalho Chehab struct videobuf_buffer *vb) 8080c0d06caSMauro Carvalho Chehab { 8090c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, 8100c0d06caSMauro Carvalho Chehab struct em28xx_buffer, 8110c0d06caSMauro Carvalho Chehab vb); 8120c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 8130c0d06caSMauro Carvalho Chehab struct em28xx *dev = (struct em28xx *)fh->dev; 8140c0d06caSMauro Carvalho Chehab 8150c0d06caSMauro Carvalho Chehab em28xx_isocdbg("em28xx: called buffer_release\n"); 8160c0d06caSMauro Carvalho Chehab 8170c0d06caSMauro Carvalho Chehab free_buffer(vq, buf); 8180c0d06caSMauro Carvalho Chehab } 8190c0d06caSMauro Carvalho Chehab 8200c0d06caSMauro Carvalho Chehab static struct videobuf_queue_ops em28xx_video_qops = { 8210c0d06caSMauro Carvalho Chehab .buf_setup = buffer_setup, 8220c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 8230c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 8240c0d06caSMauro Carvalho Chehab .buf_release = buffer_release, 8250c0d06caSMauro Carvalho Chehab }; 8260c0d06caSMauro Carvalho Chehab 8270c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 8280c0d06caSMauro Carvalho Chehab 8290c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 8300c0d06caSMauro Carvalho Chehab { 8310c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 8320c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 8330c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 8340c0d06caSMauro Carvalho Chehab 8350c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 8360c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 8370c0d06caSMauro Carvalho Chehab 8380c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 8390c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 8400c0d06caSMauro Carvalho Chehab 8410c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 8420c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 8430c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 8440c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 8450c0d06caSMauro Carvalho Chehab } 8460c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 8470c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 8480c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 8490c0d06caSMauro Carvalho Chehab } 8500c0d06caSMauro Carvalho Chehab 8510c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 8520c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 8530c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 8540c0d06caSMauro Carvalho Chehab } 8550c0d06caSMauro Carvalho Chehab 8560c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 8570c0d06caSMauro Carvalho Chehab } 8580c0d06caSMauro Carvalho Chehab 8590c0d06caSMauro Carvalho Chehab /* Usage lock check functions */ 8600c0d06caSMauro Carvalho Chehab static int res_get(struct em28xx_fh *fh, unsigned int bit) 8610c0d06caSMauro Carvalho Chehab { 8620c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8630c0d06caSMauro Carvalho Chehab 8640c0d06caSMauro Carvalho Chehab if (fh->resources & bit) 8650c0d06caSMauro Carvalho Chehab /* have it already allocated */ 8660c0d06caSMauro Carvalho Chehab return 1; 8670c0d06caSMauro Carvalho Chehab 8680c0d06caSMauro Carvalho Chehab /* is it free? */ 8690c0d06caSMauro Carvalho Chehab if (dev->resources & bit) { 8700c0d06caSMauro Carvalho Chehab /* no, someone else uses it */ 8710c0d06caSMauro Carvalho Chehab return 0; 8720c0d06caSMauro Carvalho Chehab } 8730c0d06caSMauro Carvalho Chehab /* it's free, grab it */ 8740c0d06caSMauro Carvalho Chehab fh->resources |= bit; 8750c0d06caSMauro Carvalho Chehab dev->resources |= bit; 8760c0d06caSMauro Carvalho Chehab em28xx_videodbg("res: get %d\n", bit); 8770c0d06caSMauro Carvalho Chehab return 1; 8780c0d06caSMauro Carvalho Chehab } 8790c0d06caSMauro Carvalho Chehab 8800c0d06caSMauro Carvalho Chehab static int res_check(struct em28xx_fh *fh, unsigned int bit) 8810c0d06caSMauro Carvalho Chehab { 8820c0d06caSMauro Carvalho Chehab return fh->resources & bit; 8830c0d06caSMauro Carvalho Chehab } 8840c0d06caSMauro Carvalho Chehab 8850c0d06caSMauro Carvalho Chehab static int res_locked(struct em28xx *dev, unsigned int bit) 8860c0d06caSMauro Carvalho Chehab { 8870c0d06caSMauro Carvalho Chehab return dev->resources & bit; 8880c0d06caSMauro Carvalho Chehab } 8890c0d06caSMauro Carvalho Chehab 8900c0d06caSMauro Carvalho Chehab static void res_free(struct em28xx_fh *fh, unsigned int bits) 8910c0d06caSMauro Carvalho Chehab { 8920c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8930c0d06caSMauro Carvalho Chehab 8940c0d06caSMauro Carvalho Chehab BUG_ON((fh->resources & bits) != bits); 8950c0d06caSMauro Carvalho Chehab 8960c0d06caSMauro Carvalho Chehab fh->resources &= ~bits; 8970c0d06caSMauro Carvalho Chehab dev->resources &= ~bits; 8980c0d06caSMauro Carvalho Chehab em28xx_videodbg("res: put %d\n", bits); 8990c0d06caSMauro Carvalho Chehab } 9000c0d06caSMauro Carvalho Chehab 9010c0d06caSMauro Carvalho Chehab static int get_ressource(struct em28xx_fh *fh) 9020c0d06caSMauro Carvalho Chehab { 9030c0d06caSMauro Carvalho Chehab switch (fh->type) { 9040c0d06caSMauro Carvalho Chehab case V4L2_BUF_TYPE_VIDEO_CAPTURE: 9050c0d06caSMauro Carvalho Chehab return EM28XX_RESOURCE_VIDEO; 9060c0d06caSMauro Carvalho Chehab case V4L2_BUF_TYPE_VBI_CAPTURE: 9070c0d06caSMauro Carvalho Chehab return EM28XX_RESOURCE_VBI; 9080c0d06caSMauro Carvalho Chehab default: 9090c0d06caSMauro Carvalho Chehab BUG(); 9100c0d06caSMauro Carvalho Chehab return 0; 9110c0d06caSMauro Carvalho Chehab } 9120c0d06caSMauro Carvalho Chehab } 9130c0d06caSMauro Carvalho Chehab 9140c0d06caSMauro Carvalho Chehab /* 9150c0d06caSMauro Carvalho Chehab * ac97_queryctrl() 9160c0d06caSMauro Carvalho Chehab * return the ac97 supported controls 9170c0d06caSMauro Carvalho Chehab */ 9180c0d06caSMauro Carvalho Chehab static int ac97_queryctrl(struct v4l2_queryctrl *qc) 9190c0d06caSMauro Carvalho Chehab { 9200c0d06caSMauro Carvalho Chehab int i; 9210c0d06caSMauro Carvalho Chehab 9220c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(ac97_qctrl); i++) { 9230c0d06caSMauro Carvalho Chehab if (qc->id && qc->id == ac97_qctrl[i].id) { 9240c0d06caSMauro Carvalho Chehab memcpy(qc, &(ac97_qctrl[i]), sizeof(*qc)); 9250c0d06caSMauro Carvalho Chehab return 0; 9260c0d06caSMauro Carvalho Chehab } 9270c0d06caSMauro Carvalho Chehab } 9280c0d06caSMauro Carvalho Chehab 9290c0d06caSMauro Carvalho Chehab /* Control is not ac97 related */ 9300c0d06caSMauro Carvalho Chehab return 1; 9310c0d06caSMauro Carvalho Chehab } 9320c0d06caSMauro Carvalho Chehab 9330c0d06caSMauro Carvalho Chehab /* 9340c0d06caSMauro Carvalho Chehab * ac97_get_ctrl() 9350c0d06caSMauro Carvalho Chehab * return the current values for ac97 mute and volume 9360c0d06caSMauro Carvalho Chehab */ 9370c0d06caSMauro Carvalho Chehab static int ac97_get_ctrl(struct em28xx *dev, struct v4l2_control *ctrl) 9380c0d06caSMauro Carvalho Chehab { 9390c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 9400c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 9410c0d06caSMauro Carvalho Chehab ctrl->value = dev->mute; 9420c0d06caSMauro Carvalho Chehab return 0; 9430c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 9440c0d06caSMauro Carvalho Chehab ctrl->value = dev->volume; 9450c0d06caSMauro Carvalho Chehab return 0; 9460c0d06caSMauro Carvalho Chehab default: 9470c0d06caSMauro Carvalho Chehab /* Control is not ac97 related */ 9480c0d06caSMauro Carvalho Chehab return 1; 9490c0d06caSMauro Carvalho Chehab } 9500c0d06caSMauro Carvalho Chehab } 9510c0d06caSMauro Carvalho Chehab 9520c0d06caSMauro Carvalho Chehab /* 9530c0d06caSMauro Carvalho Chehab * ac97_set_ctrl() 9540c0d06caSMauro Carvalho Chehab * set values for ac97 mute and volume 9550c0d06caSMauro Carvalho Chehab */ 9560c0d06caSMauro Carvalho Chehab static int ac97_set_ctrl(struct em28xx *dev, const struct v4l2_control *ctrl) 9570c0d06caSMauro Carvalho Chehab { 9580c0d06caSMauro Carvalho Chehab int i; 9590c0d06caSMauro Carvalho Chehab 9600c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(ac97_qctrl); i++) 9610c0d06caSMauro Carvalho Chehab if (ctrl->id == ac97_qctrl[i].id) 9620c0d06caSMauro Carvalho Chehab goto handle; 9630c0d06caSMauro Carvalho Chehab 9640c0d06caSMauro Carvalho Chehab /* Announce that hasn't handle it */ 9650c0d06caSMauro Carvalho Chehab return 1; 9660c0d06caSMauro Carvalho Chehab 9670c0d06caSMauro Carvalho Chehab handle: 9680c0d06caSMauro Carvalho Chehab if (ctrl->value < ac97_qctrl[i].minimum || 9690c0d06caSMauro Carvalho Chehab ctrl->value > ac97_qctrl[i].maximum) 9700c0d06caSMauro Carvalho Chehab return -ERANGE; 9710c0d06caSMauro Carvalho Chehab 9720c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 9730c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 9740c0d06caSMauro Carvalho Chehab dev->mute = ctrl->value; 9750c0d06caSMauro Carvalho Chehab break; 9760c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 9770c0d06caSMauro Carvalho Chehab dev->volume = ctrl->value; 9780c0d06caSMauro Carvalho Chehab break; 9790c0d06caSMauro Carvalho Chehab } 9800c0d06caSMauro Carvalho Chehab 9810c0d06caSMauro Carvalho Chehab return em28xx_audio_analog_set(dev); 9820c0d06caSMauro Carvalho Chehab } 9830c0d06caSMauro Carvalho Chehab 9840c0d06caSMauro Carvalho Chehab static int check_dev(struct em28xx *dev) 9850c0d06caSMauro Carvalho Chehab { 9860c0d06caSMauro Carvalho Chehab if (dev->state & DEV_DISCONNECTED) { 9870c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device not present\n"); 9880c0d06caSMauro Carvalho Chehab return -ENODEV; 9890c0d06caSMauro Carvalho Chehab } 9900c0d06caSMauro Carvalho Chehab 9910c0d06caSMauro Carvalho Chehab if (dev->state & DEV_MISCONFIGURED) { 9920c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device is misconfigured; " 9930c0d06caSMauro Carvalho Chehab "close and open it again\n"); 9940c0d06caSMauro Carvalho Chehab return -EIO; 9950c0d06caSMauro Carvalho Chehab } 9960c0d06caSMauro Carvalho Chehab return 0; 9970c0d06caSMauro Carvalho Chehab } 9980c0d06caSMauro Carvalho Chehab 9990c0d06caSMauro Carvalho Chehab static void get_scale(struct em28xx *dev, 10000c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 10010c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 10020c0d06caSMauro Carvalho Chehab { 10030c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 10040c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 10050c0d06caSMauro Carvalho Chehab 10060c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 10070c0d06caSMauro Carvalho Chehab if (*hscale >= 0x4000) 10080c0d06caSMauro Carvalho Chehab *hscale = 0x3fff; 10090c0d06caSMauro Carvalho Chehab 10100c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 10110c0d06caSMauro Carvalho Chehab if (*vscale >= 0x4000) 10120c0d06caSMauro Carvalho Chehab *vscale = 0x3fff; 10130c0d06caSMauro Carvalho Chehab } 10140c0d06caSMauro Carvalho Chehab 10150c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 10160c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 10170c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 10180c0d06caSMauro Carvalho Chehab 10190c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 10200c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 10210c0d06caSMauro Carvalho Chehab { 10220c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10230c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10240c0d06caSMauro Carvalho Chehab 10250c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 10260c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 10270c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 10280c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 10290c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 10300c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 10310c0d06caSMauro Carvalho Chehab 10320c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 10330c0d06caSMauro Carvalho Chehab if (dev->progressive) 10340c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 10350c0d06caSMauro Carvalho Chehab else 10360c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 10370c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 10380c0d06caSMauro Carvalho Chehab return 0; 10390c0d06caSMauro Carvalho Chehab } 10400c0d06caSMauro Carvalho Chehab 10410c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 10420c0d06caSMauro Carvalho Chehab { 10430c0d06caSMauro Carvalho Chehab unsigned int i; 10440c0d06caSMauro Carvalho Chehab 10450c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 10460c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 10470c0d06caSMauro Carvalho Chehab return &format[i]; 10480c0d06caSMauro Carvalho Chehab 10490c0d06caSMauro Carvalho Chehab return NULL; 10500c0d06caSMauro Carvalho Chehab } 10510c0d06caSMauro Carvalho Chehab 10520c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 10530c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 10540c0d06caSMauro Carvalho Chehab { 10550c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10560c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10570c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 10580c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 10590c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 10600c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 10610c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 10620c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 10630c0d06caSMauro Carvalho Chehab 10640c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 10650c0d06caSMauro Carvalho Chehab if (!fmt) { 10660c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 10670c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 10680c0d06caSMauro Carvalho Chehab return -EINVAL; 10690c0d06caSMauro Carvalho Chehab } 10700c0d06caSMauro Carvalho Chehab 10710c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 10720c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 10730c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 10740c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 10750c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 10760c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 10770c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 10780c0d06caSMauro Carvalho Chehab width /= 2; 10790c0d06caSMauro Carvalho Chehab } else { 10800c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 10810c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 10820c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 10830c0d06caSMauro Carvalho Chehab 1, 0); 10840c0d06caSMauro Carvalho Chehab } 10850c0d06caSMauro Carvalho Chehab 10860c0d06caSMauro Carvalho Chehab get_scale(dev, width, height, &hscale, &vscale); 10870c0d06caSMauro Carvalho Chehab 10880c0d06caSMauro Carvalho Chehab width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 10890c0d06caSMauro Carvalho Chehab height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 10900c0d06caSMauro Carvalho Chehab 10910c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 10920c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 10930c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 10940c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * fmt->depth + 7) >> 3; 10950c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 10960c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 10970c0d06caSMauro Carvalho Chehab if (dev->progressive) 10980c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 10990c0d06caSMauro Carvalho Chehab else 11000c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 11010c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 11020c0d06caSMauro Carvalho Chehab 11030c0d06caSMauro Carvalho Chehab return 0; 11040c0d06caSMauro Carvalho Chehab } 11050c0d06caSMauro Carvalho Chehab 11060c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 11070c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 11080c0d06caSMauro Carvalho Chehab { 11090c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 11100c0d06caSMauro Carvalho Chehab 11110c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 11120c0d06caSMauro Carvalho Chehab if (!fmt) 11130c0d06caSMauro Carvalho Chehab return -EINVAL; 11140c0d06caSMauro Carvalho Chehab 11150c0d06caSMauro Carvalho Chehab dev->format = fmt; 11160c0d06caSMauro Carvalho Chehab dev->width = width; 11170c0d06caSMauro Carvalho Chehab dev->height = height; 11180c0d06caSMauro Carvalho Chehab 11190c0d06caSMauro Carvalho Chehab /* set new image size */ 11200c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 11210c0d06caSMauro Carvalho Chehab 11220c0d06caSMauro Carvalho Chehab em28xx_set_alternate(dev); 11230c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 11240c0d06caSMauro Carvalho Chehab 11250c0d06caSMauro Carvalho Chehab return 0; 11260c0d06caSMauro Carvalho Chehab } 11270c0d06caSMauro Carvalho Chehab 11280c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 11290c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 11300c0d06caSMauro Carvalho Chehab { 11310c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11320c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11330c0d06caSMauro Carvalho Chehab int rc; 11340c0d06caSMauro Carvalho Chehab 11350c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11360c0d06caSMauro Carvalho Chehab if (rc < 0) 11370c0d06caSMauro Carvalho Chehab return rc; 11380c0d06caSMauro Carvalho Chehab 11390c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 11400c0d06caSMauro Carvalho Chehab 11410c0d06caSMauro Carvalho Chehab if (videobuf_queue_is_busy(&fh->vb_vidq)) { 11420c0d06caSMauro Carvalho Chehab em28xx_errdev("%s queue busy\n", __func__); 11430c0d06caSMauro Carvalho Chehab return -EBUSY; 11440c0d06caSMauro Carvalho Chehab } 11450c0d06caSMauro Carvalho Chehab 11460c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 11470c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 11480c0d06caSMauro Carvalho Chehab } 11490c0d06caSMauro Carvalho Chehab 11500c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 11510c0d06caSMauro Carvalho Chehab { 11520c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11530c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11540c0d06caSMauro Carvalho Chehab int rc; 11550c0d06caSMauro Carvalho Chehab 11560c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11570c0d06caSMauro Carvalho Chehab if (rc < 0) 11580c0d06caSMauro Carvalho Chehab return rc; 11590c0d06caSMauro Carvalho Chehab 11600c0d06caSMauro Carvalho Chehab *norm = dev->norm; 11610c0d06caSMauro Carvalho Chehab 11620c0d06caSMauro Carvalho Chehab return 0; 11630c0d06caSMauro Carvalho Chehab } 11640c0d06caSMauro Carvalho Chehab 11650c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 11660c0d06caSMauro Carvalho Chehab { 11670c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11680c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11690c0d06caSMauro Carvalho Chehab int rc; 11700c0d06caSMauro Carvalho Chehab 11710c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11720c0d06caSMauro Carvalho Chehab if (rc < 0) 11730c0d06caSMauro Carvalho Chehab return rc; 11740c0d06caSMauro Carvalho Chehab 11750c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 11760c0d06caSMauro Carvalho Chehab 11770c0d06caSMauro Carvalho Chehab return 0; 11780c0d06caSMauro Carvalho Chehab } 11790c0d06caSMauro Carvalho Chehab 11800c0d06caSMauro Carvalho Chehab static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *norm) 11810c0d06caSMauro Carvalho Chehab { 11820c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11830c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11840c0d06caSMauro Carvalho Chehab struct v4l2_format f; 11850c0d06caSMauro Carvalho Chehab int rc; 11860c0d06caSMauro Carvalho Chehab 11870c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11880c0d06caSMauro Carvalho Chehab if (rc < 0) 11890c0d06caSMauro Carvalho Chehab return rc; 11900c0d06caSMauro Carvalho Chehab 11910c0d06caSMauro Carvalho Chehab dev->norm = *norm; 11920c0d06caSMauro Carvalho Chehab 11930c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 11940c0d06caSMauro Carvalho Chehab f.fmt.pix.width = dev->width; 11950c0d06caSMauro Carvalho Chehab f.fmt.pix.height = dev->height; 11960c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 11970c0d06caSMauro Carvalho Chehab 11980c0d06caSMauro Carvalho Chehab /* set new image size */ 11990c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 12000c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 12010c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 12020c0d06caSMauro Carvalho Chehab 12030c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 12040c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 12050c0d06caSMauro Carvalho Chehab 12060c0d06caSMauro Carvalho Chehab return 0; 12070c0d06caSMauro Carvalho Chehab } 12080c0d06caSMauro Carvalho Chehab 12090c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 12100c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 12110c0d06caSMauro Carvalho Chehab { 12120c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12130c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12140c0d06caSMauro Carvalho Chehab int rc = 0; 12150c0d06caSMauro Carvalho Chehab 12160c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 12170c0d06caSMauro Carvalho Chehab return -EINVAL; 12180c0d06caSMauro Carvalho Chehab 12190c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 12200c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 12210c0d06caSMauro Carvalho Chehab video, g_parm, p); 12220c0d06caSMauro Carvalho Chehab else 12230c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 12240c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 12250c0d06caSMauro Carvalho Chehab 12260c0d06caSMauro Carvalho Chehab return rc; 12270c0d06caSMauro Carvalho Chehab } 12280c0d06caSMauro Carvalho Chehab 12290c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 12300c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 12310c0d06caSMauro Carvalho Chehab { 12320c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12330c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12340c0d06caSMauro Carvalho Chehab 12350c0d06caSMauro Carvalho Chehab if (!dev->board.is_webcam) 12360c0d06caSMauro Carvalho Chehab return -EINVAL; 12370c0d06caSMauro Carvalho Chehab 12380c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 12390c0d06caSMauro Carvalho Chehab return -EINVAL; 12400c0d06caSMauro Carvalho Chehab 12410c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 12420c0d06caSMauro Carvalho Chehab } 12430c0d06caSMauro Carvalho Chehab 12440c0d06caSMauro Carvalho Chehab static const char *iname[] = { 12450c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 12460c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 12470c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 12480c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 12490c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 12500c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 12510c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 12520c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 12530c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 12540c0d06caSMauro Carvalho Chehab }; 12550c0d06caSMauro Carvalho Chehab 12560c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 12570c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 12580c0d06caSMauro Carvalho Chehab { 12590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12610c0d06caSMauro Carvalho Chehab unsigned int n; 12620c0d06caSMauro Carvalho Chehab 12630c0d06caSMauro Carvalho Chehab n = i->index; 12640c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 12650c0d06caSMauro Carvalho Chehab return -EINVAL; 12660c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 12670c0d06caSMauro Carvalho Chehab return -EINVAL; 12680c0d06caSMauro Carvalho Chehab 12690c0d06caSMauro Carvalho Chehab i->index = n; 12700c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 12710c0d06caSMauro Carvalho Chehab 12720c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 12730c0d06caSMauro Carvalho Chehab 12740c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 12750c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 12760c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 12770c0d06caSMauro Carvalho Chehab 12780c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 12790c0d06caSMauro Carvalho Chehab 12800c0d06caSMauro Carvalho Chehab return 0; 12810c0d06caSMauro Carvalho Chehab } 12820c0d06caSMauro Carvalho Chehab 12830c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 12840c0d06caSMauro Carvalho Chehab { 12850c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12860c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12870c0d06caSMauro Carvalho Chehab 12880c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 12890c0d06caSMauro Carvalho Chehab 12900c0d06caSMauro Carvalho Chehab return 0; 12910c0d06caSMauro Carvalho Chehab } 12920c0d06caSMauro Carvalho Chehab 12930c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 12940c0d06caSMauro Carvalho Chehab { 12950c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12960c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12970c0d06caSMauro Carvalho Chehab int rc; 12980c0d06caSMauro Carvalho Chehab 12990c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13000c0d06caSMauro Carvalho Chehab if (rc < 0) 13010c0d06caSMauro Carvalho Chehab return rc; 13020c0d06caSMauro Carvalho Chehab 13030c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 13040c0d06caSMauro Carvalho Chehab return -EINVAL; 13050c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 13060c0d06caSMauro Carvalho Chehab return -EINVAL; 13070c0d06caSMauro Carvalho Chehab 13080c0d06caSMauro Carvalho Chehab video_mux(dev, i); 13090c0d06caSMauro Carvalho Chehab return 0; 13100c0d06caSMauro Carvalho Chehab } 13110c0d06caSMauro Carvalho Chehab 13120c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 13130c0d06caSMauro Carvalho Chehab { 13140c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13150c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13160c0d06caSMauro Carvalho Chehab 13170c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 13180c0d06caSMauro Carvalho Chehab return -EINVAL; 13190c0d06caSMauro Carvalho Chehab 13200c0d06caSMauro Carvalho Chehab switch (a->index) { 13210c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 13220c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 13230c0d06caSMauro Carvalho Chehab break; 13240c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 13250c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 13260c0d06caSMauro Carvalho Chehab break; 13270c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 13280c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 13290c0d06caSMauro Carvalho Chehab break; 13300c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 13310c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 13320c0d06caSMauro Carvalho Chehab break; 13330c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 13340c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 13350c0d06caSMauro Carvalho Chehab break; 13360c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 13370c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 13380c0d06caSMauro Carvalho Chehab break; 13390c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 13400c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 13410c0d06caSMauro Carvalho Chehab break; 13420c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 13430c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 13440c0d06caSMauro Carvalho Chehab break; 13450c0d06caSMauro Carvalho Chehab default: 13460c0d06caSMauro Carvalho Chehab return -EINVAL; 13470c0d06caSMauro Carvalho Chehab } 13480c0d06caSMauro Carvalho Chehab 13490c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 13500c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 13510c0d06caSMauro Carvalho Chehab 13520c0d06caSMauro Carvalho Chehab return 0; 13530c0d06caSMauro Carvalho Chehab } 13540c0d06caSMauro Carvalho Chehab 13550c0d06caSMauro Carvalho Chehab static int vidioc_s_audio(struct file *file, void *priv, struct v4l2_audio *a) 13560c0d06caSMauro Carvalho Chehab { 13570c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13580c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13590c0d06caSMauro Carvalho Chehab 13600c0d06caSMauro Carvalho Chehab 13610c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 13620c0d06caSMauro Carvalho Chehab return -EINVAL; 13630c0d06caSMauro Carvalho Chehab 13640c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 13650c0d06caSMauro Carvalho Chehab return -EINVAL; 13660c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 13670c0d06caSMauro Carvalho Chehab return -EINVAL; 13680c0d06caSMauro Carvalho Chehab 13690c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 13700c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 13710c0d06caSMauro Carvalho Chehab 13720c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 13730c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 13740c0d06caSMauro Carvalho Chehab 13750c0d06caSMauro Carvalho Chehab return 0; 13760c0d06caSMauro Carvalho Chehab } 13770c0d06caSMauro Carvalho Chehab 13780c0d06caSMauro Carvalho Chehab static int vidioc_queryctrl(struct file *file, void *priv, 13790c0d06caSMauro Carvalho Chehab struct v4l2_queryctrl *qc) 13800c0d06caSMauro Carvalho Chehab { 13810c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13820c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13830c0d06caSMauro Carvalho Chehab int id = qc->id; 13840c0d06caSMauro Carvalho Chehab int rc; 13850c0d06caSMauro Carvalho Chehab 13860c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13870c0d06caSMauro Carvalho Chehab if (rc < 0) 13880c0d06caSMauro Carvalho Chehab return rc; 13890c0d06caSMauro Carvalho Chehab 13900c0d06caSMauro Carvalho Chehab memset(qc, 0, sizeof(*qc)); 13910c0d06caSMauro Carvalho Chehab 13920c0d06caSMauro Carvalho Chehab qc->id = id; 13930c0d06caSMauro Carvalho Chehab 13940c0d06caSMauro Carvalho Chehab /* enumerate AC97 controls */ 13950c0d06caSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 13960c0d06caSMauro Carvalho Chehab rc = ac97_queryctrl(qc); 13970c0d06caSMauro Carvalho Chehab if (!rc) 13980c0d06caSMauro Carvalho Chehab return 0; 13990c0d06caSMauro Carvalho Chehab } 14000c0d06caSMauro Carvalho Chehab 14010c0d06caSMauro Carvalho Chehab /* enumerate V4L2 device controls */ 14020c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, queryctrl, qc); 14030c0d06caSMauro Carvalho Chehab 14040c0d06caSMauro Carvalho Chehab if (qc->type) 14050c0d06caSMauro Carvalho Chehab return 0; 14060c0d06caSMauro Carvalho Chehab else 14070c0d06caSMauro Carvalho Chehab return -EINVAL; 14080c0d06caSMauro Carvalho Chehab } 14090c0d06caSMauro Carvalho Chehab 14100c0d06caSMauro Carvalho Chehab /* 14110c0d06caSMauro Carvalho Chehab * FIXME: This is an indirect way to check if a control exists at a 14120c0d06caSMauro Carvalho Chehab * subdev. Instead of that hack, maybe the better would be to change all 14130c0d06caSMauro Carvalho Chehab * subdevs to return -ENOIOCTLCMD, if an ioctl is not supported. 14140c0d06caSMauro Carvalho Chehab */ 14150c0d06caSMauro Carvalho Chehab static int check_subdev_ctrl(struct em28xx *dev, int id) 14160c0d06caSMauro Carvalho Chehab { 14170c0d06caSMauro Carvalho Chehab struct v4l2_queryctrl qc; 14180c0d06caSMauro Carvalho Chehab 14190c0d06caSMauro Carvalho Chehab memset(&qc, 0, sizeof(qc)); 14200c0d06caSMauro Carvalho Chehab qc.id = id; 14210c0d06caSMauro Carvalho Chehab 14220c0d06caSMauro Carvalho Chehab /* enumerate V4L2 device controls */ 14230c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, queryctrl, &qc); 14240c0d06caSMauro Carvalho Chehab 14250c0d06caSMauro Carvalho Chehab if (qc.type) 14260c0d06caSMauro Carvalho Chehab return 0; 14270c0d06caSMauro Carvalho Chehab else 14280c0d06caSMauro Carvalho Chehab return -EINVAL; 14290c0d06caSMauro Carvalho Chehab } 14300c0d06caSMauro Carvalho Chehab 14310c0d06caSMauro Carvalho Chehab static int vidioc_g_ctrl(struct file *file, void *priv, 14320c0d06caSMauro Carvalho Chehab struct v4l2_control *ctrl) 14330c0d06caSMauro Carvalho Chehab { 14340c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14350c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14360c0d06caSMauro Carvalho Chehab int rc; 14370c0d06caSMauro Carvalho Chehab 14380c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 14390c0d06caSMauro Carvalho Chehab if (rc < 0) 14400c0d06caSMauro Carvalho Chehab return rc; 14410c0d06caSMauro Carvalho Chehab rc = 0; 14420c0d06caSMauro Carvalho Chehab 14430c0d06caSMauro Carvalho Chehab /* Set an AC97 control */ 14440c0d06caSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) 14450c0d06caSMauro Carvalho Chehab rc = ac97_get_ctrl(dev, ctrl); 14460c0d06caSMauro Carvalho Chehab else 14470c0d06caSMauro Carvalho Chehab rc = 1; 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab /* It were not an AC97 control. Sends it to the v4l2 dev interface */ 14500c0d06caSMauro Carvalho Chehab if (rc == 1) { 14510c0d06caSMauro Carvalho Chehab if (check_subdev_ctrl(dev, ctrl->id)) 14520c0d06caSMauro Carvalho Chehab return -EINVAL; 14530c0d06caSMauro Carvalho Chehab 14540c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_ctrl, ctrl); 14550c0d06caSMauro Carvalho Chehab rc = 0; 14560c0d06caSMauro Carvalho Chehab } 14570c0d06caSMauro Carvalho Chehab 14580c0d06caSMauro Carvalho Chehab return rc; 14590c0d06caSMauro Carvalho Chehab } 14600c0d06caSMauro Carvalho Chehab 14610c0d06caSMauro Carvalho Chehab static int vidioc_s_ctrl(struct file *file, void *priv, 14620c0d06caSMauro Carvalho Chehab struct v4l2_control *ctrl) 14630c0d06caSMauro Carvalho Chehab { 14640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14660c0d06caSMauro Carvalho Chehab int rc; 14670c0d06caSMauro Carvalho Chehab 14680c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 14690c0d06caSMauro Carvalho Chehab if (rc < 0) 14700c0d06caSMauro Carvalho Chehab return rc; 14710c0d06caSMauro Carvalho Chehab 14720c0d06caSMauro Carvalho Chehab /* Set an AC97 control */ 14730c0d06caSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) 14740c0d06caSMauro Carvalho Chehab rc = ac97_set_ctrl(dev, ctrl); 14750c0d06caSMauro Carvalho Chehab else 14760c0d06caSMauro Carvalho Chehab rc = 1; 14770c0d06caSMauro Carvalho Chehab 14780c0d06caSMauro Carvalho Chehab /* It isn't an AC97 control. Sends it to the v4l2 dev interface */ 14790c0d06caSMauro Carvalho Chehab if (rc == 1) { 14800c0d06caSMauro Carvalho Chehab rc = check_subdev_ctrl(dev, ctrl->id); 14810c0d06caSMauro Carvalho Chehab if (!rc) 14820c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, 14830c0d06caSMauro Carvalho Chehab core, s_ctrl, ctrl); 14840c0d06caSMauro Carvalho Chehab /* 14850c0d06caSMauro Carvalho Chehab * In the case of non-AC97 volume controls, we still need 14860c0d06caSMauro Carvalho Chehab * to do some setups at em28xx, in order to mute/unmute 14870c0d06caSMauro Carvalho Chehab * and to adjust audio volume. However, the value ranges 14880c0d06caSMauro Carvalho Chehab * should be checked by the corresponding V4L subdriver. 14890c0d06caSMauro Carvalho Chehab */ 14900c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 14910c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 14920c0d06caSMauro Carvalho Chehab dev->mute = ctrl->value; 14930c0d06caSMauro Carvalho Chehab rc = em28xx_audio_analog_set(dev); 14940c0d06caSMauro Carvalho Chehab break; 14950c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 14960c0d06caSMauro Carvalho Chehab dev->volume = ctrl->value; 14970c0d06caSMauro Carvalho Chehab rc = em28xx_audio_analog_set(dev); 14980c0d06caSMauro Carvalho Chehab } 14990c0d06caSMauro Carvalho Chehab } 15000c0d06caSMauro Carvalho Chehab return (rc < 0) ? rc : 0; 15010c0d06caSMauro Carvalho Chehab } 15020c0d06caSMauro Carvalho Chehab 15030c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 15040c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15050c0d06caSMauro Carvalho Chehab { 15060c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15070c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15080c0d06caSMauro Carvalho Chehab int rc; 15090c0d06caSMauro Carvalho Chehab 15100c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15110c0d06caSMauro Carvalho Chehab if (rc < 0) 15120c0d06caSMauro Carvalho Chehab return rc; 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab if (0 != t->index) 15150c0d06caSMauro Carvalho Chehab return -EINVAL; 15160c0d06caSMauro Carvalho Chehab 15170c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 15180c0d06caSMauro Carvalho Chehab t->type = V4L2_TUNER_ANALOG_TV; 15190c0d06caSMauro Carvalho Chehab 15200c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 15210c0d06caSMauro Carvalho Chehab return 0; 15220c0d06caSMauro Carvalho Chehab } 15230c0d06caSMauro Carvalho Chehab 15240c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 15250c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15260c0d06caSMauro Carvalho Chehab { 15270c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15280c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15290c0d06caSMauro Carvalho Chehab int rc; 15300c0d06caSMauro Carvalho Chehab 15310c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15320c0d06caSMauro Carvalho Chehab if (rc < 0) 15330c0d06caSMauro Carvalho Chehab return rc; 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab if (0 != t->index) 15360c0d06caSMauro Carvalho Chehab return -EINVAL; 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 15390c0d06caSMauro Carvalho Chehab return 0; 15400c0d06caSMauro Carvalho Chehab } 15410c0d06caSMauro Carvalho Chehab 15420c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 15430c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15440c0d06caSMauro Carvalho Chehab { 15450c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15460c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15470c0d06caSMauro Carvalho Chehab 15480c0d06caSMauro Carvalho Chehab f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV; 15490c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 15500c0d06caSMauro Carvalho Chehab return 0; 15510c0d06caSMauro Carvalho Chehab } 15520c0d06caSMauro Carvalho Chehab 15530c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 15540c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 15550c0d06caSMauro Carvalho Chehab { 15560c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15570c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15580c0d06caSMauro Carvalho Chehab int rc; 15590c0d06caSMauro Carvalho Chehab 15600c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15610c0d06caSMauro Carvalho Chehab if (rc < 0) 15620c0d06caSMauro Carvalho Chehab return rc; 15630c0d06caSMauro Carvalho Chehab 15640c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 15650c0d06caSMauro Carvalho Chehab return -EINVAL; 15660c0d06caSMauro Carvalho Chehab 15670c0d06caSMauro Carvalho Chehab if (unlikely(0 == fh->radio && f->type != V4L2_TUNER_ANALOG_TV)) 15680c0d06caSMauro Carvalho Chehab return -EINVAL; 15690c0d06caSMauro Carvalho Chehab if (unlikely(1 == fh->radio && f->type != V4L2_TUNER_RADIO)) 15700c0d06caSMauro Carvalho Chehab return -EINVAL; 15710c0d06caSMauro Carvalho Chehab 15720c0d06caSMauro Carvalho Chehab dev->ctl_freq = f->frequency; 15730c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 15740c0d06caSMauro Carvalho Chehab 15750c0d06caSMauro Carvalho Chehab return 0; 15760c0d06caSMauro Carvalho Chehab } 15770c0d06caSMauro Carvalho Chehab 15780c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 15790c0d06caSMauro Carvalho Chehab static int em28xx_reg_len(int reg) 15800c0d06caSMauro Carvalho Chehab { 15810c0d06caSMauro Carvalho Chehab switch (reg) { 15820c0d06caSMauro Carvalho Chehab case EM28XX_R40_AC97LSB: 15830c0d06caSMauro Carvalho Chehab case EM28XX_R30_HSCALELOW: 15840c0d06caSMauro Carvalho Chehab case EM28XX_R32_VSCALELOW: 15850c0d06caSMauro Carvalho Chehab return 2; 15860c0d06caSMauro Carvalho Chehab default: 15870c0d06caSMauro Carvalho Chehab return 1; 15880c0d06caSMauro Carvalho Chehab } 15890c0d06caSMauro Carvalho Chehab } 15900c0d06caSMauro Carvalho Chehab 15910c0d06caSMauro Carvalho Chehab static int vidioc_g_chip_ident(struct file *file, void *priv, 15920c0d06caSMauro Carvalho Chehab struct v4l2_dbg_chip_ident *chip) 15930c0d06caSMauro Carvalho Chehab { 15940c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15950c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15960c0d06caSMauro Carvalho Chehab 15970c0d06caSMauro Carvalho Chehab chip->ident = V4L2_IDENT_NONE; 15980c0d06caSMauro Carvalho Chehab chip->revision = 0; 15990c0d06caSMauro Carvalho Chehab 16000c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_chip_ident, chip); 16010c0d06caSMauro Carvalho Chehab 16020c0d06caSMauro Carvalho Chehab return 0; 16030c0d06caSMauro Carvalho Chehab } 16040c0d06caSMauro Carvalho Chehab 16050c0d06caSMauro Carvalho Chehab 16060c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 16070c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16080c0d06caSMauro Carvalho Chehab { 16090c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16100c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16110c0d06caSMauro Carvalho Chehab int ret; 16120c0d06caSMauro Carvalho Chehab 16130c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 16140c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 16150c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 16160c0d06caSMauro Carvalho Chehab if (ret < 0) 16170c0d06caSMauro Carvalho Chehab return ret; 16180c0d06caSMauro Carvalho Chehab 16190c0d06caSMauro Carvalho Chehab reg->val = ret; 16200c0d06caSMauro Carvalho Chehab reg->size = 1; 16210c0d06caSMauro Carvalho Chehab return 0; 16220c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 16230c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 16240c0d06caSMauro Carvalho Chehab return 0; 16250c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 16260c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 16270c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 16280c0d06caSMauro Carvalho Chehab return 0; 16290c0d06caSMauro Carvalho Chehab default: 16300c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 16310c0d06caSMauro Carvalho Chehab return -EINVAL; 16320c0d06caSMauro Carvalho Chehab } 16330c0d06caSMauro Carvalho Chehab 16340c0d06caSMauro Carvalho Chehab /* Match host */ 16350c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 16360c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 16370c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 16380c0d06caSMauro Carvalho Chehab 16390c0d06caSMauro Carvalho Chehab if (ret < 0) 16400c0d06caSMauro Carvalho Chehab return ret; 16410c0d06caSMauro Carvalho Chehab 16420c0d06caSMauro Carvalho Chehab reg->val = ret; 16430c0d06caSMauro Carvalho Chehab } else { 16440c0d06caSMauro Carvalho Chehab __le16 val = 0; 16450c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 16460c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 16470c0d06caSMauro Carvalho Chehab if (ret < 0) 16480c0d06caSMauro Carvalho Chehab return ret; 16490c0d06caSMauro Carvalho Chehab 16500c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 16510c0d06caSMauro Carvalho Chehab } 16520c0d06caSMauro Carvalho Chehab 16530c0d06caSMauro Carvalho Chehab return 0; 16540c0d06caSMauro Carvalho Chehab } 16550c0d06caSMauro Carvalho Chehab 16560c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 16570c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 16580c0d06caSMauro Carvalho Chehab { 16590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16610c0d06caSMauro Carvalho Chehab __le16 buf; 16620c0d06caSMauro Carvalho Chehab 16630c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 16640c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 16650c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 16660c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 16670c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 16680c0d06caSMauro Carvalho Chehab return 0; 16690c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 16700c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 16710c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 16720c0d06caSMauro Carvalho Chehab return 0; 16730c0d06caSMauro Carvalho Chehab default: 16740c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 16750c0d06caSMauro Carvalho Chehab return -EINVAL; 16760c0d06caSMauro Carvalho Chehab } 16770c0d06caSMauro Carvalho Chehab 16780c0d06caSMauro Carvalho Chehab /* Match host */ 16790c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 16800c0d06caSMauro Carvalho Chehab 16810c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 16820c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 16830c0d06caSMauro Carvalho Chehab } 16840c0d06caSMauro Carvalho Chehab #endif 16850c0d06caSMauro Carvalho Chehab 16860c0d06caSMauro Carvalho Chehab 16870c0d06caSMauro Carvalho Chehab static int vidioc_cropcap(struct file *file, void *priv, 16880c0d06caSMauro Carvalho Chehab struct v4l2_cropcap *cc) 16890c0d06caSMauro Carvalho Chehab { 16900c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16910c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16920c0d06caSMauro Carvalho Chehab 16930c0d06caSMauro Carvalho Chehab if (cc->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 16940c0d06caSMauro Carvalho Chehab return -EINVAL; 16950c0d06caSMauro Carvalho Chehab 16960c0d06caSMauro Carvalho Chehab cc->bounds.left = 0; 16970c0d06caSMauro Carvalho Chehab cc->bounds.top = 0; 16980c0d06caSMauro Carvalho Chehab cc->bounds.width = dev->width; 16990c0d06caSMauro Carvalho Chehab cc->bounds.height = dev->height; 17000c0d06caSMauro Carvalho Chehab cc->defrect = cc->bounds; 17010c0d06caSMauro Carvalho Chehab cc->pixelaspect.numerator = 54; /* 4:3 FIXME: remove magic numbers */ 17020c0d06caSMauro Carvalho Chehab cc->pixelaspect.denominator = 59; 17030c0d06caSMauro Carvalho Chehab 17040c0d06caSMauro Carvalho Chehab return 0; 17050c0d06caSMauro Carvalho Chehab } 17060c0d06caSMauro Carvalho Chehab 17070c0d06caSMauro Carvalho Chehab static int vidioc_streamon(struct file *file, void *priv, 17080c0d06caSMauro Carvalho Chehab enum v4l2_buf_type type) 17090c0d06caSMauro Carvalho Chehab { 17100c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17110c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17120c0d06caSMauro Carvalho Chehab int rc = -EINVAL; 17130c0d06caSMauro Carvalho Chehab 17140c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 17150c0d06caSMauro Carvalho Chehab if (rc < 0) 17160c0d06caSMauro Carvalho Chehab return rc; 17170c0d06caSMauro Carvalho Chehab 17180c0d06caSMauro Carvalho Chehab if (unlikely(type != fh->type)) 17190c0d06caSMauro Carvalho Chehab return -EINVAL; 17200c0d06caSMauro Carvalho Chehab 17210c0d06caSMauro Carvalho Chehab em28xx_videodbg("vidioc_streamon fh=%p t=%d fh->res=%d dev->res=%d\n", 17220c0d06caSMauro Carvalho Chehab fh, type, fh->resources, dev->resources); 17230c0d06caSMauro Carvalho Chehab 17240c0d06caSMauro Carvalho Chehab if (unlikely(!res_get(fh, get_ressource(fh)))) 17250c0d06caSMauro Carvalho Chehab return -EBUSY; 17260c0d06caSMauro Carvalho Chehab 17270c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 17280c0d06caSMauro Carvalho Chehab rc = videobuf_streamon(&fh->vb_vidq); 17290c0d06caSMauro Carvalho Chehab else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) 17300c0d06caSMauro Carvalho Chehab rc = videobuf_streamon(&fh->vb_vbiq); 17310c0d06caSMauro Carvalho Chehab 17320c0d06caSMauro Carvalho Chehab return rc; 17330c0d06caSMauro Carvalho Chehab } 17340c0d06caSMauro Carvalho Chehab 17350c0d06caSMauro Carvalho Chehab static int vidioc_streamoff(struct file *file, void *priv, 17360c0d06caSMauro Carvalho Chehab enum v4l2_buf_type type) 17370c0d06caSMauro Carvalho Chehab { 17380c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17390c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17400c0d06caSMauro Carvalho Chehab int rc; 17410c0d06caSMauro Carvalho Chehab 17420c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 17430c0d06caSMauro Carvalho Chehab if (rc < 0) 17440c0d06caSMauro Carvalho Chehab return rc; 17450c0d06caSMauro Carvalho Chehab 17460c0d06caSMauro Carvalho Chehab if (fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 17470c0d06caSMauro Carvalho Chehab fh->type != V4L2_BUF_TYPE_VBI_CAPTURE) 17480c0d06caSMauro Carvalho Chehab return -EINVAL; 17490c0d06caSMauro Carvalho Chehab if (type != fh->type) 17500c0d06caSMauro Carvalho Chehab return -EINVAL; 17510c0d06caSMauro Carvalho Chehab 17520c0d06caSMauro Carvalho Chehab em28xx_videodbg("vidioc_streamoff fh=%p t=%d fh->res=%d dev->res=%d\n", 17530c0d06caSMauro Carvalho Chehab fh, type, fh->resources, dev->resources); 17540c0d06caSMauro Carvalho Chehab 17550c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 17560c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VIDEO)) { 17570c0d06caSMauro Carvalho Chehab videobuf_streamoff(&fh->vb_vidq); 17580c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VIDEO); 17590c0d06caSMauro Carvalho Chehab } 17600c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 17610c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VBI)) { 17620c0d06caSMauro Carvalho Chehab videobuf_streamoff(&fh->vb_vbiq); 17630c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VBI); 17640c0d06caSMauro Carvalho Chehab } 17650c0d06caSMauro Carvalho Chehab } 17660c0d06caSMauro Carvalho Chehab 17670c0d06caSMauro Carvalho Chehab return 0; 17680c0d06caSMauro Carvalho Chehab } 17690c0d06caSMauro Carvalho Chehab 17700c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 17710c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 17720c0d06caSMauro Carvalho Chehab { 17730c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 17740c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 17750c0d06caSMauro Carvalho Chehab 17760c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 17770c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 17780c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 17790c0d06caSMauro Carvalho Chehab 17800c0d06caSMauro Carvalho Chehab cap->capabilities = 17810c0d06caSMauro Carvalho Chehab V4L2_CAP_SLICED_VBI_CAPTURE | 17820c0d06caSMauro Carvalho Chehab V4L2_CAP_VIDEO_CAPTURE | 17830c0d06caSMauro Carvalho Chehab V4L2_CAP_READWRITE | V4L2_CAP_STREAMING; 17840c0d06caSMauro Carvalho Chehab 17850c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 17860c0d06caSMauro Carvalho Chehab cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 17870c0d06caSMauro Carvalho Chehab 17880c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 17890c0d06caSMauro Carvalho Chehab cap->capabilities |= V4L2_CAP_AUDIO; 17900c0d06caSMauro Carvalho Chehab 17910c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 17920c0d06caSMauro Carvalho Chehab cap->capabilities |= V4L2_CAP_TUNER; 17930c0d06caSMauro Carvalho Chehab 17940c0d06caSMauro Carvalho Chehab return 0; 17950c0d06caSMauro Carvalho Chehab } 17960c0d06caSMauro Carvalho Chehab 17970c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 17980c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 17990c0d06caSMauro Carvalho Chehab { 18000c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 18010c0d06caSMauro Carvalho Chehab return -EINVAL; 18020c0d06caSMauro Carvalho Chehab 18030c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 18040c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 18050c0d06caSMauro Carvalho Chehab 18060c0d06caSMauro Carvalho Chehab return 0; 18070c0d06caSMauro Carvalho Chehab } 18080c0d06caSMauro Carvalho Chehab 18090c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 18100c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 18110c0d06caSMauro Carvalho Chehab { 18120c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18130c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18140c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 18150c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 18160c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 18170c0d06caSMauro Carvalho Chehab 18180c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 18190c0d06caSMauro Carvalho Chehab if (!fmt) { 18200c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 18210c0d06caSMauro Carvalho Chehab fsize->pixel_format); 18220c0d06caSMauro Carvalho Chehab return -EINVAL; 18230c0d06caSMauro Carvalho Chehab } 18240c0d06caSMauro Carvalho Chehab 18250c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 18260c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 18270c0d06caSMauro Carvalho Chehab return -EINVAL; 18280c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 18290c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 18300c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 18310c0d06caSMauro Carvalho Chehab return 0; 18320c0d06caSMauro Carvalho Chehab } 18330c0d06caSMauro Carvalho Chehab 18340c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 18350c0d06caSMauro Carvalho Chehab return -EINVAL; 18360c0d06caSMauro Carvalho Chehab 18370c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 18380c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 18390c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 18400c0d06caSMauro Carvalho Chehab fsize->stepwise.min_height = 32; 18410c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 18420c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 18430c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 18440c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 18450c0d06caSMauro Carvalho Chehab return 0; 18460c0d06caSMauro Carvalho Chehab } 18470c0d06caSMauro Carvalho Chehab 18480c0d06caSMauro Carvalho Chehab /* Sliced VBI ioctls */ 18490c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_sliced_vbi_cap(struct file *file, void *priv, 18500c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 18510c0d06caSMauro Carvalho Chehab { 18520c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18530c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18540c0d06caSMauro Carvalho Chehab int rc; 18550c0d06caSMauro Carvalho Chehab 18560c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 18570c0d06caSMauro Carvalho Chehab if (rc < 0) 18580c0d06caSMauro Carvalho Chehab return rc; 18590c0d06caSMauro Carvalho Chehab 18600c0d06caSMauro Carvalho Chehab f->fmt.sliced.service_set = 0; 18610c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, vbi, g_sliced_fmt, &f->fmt.sliced); 18620c0d06caSMauro Carvalho Chehab 18630c0d06caSMauro Carvalho Chehab if (f->fmt.sliced.service_set == 0) 18640c0d06caSMauro Carvalho Chehab rc = -EINVAL; 18650c0d06caSMauro Carvalho Chehab 18660c0d06caSMauro Carvalho Chehab return rc; 18670c0d06caSMauro Carvalho Chehab } 18680c0d06caSMauro Carvalho Chehab 18690c0d06caSMauro Carvalho Chehab static int vidioc_try_set_sliced_vbi_cap(struct file *file, void *priv, 18700c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 18710c0d06caSMauro Carvalho Chehab { 18720c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18730c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18740c0d06caSMauro Carvalho Chehab int rc; 18750c0d06caSMauro Carvalho Chehab 18760c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 18770c0d06caSMauro Carvalho Chehab if (rc < 0) 18780c0d06caSMauro Carvalho Chehab return rc; 18790c0d06caSMauro Carvalho Chehab 18800c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, vbi, g_sliced_fmt, &f->fmt.sliced); 18810c0d06caSMauro Carvalho Chehab 18820c0d06caSMauro Carvalho Chehab if (f->fmt.sliced.service_set == 0) 18830c0d06caSMauro Carvalho Chehab return -EINVAL; 18840c0d06caSMauro Carvalho Chehab 18850c0d06caSMauro Carvalho Chehab return 0; 18860c0d06caSMauro Carvalho Chehab } 18870c0d06caSMauro Carvalho Chehab 18880c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 18890c0d06caSMauro Carvalho Chehab 18900c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 18910c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 18920c0d06caSMauro Carvalho Chehab { 18930c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 18940c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18950c0d06caSMauro Carvalho Chehab 18960c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 18970c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 18980c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 18990c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 19000c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 19010c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 19020c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 19030c0d06caSMauro Carvalho Chehab 19040c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 19050c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 19060c0d06caSMauro Carvalho Chehab /* NTSC */ 19070c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 19080c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 19090c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 19100c0d06caSMauro Carvalho Chehab /* PAL */ 19110c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 19120c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 19130c0d06caSMauro Carvalho Chehab } 19140c0d06caSMauro Carvalho Chehab 19150c0d06caSMauro Carvalho Chehab return 0; 19160c0d06caSMauro Carvalho Chehab } 19170c0d06caSMauro Carvalho Chehab 19180c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vbi_cap(struct file *file, void *priv, 19190c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 19200c0d06caSMauro Carvalho Chehab { 19210c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 19220c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19230c0d06caSMauro Carvalho Chehab 19240c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 19250c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 19260c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 19270c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 19280c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 19290c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 19300c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 19310c0d06caSMauro Carvalho Chehab 19320c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 19330c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 19340c0d06caSMauro Carvalho Chehab /* NTSC */ 19350c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 19360c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 19370c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 19380c0d06caSMauro Carvalho Chehab /* PAL */ 19390c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 19400c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 19410c0d06caSMauro Carvalho Chehab } 19420c0d06caSMauro Carvalho Chehab 19430c0d06caSMauro Carvalho Chehab return 0; 19440c0d06caSMauro Carvalho Chehab } 19450c0d06caSMauro Carvalho Chehab 19460c0d06caSMauro Carvalho Chehab static int vidioc_reqbufs(struct file *file, void *priv, 19470c0d06caSMauro Carvalho Chehab struct v4l2_requestbuffers *rb) 19480c0d06caSMauro Carvalho Chehab { 19490c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 19500c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19510c0d06caSMauro Carvalho Chehab int rc; 19520c0d06caSMauro Carvalho Chehab 19530c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 19540c0d06caSMauro Carvalho Chehab if (rc < 0) 19550c0d06caSMauro Carvalho Chehab return rc; 19560c0d06caSMauro Carvalho Chehab 19570c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 19580c0d06caSMauro Carvalho Chehab return videobuf_reqbufs(&fh->vb_vidq, rb); 19590c0d06caSMauro Carvalho Chehab else 19600c0d06caSMauro Carvalho Chehab return videobuf_reqbufs(&fh->vb_vbiq, rb); 19610c0d06caSMauro Carvalho Chehab } 19620c0d06caSMauro Carvalho Chehab 19630c0d06caSMauro Carvalho Chehab static int vidioc_querybuf(struct file *file, void *priv, 19640c0d06caSMauro Carvalho Chehab struct v4l2_buffer *b) 19650c0d06caSMauro Carvalho Chehab { 19660c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 19670c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19680c0d06caSMauro Carvalho Chehab int rc; 19690c0d06caSMauro Carvalho Chehab 19700c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 19710c0d06caSMauro Carvalho Chehab if (rc < 0) 19720c0d06caSMauro Carvalho Chehab return rc; 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 19750c0d06caSMauro Carvalho Chehab return videobuf_querybuf(&fh->vb_vidq, b); 19760c0d06caSMauro Carvalho Chehab else { 19770c0d06caSMauro Carvalho Chehab /* FIXME: I'm not sure yet whether this is a bug in zvbi or 19780c0d06caSMauro Carvalho Chehab the videobuf framework, but we probably shouldn't be 19790c0d06caSMauro Carvalho Chehab returning a buffer larger than that which was asked for. 19800c0d06caSMauro Carvalho Chehab At a minimum, it causes a crash in zvbi since it does 19810c0d06caSMauro Carvalho Chehab a memcpy based on the source buffer length */ 19820c0d06caSMauro Carvalho Chehab int result = videobuf_querybuf(&fh->vb_vbiq, b); 19830c0d06caSMauro Carvalho Chehab b->length = dev->vbi_width * dev->vbi_height * 2; 19840c0d06caSMauro Carvalho Chehab 19850c0d06caSMauro Carvalho Chehab return result; 19860c0d06caSMauro Carvalho Chehab } 19870c0d06caSMauro Carvalho Chehab } 19880c0d06caSMauro Carvalho Chehab 19890c0d06caSMauro Carvalho Chehab static int vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *b) 19900c0d06caSMauro Carvalho Chehab { 19910c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 19920c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19930c0d06caSMauro Carvalho Chehab int rc; 19940c0d06caSMauro Carvalho Chehab 19950c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 19960c0d06caSMauro Carvalho Chehab if (rc < 0) 19970c0d06caSMauro Carvalho Chehab return rc; 19980c0d06caSMauro Carvalho Chehab 19990c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 20000c0d06caSMauro Carvalho Chehab return videobuf_qbuf(&fh->vb_vidq, b); 20010c0d06caSMauro Carvalho Chehab else 20020c0d06caSMauro Carvalho Chehab return videobuf_qbuf(&fh->vb_vbiq, b); 20030c0d06caSMauro Carvalho Chehab } 20040c0d06caSMauro Carvalho Chehab 20050c0d06caSMauro Carvalho Chehab static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b) 20060c0d06caSMauro Carvalho Chehab { 20070c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 20080c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 20090c0d06caSMauro Carvalho Chehab int rc; 20100c0d06caSMauro Carvalho Chehab 20110c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 20120c0d06caSMauro Carvalho Chehab if (rc < 0) 20130c0d06caSMauro Carvalho Chehab return rc; 20140c0d06caSMauro Carvalho Chehab 20150c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 20160c0d06caSMauro Carvalho Chehab return videobuf_dqbuf(&fh->vb_vidq, b, file->f_flags & 20170c0d06caSMauro Carvalho Chehab O_NONBLOCK); 20180c0d06caSMauro Carvalho Chehab else 20190c0d06caSMauro Carvalho Chehab return videobuf_dqbuf(&fh->vb_vbiq, b, file->f_flags & 20200c0d06caSMauro Carvalho Chehab O_NONBLOCK); 20210c0d06caSMauro Carvalho Chehab } 20220c0d06caSMauro Carvalho Chehab 20230c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 20240c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 20250c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 20260c0d06caSMauro Carvalho Chehab 20270c0d06caSMauro Carvalho Chehab static int radio_querycap(struct file *file, void *priv, 20280c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 20290c0d06caSMauro Carvalho Chehab { 20300c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 20310c0d06caSMauro Carvalho Chehab 20320c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 20330c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 20340c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 20350c0d06caSMauro Carvalho Chehab 20360c0d06caSMauro Carvalho Chehab cap->capabilities = V4L2_CAP_TUNER; 20370c0d06caSMauro Carvalho Chehab return 0; 20380c0d06caSMauro Carvalho Chehab } 20390c0d06caSMauro Carvalho Chehab 20400c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 20410c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 20420c0d06caSMauro Carvalho Chehab { 20430c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 20440c0d06caSMauro Carvalho Chehab 20450c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 20460c0d06caSMauro Carvalho Chehab return -EINVAL; 20470c0d06caSMauro Carvalho Chehab 20480c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 20490c0d06caSMauro Carvalho Chehab t->type = V4L2_TUNER_RADIO; 20500c0d06caSMauro Carvalho Chehab 20510c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 20520c0d06caSMauro Carvalho Chehab 20530c0d06caSMauro Carvalho Chehab return 0; 20540c0d06caSMauro Carvalho Chehab } 20550c0d06caSMauro Carvalho Chehab 20560c0d06caSMauro Carvalho Chehab static int radio_enum_input(struct file *file, void *priv, 20570c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 20580c0d06caSMauro Carvalho Chehab { 20590c0d06caSMauro Carvalho Chehab if (i->index != 0) 20600c0d06caSMauro Carvalho Chehab return -EINVAL; 20610c0d06caSMauro Carvalho Chehab strcpy(i->name, "Radio"); 20620c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 20630c0d06caSMauro Carvalho Chehab 20640c0d06caSMauro Carvalho Chehab return 0; 20650c0d06caSMauro Carvalho Chehab } 20660c0d06caSMauro Carvalho Chehab 20670c0d06caSMauro Carvalho Chehab static int radio_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 20680c0d06caSMauro Carvalho Chehab { 20690c0d06caSMauro Carvalho Chehab if (unlikely(a->index)) 20700c0d06caSMauro Carvalho Chehab return -EINVAL; 20710c0d06caSMauro Carvalho Chehab 20720c0d06caSMauro Carvalho Chehab strcpy(a->name, "Radio"); 20730c0d06caSMauro Carvalho Chehab return 0; 20740c0d06caSMauro Carvalho Chehab } 20750c0d06caSMauro Carvalho Chehab 20760c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 20770c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 20780c0d06caSMauro Carvalho Chehab { 20790c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 20800c0d06caSMauro Carvalho Chehab 20810c0d06caSMauro Carvalho Chehab if (0 != t->index) 20820c0d06caSMauro Carvalho Chehab return -EINVAL; 20830c0d06caSMauro Carvalho Chehab 20840c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 20850c0d06caSMauro Carvalho Chehab 20860c0d06caSMauro Carvalho Chehab return 0; 20870c0d06caSMauro Carvalho Chehab } 20880c0d06caSMauro Carvalho Chehab 20890c0d06caSMauro Carvalho Chehab static int radio_s_audio(struct file *file, void *fh, 20900c0d06caSMauro Carvalho Chehab struct v4l2_audio *a) 20910c0d06caSMauro Carvalho Chehab { 20920c0d06caSMauro Carvalho Chehab return 0; 20930c0d06caSMauro Carvalho Chehab } 20940c0d06caSMauro Carvalho Chehab 20950c0d06caSMauro Carvalho Chehab static int radio_s_input(struct file *file, void *fh, unsigned int i) 20960c0d06caSMauro Carvalho Chehab { 20970c0d06caSMauro Carvalho Chehab return 0; 20980c0d06caSMauro Carvalho Chehab } 20990c0d06caSMauro Carvalho Chehab 21000c0d06caSMauro Carvalho Chehab static int radio_queryctrl(struct file *file, void *priv, 21010c0d06caSMauro Carvalho Chehab struct v4l2_queryctrl *qc) 21020c0d06caSMauro Carvalho Chehab { 21030c0d06caSMauro Carvalho Chehab int i; 21040c0d06caSMauro Carvalho Chehab 21050c0d06caSMauro Carvalho Chehab if (qc->id < V4L2_CID_BASE || 21060c0d06caSMauro Carvalho Chehab qc->id >= V4L2_CID_LASTP1) 21070c0d06caSMauro Carvalho Chehab return -EINVAL; 21080c0d06caSMauro Carvalho Chehab 21090c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(ac97_qctrl); i++) { 21100c0d06caSMauro Carvalho Chehab if (qc->id && qc->id == ac97_qctrl[i].id) { 21110c0d06caSMauro Carvalho Chehab memcpy(qc, &(ac97_qctrl[i]), sizeof(*qc)); 21120c0d06caSMauro Carvalho Chehab return 0; 21130c0d06caSMauro Carvalho Chehab } 21140c0d06caSMauro Carvalho Chehab } 21150c0d06caSMauro Carvalho Chehab 21160c0d06caSMauro Carvalho Chehab return -EINVAL; 21170c0d06caSMauro Carvalho Chehab } 21180c0d06caSMauro Carvalho Chehab 21190c0d06caSMauro Carvalho Chehab /* 21200c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 21210c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 21220c0d06caSMauro Carvalho Chehab */ 21230c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 21240c0d06caSMauro Carvalho Chehab { 21250c0d06caSMauro Carvalho Chehab int errCode = 0, radio = 0; 21260c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 21270c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 21280c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 21290c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 21300c0d06caSMauro Carvalho Chehab enum v4l2_field field; 21310c0d06caSMauro Carvalho Chehab 21320c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 21330c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 21340c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 21350c0d06caSMauro Carvalho Chehab break; 21360c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 21370c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 21380c0d06caSMauro Carvalho Chehab break; 21390c0d06caSMauro Carvalho Chehab case VFL_TYPE_RADIO: 21400c0d06caSMauro Carvalho Chehab radio = 1; 21410c0d06caSMauro Carvalho Chehab break; 21420c0d06caSMauro Carvalho Chehab } 21430c0d06caSMauro Carvalho Chehab 21440c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 21450c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 21460c0d06caSMauro Carvalho Chehab dev->users); 21470c0d06caSMauro Carvalho Chehab 21480c0d06caSMauro Carvalho Chehab 21490c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21500c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21510c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 21520c0d06caSMauro Carvalho Chehab if (!fh) { 21530c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 21540c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21550c0d06caSMauro Carvalho Chehab return -ENOMEM; 21560c0d06caSMauro Carvalho Chehab } 21570c0d06caSMauro Carvalho Chehab fh->dev = dev; 21580c0d06caSMauro Carvalho Chehab fh->radio = radio; 21590c0d06caSMauro Carvalho Chehab fh->type = fh_type; 21600c0d06caSMauro Carvalho Chehab filp->private_data = fh; 21610c0d06caSMauro Carvalho Chehab 21620c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE && dev->users == 0) { 21630c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 21640c0d06caSMauro Carvalho Chehab em28xx_set_alternate(dev); 21650c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 21660c0d06caSMauro Carvalho Chehab 21670c0d06caSMauro Carvalho Chehab /* Needed, since GPIO might have disabled power of 21680c0d06caSMauro Carvalho Chehab some i2c device 21690c0d06caSMauro Carvalho Chehab */ 21700c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 21710c0d06caSMauro Carvalho Chehab 21720c0d06caSMauro Carvalho Chehab } 21730c0d06caSMauro Carvalho Chehab if (fh->radio) { 21740c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 21750c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 21760c0d06caSMauro Carvalho Chehab } 21770c0d06caSMauro Carvalho Chehab 21780c0d06caSMauro Carvalho Chehab dev->users++; 21790c0d06caSMauro Carvalho Chehab 21800c0d06caSMauro Carvalho Chehab if (dev->progressive) 21810c0d06caSMauro Carvalho Chehab field = V4L2_FIELD_NONE; 21820c0d06caSMauro Carvalho Chehab else 21830c0d06caSMauro Carvalho Chehab field = V4L2_FIELD_INTERLACED; 21840c0d06caSMauro Carvalho Chehab 21850c0d06caSMauro Carvalho Chehab videobuf_queue_vmalloc_init(&fh->vb_vidq, &em28xx_video_qops, 21860c0d06caSMauro Carvalho Chehab NULL, &dev->slock, 21870c0d06caSMauro Carvalho Chehab V4L2_BUF_TYPE_VIDEO_CAPTURE, field, 21880c0d06caSMauro Carvalho Chehab sizeof(struct em28xx_buffer), fh, &dev->lock); 21890c0d06caSMauro Carvalho Chehab 21900c0d06caSMauro Carvalho Chehab videobuf_queue_vmalloc_init(&fh->vb_vbiq, &em28xx_vbi_qops, 21910c0d06caSMauro Carvalho Chehab NULL, &dev->slock, 21920c0d06caSMauro Carvalho Chehab V4L2_BUF_TYPE_VBI_CAPTURE, 21930c0d06caSMauro Carvalho Chehab V4L2_FIELD_SEQ_TB, 21940c0d06caSMauro Carvalho Chehab sizeof(struct em28xx_buffer), fh, &dev->lock); 21950c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21960c0d06caSMauro Carvalho Chehab 21970c0d06caSMauro Carvalho Chehab return errCode; 21980c0d06caSMauro Carvalho Chehab } 21990c0d06caSMauro Carvalho Chehab 22000c0d06caSMauro Carvalho Chehab /* 22010c0d06caSMauro Carvalho Chehab * em28xx_realease_resources() 22020c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 22030c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 22040c0d06caSMauro Carvalho Chehab */ 22050c0d06caSMauro Carvalho Chehab void em28xx_release_analog_resources(struct em28xx *dev) 22060c0d06caSMauro Carvalho Chehab { 22070c0d06caSMauro Carvalho Chehab 22080c0d06caSMauro Carvalho Chehab /*FIXME: I2C IR should be disconnected */ 22090c0d06caSMauro Carvalho Chehab 22100c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 22110c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->radio_dev)) 22120c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 22130c0d06caSMauro Carvalho Chehab else 22140c0d06caSMauro Carvalho Chehab video_device_release(dev->radio_dev); 22150c0d06caSMauro Carvalho Chehab dev->radio_dev = NULL; 22160c0d06caSMauro Carvalho Chehab } 22170c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 22180c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 22190c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 22200c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vbi_dev)) 22210c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 22220c0d06caSMauro Carvalho Chehab else 22230c0d06caSMauro Carvalho Chehab video_device_release(dev->vbi_dev); 22240c0d06caSMauro Carvalho Chehab dev->vbi_dev = NULL; 22250c0d06caSMauro Carvalho Chehab } 22260c0d06caSMauro Carvalho Chehab if (dev->vdev) { 22270c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 22280c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 22290c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vdev)) 22300c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 22310c0d06caSMauro Carvalho Chehab else 22320c0d06caSMauro Carvalho Chehab video_device_release(dev->vdev); 22330c0d06caSMauro Carvalho Chehab dev->vdev = NULL; 22340c0d06caSMauro Carvalho Chehab } 22350c0d06caSMauro Carvalho Chehab } 22360c0d06caSMauro Carvalho Chehab 22370c0d06caSMauro Carvalho Chehab /* 22380c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 22390c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 22400c0d06caSMauro Carvalho Chehab * calls and ioctls 22410c0d06caSMauro Carvalho Chehab */ 22420c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 22430c0d06caSMauro Carvalho Chehab { 22440c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 22450c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 22460c0d06caSMauro Carvalho Chehab int errCode; 22470c0d06caSMauro Carvalho Chehab 22480c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 22490c0d06caSMauro Carvalho Chehab 22500c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 22510c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VIDEO)) { 22520c0d06caSMauro Carvalho Chehab videobuf_stop(&fh->vb_vidq); 22530c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VIDEO); 22540c0d06caSMauro Carvalho Chehab } 22550c0d06caSMauro Carvalho Chehab 22560c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VBI)) { 22570c0d06caSMauro Carvalho Chehab videobuf_stop(&fh->vb_vbiq); 22580c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VBI); 22590c0d06caSMauro Carvalho Chehab } 22600c0d06caSMauro Carvalho Chehab 22610c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 22620c0d06caSMauro Carvalho Chehab /* the device is already disconnect, 22630c0d06caSMauro Carvalho Chehab free the remaining resources */ 22640c0d06caSMauro Carvalho Chehab if (dev->state & DEV_DISCONNECTED) { 22650c0d06caSMauro Carvalho Chehab em28xx_release_resources(dev); 22660c0d06caSMauro Carvalho Chehab kfree(dev->alt_max_pkt_size); 22670c0d06caSMauro Carvalho Chehab kfree(dev); 22680c0d06caSMauro Carvalho Chehab kfree(fh); 22690c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 22700c0d06caSMauro Carvalho Chehab return 0; 22710c0d06caSMauro Carvalho Chehab } 22720c0d06caSMauro Carvalho Chehab 22730c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 22740c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 22750c0d06caSMauro Carvalho Chehab 22760c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 22770c0d06caSMauro Carvalho Chehab em28xx_uninit_isoc(dev, EM28XX_ANALOG_MODE); 22780c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 22790c0d06caSMauro Carvalho Chehab 22800c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 22810c0d06caSMauro Carvalho Chehab dev->alt = 0; 22820c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 22830c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 22840c0d06caSMauro Carvalho Chehab if (errCode < 0) { 22850c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 22860c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 22870c0d06caSMauro Carvalho Chehab } 22880c0d06caSMauro Carvalho Chehab } 22890c0d06caSMauro Carvalho Chehab 22900c0d06caSMauro Carvalho Chehab videobuf_mmap_free(&fh->vb_vidq); 22910c0d06caSMauro Carvalho Chehab videobuf_mmap_free(&fh->vb_vbiq); 22920c0d06caSMauro Carvalho Chehab kfree(fh); 22930c0d06caSMauro Carvalho Chehab dev->users--; 22940c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 22950c0d06caSMauro Carvalho Chehab return 0; 22960c0d06caSMauro Carvalho Chehab } 22970c0d06caSMauro Carvalho Chehab 22980c0d06caSMauro Carvalho Chehab /* 22990c0d06caSMauro Carvalho Chehab * em28xx_v4l2_read() 23000c0d06caSMauro Carvalho Chehab * will allocate buffers when called for the first time 23010c0d06caSMauro Carvalho Chehab */ 23020c0d06caSMauro Carvalho Chehab static ssize_t 23030c0d06caSMauro Carvalho Chehab em28xx_v4l2_read(struct file *filp, char __user *buf, size_t count, 23040c0d06caSMauro Carvalho Chehab loff_t *pos) 23050c0d06caSMauro Carvalho Chehab { 23060c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 23070c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 23080c0d06caSMauro Carvalho Chehab int rc; 23090c0d06caSMauro Carvalho Chehab 23100c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 23110c0d06caSMauro Carvalho Chehab if (rc < 0) 23120c0d06caSMauro Carvalho Chehab return rc; 23130c0d06caSMauro Carvalho Chehab 23140c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 23150c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 23160c0d06caSMauro Carvalho Chehab /* FIXME: read() is not prepared to allow changing the video 23170c0d06caSMauro Carvalho Chehab resolution while streaming. Seems a bug at em28xx_set_fmt 23180c0d06caSMauro Carvalho Chehab */ 23190c0d06caSMauro Carvalho Chehab 23200c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 23210c0d06caSMauro Carvalho Chehab if (res_locked(dev, EM28XX_RESOURCE_VIDEO)) 23220c0d06caSMauro Carvalho Chehab rc = -EBUSY; 23230c0d06caSMauro Carvalho Chehab else 23240c0d06caSMauro Carvalho Chehab rc = videobuf_read_stream(&fh->vb_vidq, buf, count, pos, 0, 23250c0d06caSMauro Carvalho Chehab filp->f_flags & O_NONBLOCK); 23260c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 23270c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VBI)) 23280c0d06caSMauro Carvalho Chehab rc = -EBUSY; 23290c0d06caSMauro Carvalho Chehab else 23300c0d06caSMauro Carvalho Chehab rc = videobuf_read_stream(&fh->vb_vbiq, buf, count, pos, 0, 23310c0d06caSMauro Carvalho Chehab filp->f_flags & O_NONBLOCK); 23320c0d06caSMauro Carvalho Chehab } 23330c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 23340c0d06caSMauro Carvalho Chehab 23350c0d06caSMauro Carvalho Chehab return rc; 23360c0d06caSMauro Carvalho Chehab } 23370c0d06caSMauro Carvalho Chehab 23380c0d06caSMauro Carvalho Chehab /* 23390c0d06caSMauro Carvalho Chehab * em28xx_poll() 23400c0d06caSMauro Carvalho Chehab * will allocate buffers when called for the first time 23410c0d06caSMauro Carvalho Chehab */ 23420c0d06caSMauro Carvalho Chehab static unsigned int em28xx_poll(struct file *filp, poll_table *wait) 23430c0d06caSMauro Carvalho Chehab { 23440c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 23450c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 23460c0d06caSMauro Carvalho Chehab int rc; 23470c0d06caSMauro Carvalho Chehab 23480c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 23490c0d06caSMauro Carvalho Chehab if (rc < 0) 23500c0d06caSMauro Carvalho Chehab return rc; 23510c0d06caSMauro Carvalho Chehab 23520c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 23530c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VIDEO)) 23540c0d06caSMauro Carvalho Chehab return POLLERR; 23550c0d06caSMauro Carvalho Chehab return videobuf_poll_stream(filp, &fh->vb_vidq, wait); 23560c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 23570c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VBI)) 23580c0d06caSMauro Carvalho Chehab return POLLERR; 23590c0d06caSMauro Carvalho Chehab return videobuf_poll_stream(filp, &fh->vb_vbiq, wait); 23600c0d06caSMauro Carvalho Chehab } else { 23610c0d06caSMauro Carvalho Chehab return POLLERR; 23620c0d06caSMauro Carvalho Chehab } 23630c0d06caSMauro Carvalho Chehab } 23640c0d06caSMauro Carvalho Chehab 23650c0d06caSMauro Carvalho Chehab static unsigned int em28xx_v4l2_poll(struct file *filp, poll_table *wait) 23660c0d06caSMauro Carvalho Chehab { 23670c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 23680c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 23690c0d06caSMauro Carvalho Chehab unsigned int res; 23700c0d06caSMauro Carvalho Chehab 23710c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 23720c0d06caSMauro Carvalho Chehab res = em28xx_poll(filp, wait); 23730c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 23740c0d06caSMauro Carvalho Chehab return res; 23750c0d06caSMauro Carvalho Chehab } 23760c0d06caSMauro Carvalho Chehab 23770c0d06caSMauro Carvalho Chehab /* 23780c0d06caSMauro Carvalho Chehab * em28xx_v4l2_mmap() 23790c0d06caSMauro Carvalho Chehab */ 23800c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_mmap(struct file *filp, struct vm_area_struct *vma) 23810c0d06caSMauro Carvalho Chehab { 23820c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 23830c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 23840c0d06caSMauro Carvalho Chehab int rc; 23850c0d06caSMauro Carvalho Chehab 23860c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 23870c0d06caSMauro Carvalho Chehab if (rc < 0) 23880c0d06caSMauro Carvalho Chehab return rc; 23890c0d06caSMauro Carvalho Chehab 23900c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 23910c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 23920c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 23930c0d06caSMauro Carvalho Chehab rc = videobuf_mmap_mapper(&fh->vb_vidq, vma); 23940c0d06caSMauro Carvalho Chehab else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) 23950c0d06caSMauro Carvalho Chehab rc = videobuf_mmap_mapper(&fh->vb_vbiq, vma); 23960c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 23970c0d06caSMauro Carvalho Chehab 23980c0d06caSMauro Carvalho Chehab em28xx_videodbg("vma start=0x%08lx, size=%ld, ret=%d\n", 23990c0d06caSMauro Carvalho Chehab (unsigned long)vma->vm_start, 24000c0d06caSMauro Carvalho Chehab (unsigned long)vma->vm_end-(unsigned long)vma->vm_start, 24010c0d06caSMauro Carvalho Chehab rc); 24020c0d06caSMauro Carvalho Chehab 24030c0d06caSMauro Carvalho Chehab return rc; 24040c0d06caSMauro Carvalho Chehab } 24050c0d06caSMauro Carvalho Chehab 24060c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 24070c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 24080c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 24090c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 24100c0d06caSMauro Carvalho Chehab .read = em28xx_v4l2_read, 24110c0d06caSMauro Carvalho Chehab .poll = em28xx_v4l2_poll, 24120c0d06caSMauro Carvalho Chehab .mmap = em28xx_v4l2_mmap, 24130c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 24140c0d06caSMauro Carvalho Chehab }; 24150c0d06caSMauro Carvalho Chehab 24160c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 24170c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 24180c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 24190c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 24200c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 24210c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 24220c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 24230c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vbi_cap = vidioc_s_fmt_vbi_cap, 24240c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 24250c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 24260c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 24270c0d06caSMauro Carvalho Chehab .vidioc_cropcap = vidioc_cropcap, 24280c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_sliced_vbi_cap = vidioc_g_fmt_sliced_vbi_cap, 24290c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_sliced_vbi_cap = vidioc_try_set_sliced_vbi_cap, 24300c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_sliced_vbi_cap = vidioc_try_set_sliced_vbi_cap, 24310c0d06caSMauro Carvalho Chehab 24320c0d06caSMauro Carvalho Chehab .vidioc_reqbufs = vidioc_reqbufs, 24330c0d06caSMauro Carvalho Chehab .vidioc_querybuf = vidioc_querybuf, 24340c0d06caSMauro Carvalho Chehab .vidioc_qbuf = vidioc_qbuf, 24350c0d06caSMauro Carvalho Chehab .vidioc_dqbuf = vidioc_dqbuf, 24360c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 24370c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 24380c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 24390c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 24400c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 24410c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 24420c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 24430c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 24440c0d06caSMauro Carvalho Chehab .vidioc_queryctrl = vidioc_queryctrl, 24450c0d06caSMauro Carvalho Chehab .vidioc_g_ctrl = vidioc_g_ctrl, 24460c0d06caSMauro Carvalho Chehab .vidioc_s_ctrl = vidioc_s_ctrl, 24470c0d06caSMauro Carvalho Chehab .vidioc_streamon = vidioc_streamon, 24480c0d06caSMauro Carvalho Chehab .vidioc_streamoff = vidioc_streamoff, 24490c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 24500c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 24510c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 24520c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 24530c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 24540c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24550c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24560c0d06caSMauro Carvalho Chehab .vidioc_g_chip_ident = vidioc_g_chip_ident, 24570c0d06caSMauro Carvalho Chehab #endif 24580c0d06caSMauro Carvalho Chehab }; 24590c0d06caSMauro Carvalho Chehab 24600c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 24610c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 24620c0d06caSMauro Carvalho Chehab .release = video_device_release, 24630c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 24640c0d06caSMauro Carvalho Chehab 24650c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 24660c0d06caSMauro Carvalho Chehab .current_norm = V4L2_STD_PAL, 24670c0d06caSMauro Carvalho Chehab }; 24680c0d06caSMauro Carvalho Chehab 24690c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 24700c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 24710c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 24720c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 24730c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 24740c0d06caSMauro Carvalho Chehab }; 24750c0d06caSMauro Carvalho Chehab 24760c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 24770c0d06caSMauro Carvalho Chehab .vidioc_querycap = radio_querycap, 24780c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 24790c0d06caSMauro Carvalho Chehab .vidioc_enum_input = radio_enum_input, 24800c0d06caSMauro Carvalho Chehab .vidioc_g_audio = radio_g_audio, 24810c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 24820c0d06caSMauro Carvalho Chehab .vidioc_s_audio = radio_s_audio, 24830c0d06caSMauro Carvalho Chehab .vidioc_s_input = radio_s_input, 24840c0d06caSMauro Carvalho Chehab .vidioc_queryctrl = radio_queryctrl, 24850c0d06caSMauro Carvalho Chehab .vidioc_g_ctrl = vidioc_g_ctrl, 24860c0d06caSMauro Carvalho Chehab .vidioc_s_ctrl = vidioc_s_ctrl, 24870c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 24880c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 24890c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 24900c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24910c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24920c0d06caSMauro Carvalho Chehab #endif 24930c0d06caSMauro Carvalho Chehab }; 24940c0d06caSMauro Carvalho Chehab 24950c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 24960c0d06caSMauro Carvalho Chehab .name = "em28xx-radio", 24970c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 24980c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 24990c0d06caSMauro Carvalho Chehab }; 25000c0d06caSMauro Carvalho Chehab 25010c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 25020c0d06caSMauro Carvalho Chehab 25030c0d06caSMauro Carvalho Chehab 25040c0d06caSMauro Carvalho Chehab 25050c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 25060c0d06caSMauro Carvalho Chehab const struct video_device *template, 25070c0d06caSMauro Carvalho Chehab const char *type_name) 25080c0d06caSMauro Carvalho Chehab { 25090c0d06caSMauro Carvalho Chehab struct video_device *vfd; 25100c0d06caSMauro Carvalho Chehab 25110c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 25120c0d06caSMauro Carvalho Chehab if (NULL == vfd) 25130c0d06caSMauro Carvalho Chehab return NULL; 25140c0d06caSMauro Carvalho Chehab 25150c0d06caSMauro Carvalho Chehab *vfd = *template; 25160c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 25170c0d06caSMauro Carvalho Chehab vfd->release = video_device_release; 25180c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 25190c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 25200c0d06caSMauro Carvalho Chehab 25210c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 25220c0d06caSMauro Carvalho Chehab dev->name, type_name); 25230c0d06caSMauro Carvalho Chehab 25240c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 25250c0d06caSMauro Carvalho Chehab return vfd; 25260c0d06caSMauro Carvalho Chehab } 25270c0d06caSMauro Carvalho Chehab 25280c0d06caSMauro Carvalho Chehab int em28xx_register_analog_devices(struct em28xx *dev) 25290c0d06caSMauro Carvalho Chehab { 25300c0d06caSMauro Carvalho Chehab u8 val; 25310c0d06caSMauro Carvalho Chehab int ret; 25320c0d06caSMauro Carvalho Chehab unsigned int maxw; 25330c0d06caSMauro Carvalho Chehab 25340c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s: v4l2 driver version %s\n", 25350c0d06caSMauro Carvalho Chehab dev->name, EM28XX_VERSION); 25360c0d06caSMauro Carvalho Chehab 25370c0d06caSMauro Carvalho Chehab /* set default norm */ 25380c0d06caSMauro Carvalho Chehab dev->norm = em28xx_video_template.current_norm; 25390c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 25400c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 25410c0d06caSMauro Carvalho Chehab 25420c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 25430c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 25440c0d06caSMauro Carvalho Chehab 25450c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 25460c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 25470c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 25480c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 25490c0d06caSMauro Carvalho Chehab maxw /= 2; 25500c0d06caSMauro Carvalho Chehab 25510c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 25520c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 25530c0d06caSMauro Carvalho Chehab 25540c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 25550c0d06caSMauro Carvalho Chehab 25560c0d06caSMauro Carvalho Chehab /* Audio defaults */ 25570c0d06caSMauro Carvalho Chehab dev->mute = 1; 25580c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 25590c0d06caSMauro Carvalho Chehab 25600c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 25610c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 25620c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 25630c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 25640c0d06caSMauro Carvalho Chehab 25650c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 25660c0d06caSMauro Carvalho Chehab em28xx_colorlevels_set_default(dev); 25670c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 25680c0d06caSMauro Carvalho Chehab 25690c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 25700c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 25710c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 25720c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 25730c0d06caSMauro Carvalho Chehab return -ENODEV; 25740c0d06caSMauro Carvalho Chehab } 25750c0d06caSMauro Carvalho Chehab 25760c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 25770c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 25780c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 25790c0d06caSMauro Carvalho Chehab if (ret) { 25800c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 25810c0d06caSMauro Carvalho Chehab ret); 25820c0d06caSMauro Carvalho Chehab return ret; 25830c0d06caSMauro Carvalho Chehab } 25840c0d06caSMauro Carvalho Chehab 25850c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 25860c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 25870c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 25880c0d06caSMauro Carvalho Chehab "vbi"); 25890c0d06caSMauro Carvalho Chehab 25900c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 25910c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 25920c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 25930c0d06caSMauro Carvalho Chehab if (ret < 0) { 25940c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 25950c0d06caSMauro Carvalho Chehab return ret; 25960c0d06caSMauro Carvalho Chehab } 25970c0d06caSMauro Carvalho Chehab } 25980c0d06caSMauro Carvalho Chehab 25990c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 26000c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 26010c0d06caSMauro Carvalho Chehab "radio"); 26020c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 26030c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 26040c0d06caSMauro Carvalho Chehab return -ENODEV; 26050c0d06caSMauro Carvalho Chehab } 26060c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 26070c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 26080c0d06caSMauro Carvalho Chehab if (ret < 0) { 26090c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 26100c0d06caSMauro Carvalho Chehab return ret; 26110c0d06caSMauro Carvalho Chehab } 26120c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 26130c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 26140c0d06caSMauro Carvalho Chehab } 26150c0d06caSMauro Carvalho Chehab 26160c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 26170c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 26180c0d06caSMauro Carvalho Chehab 26190c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 26200c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 26210c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 26220c0d06caSMauro Carvalho Chehab 26230c0d06caSMauro Carvalho Chehab return 0; 26240c0d06caSMauro Carvalho Chehab } 2625