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> 90fa4a402SFrank Schaefer Copyright (C) 2012 Frank Schäfer <fschaefer.oss@googlemail.com> 100c0d06caSMauro Carvalho Chehab 110c0d06caSMauro Carvalho Chehab Some parts based on SN9C10x PC Camera Controllers GPL driver made 120c0d06caSMauro Carvalho Chehab by Luca Risolia <luca.risolia@studio.unibo.it> 130c0d06caSMauro Carvalho Chehab 140c0d06caSMauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 150c0d06caSMauro Carvalho Chehab it under the terms of the GNU General Public License as published by 160c0d06caSMauro Carvalho Chehab the Free Software Foundation; either version 2 of the License, or 170c0d06caSMauro Carvalho Chehab (at your option) any later version. 180c0d06caSMauro Carvalho Chehab 190c0d06caSMauro Carvalho Chehab This program is distributed in the hope that it will be useful, 200c0d06caSMauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 210c0d06caSMauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 220c0d06caSMauro Carvalho Chehab GNU General Public License for more details. 230c0d06caSMauro Carvalho Chehab 240c0d06caSMauro Carvalho Chehab You should have received a copy of the GNU General Public License 250c0d06caSMauro Carvalho Chehab along with this program; if not, write to the Free Software 260c0d06caSMauro Carvalho Chehab Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 270c0d06caSMauro Carvalho Chehab */ 280c0d06caSMauro Carvalho Chehab 290c0d06caSMauro Carvalho Chehab #include <linux/init.h> 300c0d06caSMauro Carvalho Chehab #include <linux/list.h> 310c0d06caSMauro Carvalho Chehab #include <linux/module.h> 320c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 330c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 340c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 350c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 360c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 370c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 380c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 390c0d06caSMauro Carvalho Chehab 400c0d06caSMauro Carvalho Chehab #include "em28xx.h" 410c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 420c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4350fdf40fSHans Verkuil #include <media/v4l2-event.h> 440c0d06caSMauro Carvalho Chehab #include <media/msp3400.h> 450c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 460c0d06caSMauro Carvalho Chehab 470c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 480c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 490c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 500c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 510c0d06caSMauro Carvalho Chehab 520c0d06caSMauro Carvalho Chehab #define DRIVER_DESC "Empia em28xx based USB video device driver" 530c0d06caSMauro Carvalho Chehab 5443a20d79SFrank Schaefer #define EM28XX_VERSION "0.2.0" 550c0d06caSMauro Carvalho Chehab 560c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 570c0d06caSMauro Carvalho Chehab if (video_debug) \ 580c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 590c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 600c0d06caSMauro Carvalho Chehab 610c0d06caSMauro Carvalho Chehab static unsigned int isoc_debug; 620c0d06caSMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 630c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 640c0d06caSMauro Carvalho Chehab 650c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 660c0d06caSMauro Carvalho Chehab do {\ 670c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 680c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 690c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 700c0d06caSMauro Carvalho Chehab } \ 710c0d06caSMauro Carvalho Chehab } while (0) 720c0d06caSMauro Carvalho Chehab 730c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 740c0d06caSMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC); 750c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 760c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 770c0d06caSMauro Carvalho Chehab 78e507e0e5SFrank Schaefer 79e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 80e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 81e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 82e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 83e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 84e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 85e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 86e507e0e5SFrank Schaefer 87e507e0e5SFrank Schaefer 88d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 89d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 90d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 910c0d06caSMauro Carvalho Chehab 920c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 930c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 940c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 950c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 960c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 970c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 980c0d06caSMauro Carvalho Chehab 990c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 1000c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1010c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1020c0d06caSMauro Carvalho Chehab 1030c0d06caSMauro Carvalho Chehab /* supported video standards */ 1040c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1050c0d06caSMauro Carvalho Chehab { 1060c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1070c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1080c0d06caSMauro Carvalho Chehab .depth = 16, 1090c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1100c0d06caSMauro Carvalho Chehab }, { 1110c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1120c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1130c0d06caSMauro Carvalho Chehab .depth = 16, 1140c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1150c0d06caSMauro Carvalho Chehab }, { 1160c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1170c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1180c0d06caSMauro Carvalho Chehab .depth = 8, 1190c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1200c0d06caSMauro Carvalho Chehab }, { 1210c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1220c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1230c0d06caSMauro Carvalho Chehab .depth = 8, 1240c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1250c0d06caSMauro Carvalho Chehab }, { 1260c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1270c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1280c0d06caSMauro Carvalho Chehab .depth = 8, 1290c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1300c0d06caSMauro Carvalho Chehab }, { 1310c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1320c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1330c0d06caSMauro Carvalho Chehab .depth = 12, 1340c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1350c0d06caSMauro Carvalho Chehab }, 1360c0d06caSMauro Carvalho Chehab }; 1370c0d06caSMauro Carvalho Chehab 1380c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1390c0d06caSMauro Carvalho Chehab DMA and thread functions 1400c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 1410c0d06caSMauro Carvalho Chehab 1420c0d06caSMauro Carvalho Chehab /* 143948a49aaSFrank Schaefer * Finish the current buffer 1440c0d06caSMauro Carvalho Chehab */ 145948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 1460c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 1470c0d06caSMauro Carvalho Chehab { 148d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 149d3829fadSDevin Heitmueller 150d3829fadSDevin Heitmueller buf->vb.v4l2_buf.sequence = dev->field_count++; 151d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 152d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 153d3829fadSDevin Heitmueller 154d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 1550c0d06caSMauro Carvalho Chehab } 1560c0d06caSMauro Carvalho Chehab 1570c0d06caSMauro Carvalho Chehab /* 15836016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 1590c0d06caSMauro Carvalho Chehab */ 1600c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 1610c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 16236016a35SFrank Schaefer unsigned char *usb_buf, 1634078d625SFrank Schaefer unsigned long len) 1640c0d06caSMauro Carvalho Chehab { 1650c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 1660c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 1670c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 1680c0d06caSMauro Carvalho Chehab 169d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 170d3829fadSDevin Heitmueller len = buf->length - buf->pos; 1710c0d06caSMauro Carvalho Chehab 17236016a35SFrank Schaefer startread = usb_buf; 1730c0d06caSMauro Carvalho Chehab remain = len; 1740c0d06caSMauro Carvalho Chehab 175c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 17636016a35SFrank Schaefer fieldstart = buf->vb_buf; 177c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 17836016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 1790c0d06caSMauro Carvalho Chehab 1808732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 1818732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 1820c0d06caSMauro Carvalho Chehab 1830c0d06caSMauro Carvalho Chehab if (dev->progressive) 1840c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 1850c0d06caSMauro Carvalho Chehab else 1860c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 1870c0d06caSMauro Carvalho Chehab 1880c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 1890c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 1900c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 1910c0d06caSMauro Carvalho Chehab 192d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 1930c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 1940c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 195d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 196d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 19736016a35SFrank Schaefer (char *)startwrite; 1980c0d06caSMauro Carvalho Chehab lencopy = remain; 1990c0d06caSMauro Carvalho Chehab } 2000c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2010c0d06caSMauro Carvalho Chehab return; 2020c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2030c0d06caSMauro Carvalho Chehab 2040c0d06caSMauro Carvalho Chehab remain -= lencopy; 2050c0d06caSMauro Carvalho Chehab 2060c0d06caSMauro Carvalho Chehab while (remain > 0) { 207c02ec71bSFrank Schaefer if (dev->progressive) 208c02ec71bSFrank Schaefer startwrite += lencopy; 209c02ec71bSFrank Schaefer else 2100c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 2110c0d06caSMauro Carvalho Chehab startread += lencopy; 2120c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 2130c0d06caSMauro Carvalho Chehab lencopy = remain; 2140c0d06caSMauro Carvalho Chehab else 2150c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 2160c0d06caSMauro Carvalho Chehab 21736016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 218d3829fadSDevin Heitmueller buf->length) { 2190c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 2200c0d06caSMauro Carvalho Chehab "(2)\n", 2210c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 222d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 223d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 2240c0d06caSMauro Carvalho Chehab (char *)startwrite; 2250c0d06caSMauro Carvalho Chehab } 2260c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2270c0d06caSMauro Carvalho Chehab break; 2280c0d06caSMauro Carvalho Chehab 2290c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2300c0d06caSMauro Carvalho Chehab 2310c0d06caSMauro Carvalho Chehab remain -= lencopy; 2320c0d06caSMauro Carvalho Chehab } 2330c0d06caSMauro Carvalho Chehab 2348732533bSFrank Schaefer buf->pos += len; 2350c0d06caSMauro Carvalho Chehab } 2360c0d06caSMauro Carvalho Chehab 23736016a35SFrank Schaefer /* 23836016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 23936016a35SFrank Schaefer */ 2400c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 2410c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 24236016a35SFrank Schaefer unsigned char *usb_buf, 2434078d625SFrank Schaefer unsigned long len) 2440c0d06caSMauro Carvalho Chehab { 24536016a35SFrank Schaefer unsigned int offset; 2460c0d06caSMauro Carvalho Chehab 247d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 248d3829fadSDevin Heitmueller len = buf->length - buf->pos; 2490c0d06caSMauro Carvalho Chehab 2508732533bSFrank Schaefer offset = buf->pos; 2510c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 25236016a35SFrank Schaefer if (buf->top_field == 0) 25336016a35SFrank Schaefer offset += dev->vbi_width * dev->vbi_height; 2540c0d06caSMauro Carvalho Chehab 25536016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 2568732533bSFrank Schaefer buf->pos += len; 2570c0d06caSMauro Carvalho Chehab } 2580c0d06caSMauro Carvalho Chehab 2590c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 2600c0d06caSMauro Carvalho Chehab int packet, int status) 2610c0d06caSMauro Carvalho Chehab { 2620c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 2630c0d06caSMauro Carvalho Chehab 2640c0d06caSMauro Carvalho Chehab switch (status) { 2650c0d06caSMauro Carvalho Chehab case -ENOENT: 2660c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 2670c0d06caSMauro Carvalho Chehab break; 2680c0d06caSMauro Carvalho Chehab case -ECONNRESET: 2690c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 2700c0d06caSMauro Carvalho Chehab break; 2710c0d06caSMauro Carvalho Chehab case -ENOSR: 2720c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 2730c0d06caSMauro Carvalho Chehab break; 2740c0d06caSMauro Carvalho Chehab case -EPIPE: 2750c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 2760c0d06caSMauro Carvalho Chehab break; 2770c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 2780c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 2790c0d06caSMauro Carvalho Chehab break; 2800c0d06caSMauro Carvalho Chehab case -EPROTO: 2810c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 2820c0d06caSMauro Carvalho Chehab break; 2830c0d06caSMauro Carvalho Chehab case -EILSEQ: 2840c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 2850c0d06caSMauro Carvalho Chehab break; 2860c0d06caSMauro Carvalho Chehab case -ETIME: 2870c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 2880c0d06caSMauro Carvalho Chehab break; 2890c0d06caSMauro Carvalho Chehab } 2900c0d06caSMauro Carvalho Chehab if (packet < 0) { 2910c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 2920c0d06caSMauro Carvalho Chehab } else { 2930c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 2940c0d06caSMauro Carvalho Chehab packet, status, errmsg); 2950c0d06caSMauro Carvalho Chehab } 2960c0d06caSMauro Carvalho Chehab } 2970c0d06caSMauro Carvalho Chehab 2980c0d06caSMauro Carvalho Chehab /* 29924a6d849SFrank Schaefer * get the next available buffer from dma queue 3000c0d06caSMauro Carvalho Chehab */ 30124a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 30224a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 3030c0d06caSMauro Carvalho Chehab { 30424a6d849SFrank Schaefer struct em28xx_buffer *buf; 3050c0d06caSMauro Carvalho Chehab 3060c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 3070c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 30824a6d849SFrank Schaefer return NULL; 3090c0d06caSMauro Carvalho Chehab } 3100c0d06caSMauro Carvalho Chehab 3110c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 312d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 3130c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 314d3829fadSDevin Heitmueller list_del(&buf->list); 3158732533bSFrank Schaefer buf->pos = 0; 316d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 3170c0d06caSMauro Carvalho Chehab 31824a6d849SFrank Schaefer return buf; 3190c0d06caSMauro Carvalho Chehab } 3200c0d06caSMauro Carvalho Chehab 321e04c00d9SFrank Schaefer /* 322e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 323e04c00d9SFrank Schaefer */ 324e04c00d9SFrank Schaefer static struct em28xx_buffer * 325e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 326e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 327e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 328e04c00d9SFrank Schaefer { 329e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 330e04c00d9SFrank Schaefer if (buf != NULL) 331e04c00d9SFrank Schaefer finish_buffer(dev, buf); 332e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 333e04c00d9SFrank Schaefer } 334e04c00d9SFrank Schaefer if (buf != NULL) { 335e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 336e04c00d9SFrank Schaefer buf->pos = 0; 337e04c00d9SFrank Schaefer } 338e04c00d9SFrank Schaefer 339e04c00d9SFrank Schaefer return buf; 340e04c00d9SFrank Schaefer } 341e04c00d9SFrank Schaefer 342227b7c90SFrank Schaefer /* 343227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 344227b7c90SFrank Schaefer */ 345227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 346227b7c90SFrank Schaefer unsigned char *data_pkt, 347227b7c90SFrank Schaefer unsigned int data_len) 348227b7c90SFrank Schaefer { 349227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 350227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 351227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 352227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 353227b7c90SFrank Schaefer 354227b7c90SFrank Schaefer /* capture type 0 = vbi start 355227b7c90SFrank Schaefer capture type 1 = vbi in progress 356227b7c90SFrank Schaefer capture type 2 = video start 357227b7c90SFrank Schaefer capture type 3 = video in progress */ 358227b7c90SFrank Schaefer if (data_len >= 4) { 359227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 360227b7c90SFrank Schaefer * never split across packets */ 361227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 362227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 363227b7c90SFrank Schaefer /* Continuation */ 364227b7c90SFrank Schaefer data_pkt += 4; 365227b7c90SFrank Schaefer data_len -= 4; 366227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 367227b7c90SFrank Schaefer /* Field start (VBI mode) */ 368227b7c90SFrank Schaefer dev->capture_type = 0; 369227b7c90SFrank Schaefer dev->vbi_read = 0; 370227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 371227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 372227b7c90SFrank Schaefer data_pkt += 4; 373227b7c90SFrank Schaefer data_len -= 4; 374227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 375227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 376227b7c90SFrank Schaefer dev->capture_type = 2; 377227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 378227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 379227b7c90SFrank Schaefer data_pkt += 4; 380227b7c90SFrank Schaefer data_len -= 4; 381227b7c90SFrank Schaefer } 382227b7c90SFrank Schaefer } 383227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 384227b7c90SFrank Schaefer * have no continuation header */ 385227b7c90SFrank Schaefer 386227b7c90SFrank Schaefer if (dev->capture_type == 0) { 387227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 388227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 389227b7c90SFrank Schaefer dev->capture_type = 1; 390227b7c90SFrank Schaefer } 391227b7c90SFrank Schaefer 392227b7c90SFrank Schaefer if (dev->capture_type == 1) { 393227b7c90SFrank Schaefer int vbi_size = dev->vbi_width * dev->vbi_height; 394227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 395227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 396227b7c90SFrank Schaefer 397227b7c90SFrank Schaefer /* Copy VBI data */ 398227b7c90SFrank Schaefer if (vbi_buf != NULL) 399227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 400227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 401227b7c90SFrank Schaefer 402227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 403227b7c90SFrank Schaefer /* Continue with copying video data */ 404227b7c90SFrank Schaefer dev->capture_type = 2; 405227b7c90SFrank Schaefer data_pkt += vbi_data_len; 406227b7c90SFrank Schaefer data_len -= vbi_data_len; 407227b7c90SFrank Schaefer } 408227b7c90SFrank Schaefer } 409227b7c90SFrank Schaefer 410227b7c90SFrank Schaefer if (dev->capture_type == 2) { 411227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 412227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 413227b7c90SFrank Schaefer dev->capture_type = 3; 414227b7c90SFrank Schaefer } 415227b7c90SFrank Schaefer 416227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 417227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 418227b7c90SFrank Schaefer } 419227b7c90SFrank Schaefer 420e507e0e5SFrank Schaefer /* 421e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 422e507e0e5SFrank Schaefer */ 423e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 424e507e0e5SFrank Schaefer unsigned char *data_pkt, 425e507e0e5SFrank Schaefer unsigned int data_len) 426e507e0e5SFrank Schaefer { 427e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 428e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 429e507e0e5SFrank Schaefer bool frame_end = 0; 430e507e0e5SFrank Schaefer 431e507e0e5SFrank Schaefer /* Check for header */ 432e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 433e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 434e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 435e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 436e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 437e507e0e5SFrank Schaefer dev->top_field = !(data_pkt[1] & 438e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 439e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 440e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 441e507e0e5SFrank Schaefer data_pkt += 2; 442e507e0e5SFrank Schaefer data_len -= 2; 443e507e0e5SFrank Schaefer } 444e507e0e5SFrank Schaefer 445e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 446e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 447e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 448e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 449e507e0e5SFrank Schaefer } 450e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 451e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 452e507e0e5SFrank Schaefer * first frame. 453e507e0e5SFrank Schaefer */ 454e507e0e5SFrank Schaefer } 455e507e0e5SFrank Schaefer 456e507e0e5SFrank Schaefer /* Copy data */ 457e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 458e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 459e507e0e5SFrank Schaefer 460e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 461e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 462e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 463e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 464e507e0e5SFrank Schaefer } 465e507e0e5SFrank Schaefer 466e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 467e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 468e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 469e507e0e5SFrank Schaefer * header like with the other em28xx devices. 470e507e0e5SFrank Schaefer */ 471e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 472e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 473e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 474e507e0e5SFrank Schaefer } 475e507e0e5SFrank Schaefer 476960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 4770fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 4780c0d06caSMauro Carvalho Chehab { 479227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 480227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 481227b7c90SFrank Schaefer unsigned int usb_data_len; 4820c0d06caSMauro Carvalho Chehab 4830c0d06caSMauro Carvalho Chehab if (!dev) 4840c0d06caSMauro Carvalho Chehab return 0; 4850c0d06caSMauro Carvalho Chehab 4862665c299SFrank Schaefer if (dev->disconnected) 4870c0d06caSMauro Carvalho Chehab return 0; 4880c0d06caSMauro Carvalho Chehab 4891653cb0cSFrank Schaefer if (urb->status < 0) 4900c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 4910c0d06caSMauro Carvalho Chehab 4924601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 4934601cc39SFrank Schaefer 4944601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 4954601cc39SFrank Schaefer num_packets = 1; 4964601cc39SFrank Schaefer else /* isoc */ 4974601cc39SFrank Schaefer num_packets = urb->number_of_packets; 4980c0d06caSMauro Carvalho Chehab 4994601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 5004601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 501227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 5024601cc39SFrank Schaefer 503227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 5044601cc39SFrank Schaefer } else { /* isoc */ 5054601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 5064601cc39SFrank Schaefer print_err_status(dev, i, 5074601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 5080c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 5090c0d06caSMauro Carvalho Chehab continue; 5100c0d06caSMauro Carvalho Chehab } 5110c0d06caSMauro Carvalho Chehab 512227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 513227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 5140c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 5150c0d06caSMauro Carvalho Chehab continue; 5160c0d06caSMauro Carvalho Chehab } 5170c0d06caSMauro Carvalho Chehab 518227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 5194601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 5204601cc39SFrank Schaefer } 5214601cc39SFrank Schaefer 522227b7c90SFrank Schaefer if (usb_data_len == 0) { 5234601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 5244601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 5254601cc39SFrank Schaefer continue; 5264601cc39SFrank Schaefer } 5270c0d06caSMauro Carvalho Chehab 528e507e0e5SFrank Schaefer if (dev->is_em25xx) 529e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 530e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 531e507e0e5SFrank Schaefer else 532e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 533e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 534e507e0e5SFrank Schaefer 5350c0d06caSMauro Carvalho Chehab } 536227b7c90SFrank Schaefer return 1; 5370c0d06caSMauro Carvalho Chehab } 5380c0d06caSMauro Carvalho Chehab 5390c0d06caSMauro Carvalho Chehab 540d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 541d3829fadSDevin Heitmueller { 542d3829fadSDevin Heitmueller switch (f_type) { 543d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 544d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 545d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 546d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 547d3829fadSDevin Heitmueller default: 548d3829fadSDevin Heitmueller BUG(); 549d3829fadSDevin Heitmueller return 0; 550d3829fadSDevin Heitmueller } 551d3829fadSDevin Heitmueller } 552d3829fadSDevin Heitmueller 553d3829fadSDevin Heitmueller /* Usage lock check functions */ 554d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 555d3829fadSDevin Heitmueller { 556d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 557d3829fadSDevin Heitmueller 558d3829fadSDevin Heitmueller /* is it free? */ 559d3829fadSDevin Heitmueller if (dev->resources & res_type) { 560d3829fadSDevin Heitmueller /* no, someone else uses it */ 561d3829fadSDevin Heitmueller return -EBUSY; 562d3829fadSDevin Heitmueller } 563d3829fadSDevin Heitmueller 564d3829fadSDevin Heitmueller /* it's free, grab it */ 565d3829fadSDevin Heitmueller dev->resources |= res_type; 566d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 567d3829fadSDevin Heitmueller return 0; 568d3829fadSDevin Heitmueller } 569d3829fadSDevin Heitmueller 570d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 571d3829fadSDevin Heitmueller { 572d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 573d3829fadSDevin Heitmueller 574d3829fadSDevin Heitmueller dev->resources &= ~res_type; 575d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 576d3829fadSDevin Heitmueller } 577d3829fadSDevin Heitmueller 5780c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 579d3829fadSDevin Heitmueller Videobuf2 operations 5800c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 5810c0d06caSMauro Carvalho Chehab 582d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 583d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 584d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 5850c0d06caSMauro Carvalho Chehab { 586d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 587d3829fadSDevin Heitmueller unsigned long size; 5880c0d06caSMauro Carvalho Chehab 589d3829fadSDevin Heitmueller if (fmt) 590d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 591d3829fadSDevin Heitmueller else 592d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 5930c0d06caSMauro Carvalho Chehab 594d3829fadSDevin Heitmueller if (size == 0) 595d3829fadSDevin Heitmueller return -EINVAL; 5960c0d06caSMauro Carvalho Chehab 597d3829fadSDevin Heitmueller if (0 == *nbuffers) 598d3829fadSDevin Heitmueller *nbuffers = 32; 5990c0d06caSMauro Carvalho Chehab 600d3829fadSDevin Heitmueller *nplanes = 1; 601d3829fadSDevin Heitmueller sizes[0] = size; 6020c0d06caSMauro Carvalho Chehab 6030c0d06caSMauro Carvalho Chehab return 0; 6040c0d06caSMauro Carvalho Chehab } 6050c0d06caSMauro Carvalho Chehab 6060c0d06caSMauro Carvalho Chehab static int 607d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 6080c0d06caSMauro Carvalho Chehab { 609d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 6100c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 611d3829fadSDevin Heitmueller unsigned long size; 6120c0d06caSMauro Carvalho Chehab 613d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 6140c0d06caSMauro Carvalho Chehab 615d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 616d3829fadSDevin Heitmueller 617d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 618d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 619d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 6200c0d06caSMauro Carvalho Chehab return -EINVAL; 621d3829fadSDevin Heitmueller } 622d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 6230c0d06caSMauro Carvalho Chehab 624d3829fadSDevin Heitmueller return 0; 6250c0d06caSMauro Carvalho Chehab } 6260c0d06caSMauro Carvalho Chehab 627d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 628d3829fadSDevin Heitmueller { 629d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 630d3829fadSDevin Heitmueller struct v4l2_frequency f; 631d3829fadSDevin Heitmueller int rc = 0; 6320c0d06caSMauro Carvalho Chehab 633d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 634d3829fadSDevin Heitmueller 635d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 636d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 637d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 638d3829fadSDevin Heitmueller if (rc) 639d3829fadSDevin Heitmueller return rc; 640d3829fadSDevin Heitmueller 641032f1ddfSFrank Schaefer if (dev->streaming_users == 0) { 642d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 643d3829fadSDevin Heitmueller 644d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 645d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 646d3829fadSDevin Heitmueller 647d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 648d3829fadSDevin Heitmueller some i2c device 649d3829fadSDevin Heitmueller */ 650d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 651d3829fadSDevin Heitmueller 6520455eebfSFrank Schaefer dev->capture_type = -1; 653c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 654c647a91aSFrank Schaefer dev->analog_xfer_bulk, 6550c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 6560c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 657c647a91aSFrank Schaefer dev->packet_multiplier, 6580fa4a402SFrank Schaefer em28xx_urb_data_copy); 6590c0d06caSMauro Carvalho Chehab if (rc < 0) 660032f1ddfSFrank Schaefer return rc; 661d3829fadSDevin Heitmueller 662d3829fadSDevin Heitmueller /* 663d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 664d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 665d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 666d3829fadSDevin Heitmueller */ 667d3829fadSDevin Heitmueller 668d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 669d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 670d3829fadSDevin Heitmueller f.frequency = dev->ctl_freq; 671d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 672d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 673d3829fadSDevin Heitmueller else 674d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 675d3829fadSDevin Heitmueller v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 6760c0d06caSMauro Carvalho Chehab } 6770c0d06caSMauro Carvalho Chehab 678032f1ddfSFrank Schaefer dev->streaming_users++; 679032f1ddfSFrank Schaefer 6800c0d06caSMauro Carvalho Chehab return rc; 6810c0d06caSMauro Carvalho Chehab } 6820c0d06caSMauro Carvalho Chehab 6833a799c27SMauro Carvalho Chehab static int em28xx_stop_streaming(struct vb2_queue *vq) 6840c0d06caSMauro Carvalho Chehab { 685d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 6860c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 687d3829fadSDevin Heitmueller unsigned long flags = 0; 6880c0d06caSMauro Carvalho Chehab 689d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 6900c0d06caSMauro Carvalho Chehab 691d3829fadSDevin Heitmueller res_free(dev, vq->type); 692d3829fadSDevin Heitmueller 693d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 694d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 695d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 6960c0d06caSMauro Carvalho Chehab } 6970c0d06caSMauro Carvalho Chehab 698d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 699d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 700d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 701d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 702d3829fadSDevin Heitmueller list_del(&buf->list); 703d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 704d3829fadSDevin Heitmueller } 705d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 706d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 707d3829fadSDevin Heitmueller 708d3829fadSDevin Heitmueller return 0; 709d3829fadSDevin Heitmueller } 710d3829fadSDevin Heitmueller 711d3829fadSDevin Heitmueller int em28xx_stop_vbi_streaming(struct vb2_queue *vq) 7120c0d06caSMauro Carvalho Chehab { 713d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 714d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 715d3829fadSDevin Heitmueller unsigned long flags = 0; 7160c0d06caSMauro Carvalho Chehab 717d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 7180c0d06caSMauro Carvalho Chehab 719d3829fadSDevin Heitmueller res_free(dev, vq->type); 720d3829fadSDevin Heitmueller 721d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 722d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 723d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 7240c0d06caSMauro Carvalho Chehab } 7250c0d06caSMauro Carvalho Chehab 726d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 727d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 728d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 729d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 730d3829fadSDevin Heitmueller list_del(&buf->list); 731d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 732d3829fadSDevin Heitmueller } 733d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 734d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 735d3829fadSDevin Heitmueller 736d3829fadSDevin Heitmueller return 0; 737d3829fadSDevin Heitmueller } 738d3829fadSDevin Heitmueller 739d3829fadSDevin Heitmueller static void 740d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 741d3829fadSDevin Heitmueller { 742d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 743d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 744d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 745d3829fadSDevin Heitmueller unsigned long flags = 0; 746d3829fadSDevin Heitmueller 747d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 748d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 749d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 750d3829fadSDevin Heitmueller 751d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 752d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 753d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 754d3829fadSDevin Heitmueller } 755d3829fadSDevin Heitmueller 756d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 757d3829fadSDevin Heitmueller .queue_setup = queue_setup, 7580c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 7590c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 760d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 761d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 762d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 763d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 7640c0d06caSMauro Carvalho Chehab }; 7650c0d06caSMauro Carvalho Chehab 766d3829fadSDevin Heitmueller int em28xx_vb2_setup(struct em28xx *dev) 767d3829fadSDevin Heitmueller { 768d3829fadSDevin Heitmueller int rc; 769d3829fadSDevin Heitmueller struct vb2_queue *q; 770d3829fadSDevin Heitmueller 771d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 772d3829fadSDevin Heitmueller q = &dev->vb_vidq; 773d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 774ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 775195281d0SFrank Schaefer q->timestamp_type = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 776d3829fadSDevin Heitmueller q->drv_priv = dev; 777d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 778d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 779d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 780d3829fadSDevin Heitmueller 781d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 782d3829fadSDevin Heitmueller if (rc < 0) 783d3829fadSDevin Heitmueller return rc; 784d3829fadSDevin Heitmueller 785d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 786d3829fadSDevin Heitmueller q = &dev->vb_vbiq; 787d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 788d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 789195281d0SFrank Schaefer q->timestamp_type = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 790d3829fadSDevin Heitmueller q->drv_priv = dev; 791d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 792d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 793d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 794d3829fadSDevin Heitmueller 795d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 796d3829fadSDevin Heitmueller if (rc < 0) 797d3829fadSDevin Heitmueller return rc; 798d3829fadSDevin Heitmueller 799d3829fadSDevin Heitmueller return 0; 800d3829fadSDevin Heitmueller } 801d3829fadSDevin Heitmueller 8020c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 8030c0d06caSMauro Carvalho Chehab 8040c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 8050c0d06caSMauro Carvalho Chehab { 8060c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 8070c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 8080c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 8090c0d06caSMauro Carvalho Chehab 8100c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 8110c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 8120c0d06caSMauro Carvalho Chehab 8130c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 8140c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 8150c0d06caSMauro Carvalho Chehab 8160c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 8170c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 8180c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 8190c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 8200c0d06caSMauro Carvalho Chehab } 8210c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 8220c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 8230c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 8240c0d06caSMauro Carvalho Chehab } 8250c0d06caSMauro Carvalho Chehab 8260c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 8270c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 8280c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 8290c0d06caSMauro Carvalho Chehab } 8300c0d06caSMauro Carvalho Chehab 8310c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 8320c0d06caSMauro Carvalho Chehab } 8330c0d06caSMauro Carvalho Chehab 834081b945eSHans Verkuil void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 8350c0d06caSMauro Carvalho Chehab { 836081b945eSHans Verkuil struct em28xx *dev = priv; 8370c0d06caSMauro Carvalho Chehab 8380c0d06caSMauro Carvalho Chehab /* 839081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 840081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 841081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 842081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 8430c0d06caSMauro Carvalho Chehab */ 8440c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 8450c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 846081b945eSHans Verkuil dev->mute = ctrl->val; 847081b945eSHans Verkuil em28xx_audio_analog_set(dev); 8480c0d06caSMauro Carvalho Chehab break; 8490c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 850081b945eSHans Verkuil dev->volume = ctrl->val; 851081b945eSHans Verkuil em28xx_audio_analog_set(dev); 852081b945eSHans Verkuil break; 853081b945eSHans Verkuil } 854081b945eSHans Verkuil } 855081b945eSHans Verkuil 856081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 857081b945eSHans Verkuil { 858081b945eSHans Verkuil struct em28xx *dev = container_of(ctrl->handler, struct em28xx, ctrl_handler); 8598f8b113aSFrank Schaefer int ret = -EINVAL; 860081b945eSHans Verkuil 861081b945eSHans Verkuil switch (ctrl->id) { 862081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 863081b945eSHans Verkuil dev->mute = ctrl->val; 8648f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 865081b945eSHans Verkuil break; 866081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 867081b945eSHans Verkuil dev->volume = ctrl->val; 8688f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 8698f8b113aSFrank Schaefer break; 8708f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 8718f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 8728f8b113aSFrank Schaefer break; 8738f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 8748f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 8758f8b113aSFrank Schaefer break; 8768f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 8778f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 8788f8b113aSFrank Schaefer break; 8798f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 8808f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 8818f8b113aSFrank Schaefer break; 8828f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 8838f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 8848f8b113aSFrank Schaefer break; 8858f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 8868f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 8870c0d06caSMauro Carvalho Chehab break; 8880c0d06caSMauro Carvalho Chehab } 8890c0d06caSMauro Carvalho Chehab 8908f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 8910c0d06caSMauro Carvalho Chehab } 8920c0d06caSMauro Carvalho Chehab 893081b945eSHans Verkuil const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 894081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 895081b945eSHans Verkuil }; 896081b945eSHans Verkuil 8976b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 8980c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 8990c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 9000c0d06caSMauro Carvalho Chehab { 9010c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 9020c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 9030c0d06caSMauro Carvalho Chehab 9040c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 90581685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 90681685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 9070c0d06caSMauro Carvalho Chehab 9080c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 90981685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 91081685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 9110c0d06caSMauro Carvalho Chehab } 9120c0d06caSMauro Carvalho Chehab 913b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 914b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 915b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 916b8374138SFrank Schaefer { 917b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 918b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 919b8374138SFrank Schaefer 920b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 921b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 922b8374138SFrank Schaefer } 923b8374138SFrank Schaefer 9240c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 9250c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 9260c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 9270c0d06caSMauro Carvalho Chehab 9280c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 9290c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 9300c0d06caSMauro Carvalho Chehab { 9310c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9320c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9330c0d06caSMauro Carvalho Chehab 9340c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 9350c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 9360c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 9370c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 9380c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 9390c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 9400c0d06caSMauro Carvalho Chehab 9410c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 9420c0d06caSMauro Carvalho Chehab if (dev->progressive) 9430c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 9440c0d06caSMauro Carvalho Chehab else 9450c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 9460c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 9470c0d06caSMauro Carvalho Chehab return 0; 9480c0d06caSMauro Carvalho Chehab } 9490c0d06caSMauro Carvalho Chehab 9500c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 9510c0d06caSMauro Carvalho Chehab { 9520c0d06caSMauro Carvalho Chehab unsigned int i; 9530c0d06caSMauro Carvalho Chehab 9540c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 9550c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 9560c0d06caSMauro Carvalho Chehab return &format[i]; 9570c0d06caSMauro Carvalho Chehab 9580c0d06caSMauro Carvalho Chehab return NULL; 9590c0d06caSMauro Carvalho Chehab } 9600c0d06caSMauro Carvalho Chehab 9610c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 9620c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 9630c0d06caSMauro Carvalho Chehab { 9640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9660c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 9670c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 9680c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 9690c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 9700c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 9710c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 9720c0d06caSMauro Carvalho Chehab 9730c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 9740c0d06caSMauro Carvalho Chehab if (!fmt) { 9750c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 9760c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 9770c0d06caSMauro Carvalho Chehab return -EINVAL; 9780c0d06caSMauro Carvalho Chehab } 9790c0d06caSMauro Carvalho Chehab 9800c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 9810c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 9820c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 9830c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 984d3829fadSDevin Heitmueller /* 985d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 986d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 987d3829fadSDevin Heitmueller * to 50% 988d3829fadSDevin Heitmueller */ 9890c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 9900c0d06caSMauro Carvalho Chehab width /= 2; 9910c0d06caSMauro Carvalho Chehab } else { 9920c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 9930c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 9940c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 9950c0d06caSMauro Carvalho Chehab 1, 0); 9960c0d06caSMauro Carvalho Chehab } 9970c0d06caSMauro Carvalho Chehab 9986b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 99946f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 10000c0d06caSMauro Carvalho Chehab 10010c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 10020c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 10030c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1004e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 10050c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 10060c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 10070c0d06caSMauro Carvalho Chehab if (dev->progressive) 10080c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 10090c0d06caSMauro Carvalho Chehab else 10100c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 10110c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 101251dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 10130c0d06caSMauro Carvalho Chehab 10140c0d06caSMauro Carvalho Chehab return 0; 10150c0d06caSMauro Carvalho Chehab } 10160c0d06caSMauro Carvalho Chehab 10170c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 10180c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 10190c0d06caSMauro Carvalho Chehab { 10200c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 10210c0d06caSMauro Carvalho Chehab 10220c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 10230c0d06caSMauro Carvalho Chehab if (!fmt) 10240c0d06caSMauro Carvalho Chehab return -EINVAL; 10250c0d06caSMauro Carvalho Chehab 10260c0d06caSMauro Carvalho Chehab dev->format = fmt; 10270c0d06caSMauro Carvalho Chehab dev->width = width; 10280c0d06caSMauro Carvalho Chehab dev->height = height; 10290c0d06caSMauro Carvalho Chehab 10300c0d06caSMauro Carvalho Chehab /* set new image size */ 10316b09a21cSFrank Schaefer size_to_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 10320c0d06caSMauro Carvalho Chehab 10330c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 10340c0d06caSMauro Carvalho Chehab 10350c0d06caSMauro Carvalho Chehab return 0; 10360c0d06caSMauro Carvalho Chehab } 10370c0d06caSMauro Carvalho Chehab 10380c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 10390c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 10400c0d06caSMauro Carvalho Chehab { 1041d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 10420c0d06caSMauro Carvalho Chehab 1043d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1044d3829fadSDevin Heitmueller return -EBUSY; 10450c0d06caSMauro Carvalho Chehab 10460c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 10470c0d06caSMauro Carvalho Chehab 10480c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 10490c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 10500c0d06caSMauro Carvalho Chehab } 10510c0d06caSMauro Carvalho Chehab 10520c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 10530c0d06caSMauro Carvalho Chehab { 10540c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10550c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10560c0d06caSMauro Carvalho Chehab 10570c0d06caSMauro Carvalho Chehab *norm = dev->norm; 10580c0d06caSMauro Carvalho Chehab 10590c0d06caSMauro Carvalho Chehab return 0; 10600c0d06caSMauro Carvalho Chehab } 10610c0d06caSMauro Carvalho Chehab 10620c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 10630c0d06caSMauro Carvalho Chehab { 10640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10660c0d06caSMauro Carvalho Chehab 10670c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 10680c0d06caSMauro Carvalho Chehab 10690c0d06caSMauro Carvalho Chehab return 0; 10700c0d06caSMauro Carvalho Chehab } 10710c0d06caSMauro Carvalho Chehab 1072314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 10730c0d06caSMauro Carvalho Chehab { 10740c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10750c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10760c0d06caSMauro Carvalho Chehab struct v4l2_format f; 10770c0d06caSMauro Carvalho Chehab 1078314527acSHans Verkuil if (norm == dev->norm) 1079d8c95c08SHans Verkuil return 0; 10800c0d06caSMauro Carvalho Chehab 1081d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1082d8c95c08SHans Verkuil return -EBUSY; 1083d8c95c08SHans Verkuil 1084314527acSHans Verkuil dev->norm = norm; 10850c0d06caSMauro Carvalho Chehab 10860c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1087d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1088314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 10890c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 10900c0d06caSMauro Carvalho Chehab 10910c0d06caSMauro Carvalho Chehab /* set new image size */ 10920c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 10930c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 10946b09a21cSFrank Schaefer size_to_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 10950c0d06caSMauro Carvalho Chehab 10960c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 10970c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 10980c0d06caSMauro Carvalho Chehab 10990c0d06caSMauro Carvalho Chehab return 0; 11000c0d06caSMauro Carvalho Chehab } 11010c0d06caSMauro Carvalho Chehab 11020c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 11030c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 11040c0d06caSMauro Carvalho Chehab { 11050c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11060c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11070c0d06caSMauro Carvalho Chehab int rc = 0; 11080c0d06caSMauro Carvalho Chehab 110986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 11100c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 11110c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 11120c0d06caSMauro Carvalho Chehab video, g_parm, p); 11130c0d06caSMauro Carvalho Chehab else 11140c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 11150c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 11160c0d06caSMauro Carvalho Chehab 11170c0d06caSMauro Carvalho Chehab return rc; 11180c0d06caSMauro Carvalho Chehab } 11190c0d06caSMauro Carvalho Chehab 11200c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 11210c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 11220c0d06caSMauro Carvalho Chehab { 11230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11240c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11250c0d06caSMauro Carvalho Chehab 112686ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 11270c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 11280c0d06caSMauro Carvalho Chehab } 11290c0d06caSMauro Carvalho Chehab 11300c0d06caSMauro Carvalho Chehab static const char *iname[] = { 11310c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 11320c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 11330c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 11340c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 11350c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 11360c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 11370c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 11380c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 11390c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 11400c0d06caSMauro Carvalho Chehab }; 11410c0d06caSMauro Carvalho Chehab 11420c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 11430c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 11440c0d06caSMauro Carvalho Chehab { 11450c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11460c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11470c0d06caSMauro Carvalho Chehab unsigned int n; 11480c0d06caSMauro Carvalho Chehab 11490c0d06caSMauro Carvalho Chehab n = i->index; 11500c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 11510c0d06caSMauro Carvalho Chehab return -EINVAL; 11520c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 11530c0d06caSMauro Carvalho Chehab return -EINVAL; 11540c0d06caSMauro Carvalho Chehab 11550c0d06caSMauro Carvalho Chehab i->index = n; 11560c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 11570c0d06caSMauro Carvalho Chehab 11580c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 11590c0d06caSMauro Carvalho Chehab 11600c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 11610c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 11620c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 11630c0d06caSMauro Carvalho Chehab 11640c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 1165d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1166d8c95c08SHans Verkuil if (dev->board.is_webcam) 1167d8c95c08SHans Verkuil i->capabilities = 0; 11680c0d06caSMauro Carvalho Chehab 11690c0d06caSMauro Carvalho Chehab return 0; 11700c0d06caSMauro Carvalho Chehab } 11710c0d06caSMauro Carvalho Chehab 11720c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 11730c0d06caSMauro Carvalho Chehab { 11740c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11750c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11760c0d06caSMauro Carvalho Chehab 11770c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 11780c0d06caSMauro Carvalho Chehab 11790c0d06caSMauro Carvalho Chehab return 0; 11800c0d06caSMauro Carvalho Chehab } 11810c0d06caSMauro Carvalho Chehab 11820c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 11830c0d06caSMauro Carvalho Chehab { 11840c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11850c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11860c0d06caSMauro Carvalho Chehab 11870c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 11880c0d06caSMauro Carvalho Chehab return -EINVAL; 11890c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 11900c0d06caSMauro Carvalho Chehab return -EINVAL; 11910c0d06caSMauro Carvalho Chehab 11920c0d06caSMauro Carvalho Chehab video_mux(dev, i); 11930c0d06caSMauro Carvalho Chehab return 0; 11940c0d06caSMauro Carvalho Chehab } 11950c0d06caSMauro Carvalho Chehab 11960c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 11970c0d06caSMauro Carvalho Chehab { 11980c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11990c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12000c0d06caSMauro Carvalho Chehab 12010c0d06caSMauro Carvalho Chehab switch (a->index) { 12020c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 12030c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 12040c0d06caSMauro Carvalho Chehab break; 12050c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 12060c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 12070c0d06caSMauro Carvalho Chehab break; 12080c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 12090c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 12100c0d06caSMauro Carvalho Chehab break; 12110c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 12120c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 12130c0d06caSMauro Carvalho Chehab break; 12140c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 12150c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 12160c0d06caSMauro Carvalho Chehab break; 12170c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 12180c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 12190c0d06caSMauro Carvalho Chehab break; 12200c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 12210c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 12220c0d06caSMauro Carvalho Chehab break; 12230c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 12240c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 12250c0d06caSMauro Carvalho Chehab break; 12260c0d06caSMauro Carvalho Chehab default: 12270c0d06caSMauro Carvalho Chehab return -EINVAL; 12280c0d06caSMauro Carvalho Chehab } 12290c0d06caSMauro Carvalho Chehab 12300c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 12310c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 12320c0d06caSMauro Carvalho Chehab 12330c0d06caSMauro Carvalho Chehab return 0; 12340c0d06caSMauro Carvalho Chehab } 12350c0d06caSMauro Carvalho Chehab 12360e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 12370c0d06caSMauro Carvalho Chehab { 12380c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12390c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12400c0d06caSMauro Carvalho Chehab 12410c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 12420c0d06caSMauro Carvalho Chehab return -EINVAL; 12430c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 12440c0d06caSMauro Carvalho Chehab return -EINVAL; 12450c0d06caSMauro Carvalho Chehab 12460c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 12470c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 12480c0d06caSMauro Carvalho Chehab 12490c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 12500c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 12510c0d06caSMauro Carvalho Chehab 12520c0d06caSMauro Carvalho Chehab return 0; 12530c0d06caSMauro Carvalho Chehab } 12540c0d06caSMauro Carvalho Chehab 12550c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 12560c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 12570c0d06caSMauro Carvalho Chehab { 12580c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12590c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12600c0d06caSMauro Carvalho Chehab 12610c0d06caSMauro Carvalho Chehab if (0 != t->index) 12620c0d06caSMauro Carvalho Chehab return -EINVAL; 12630c0d06caSMauro Carvalho Chehab 12640c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 12650c0d06caSMauro Carvalho Chehab 12660c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 12670c0d06caSMauro Carvalho Chehab return 0; 12680c0d06caSMauro Carvalho Chehab } 12690c0d06caSMauro Carvalho Chehab 12700c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 12712f73c7c5SHans Verkuil const struct v4l2_tuner *t) 12720c0d06caSMauro Carvalho Chehab { 12730c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12740c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12750c0d06caSMauro Carvalho Chehab 12760c0d06caSMauro Carvalho Chehab if (0 != t->index) 12770c0d06caSMauro Carvalho Chehab return -EINVAL; 12780c0d06caSMauro Carvalho Chehab 12790c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 12800c0d06caSMauro Carvalho Chehab return 0; 12810c0d06caSMauro Carvalho Chehab } 12820c0d06caSMauro Carvalho Chehab 12830c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 12840c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 12850c0d06caSMauro Carvalho Chehab { 12860c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12870c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12880c0d06caSMauro Carvalho Chehab 128920deebfeSHans Verkuil if (0 != f->tuner) 129020deebfeSHans Verkuil return -EINVAL; 129120deebfeSHans Verkuil 12920c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 12930c0d06caSMauro Carvalho Chehab return 0; 12940c0d06caSMauro Carvalho Chehab } 12950c0d06caSMauro Carvalho Chehab 12960c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1297b530a447SHans Verkuil const struct v4l2_frequency *f) 12980c0d06caSMauro Carvalho Chehab { 1299b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 13000c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13010c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13020c0d06caSMauro Carvalho Chehab 13030c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 13040c0d06caSMauro Carvalho Chehab return -EINVAL; 13050c0d06caSMauro Carvalho Chehab 13060c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 1307b530a447SHans Verkuil v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_frequency, &new_freq); 1308b530a447SHans Verkuil dev->ctl_freq = new_freq.frequency; 13090c0d06caSMauro Carvalho Chehab 13100c0d06caSMauro Carvalho Chehab return 0; 13110c0d06caSMauro Carvalho Chehab } 13120c0d06caSMauro Carvalho Chehab 1313cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 131496b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 131596b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 13163b2d17b4SHans Verkuil { 13173b2d17b4SHans Verkuil struct em28xx_fh *fh = priv; 13183b2d17b4SHans Verkuil struct em28xx *dev = fh->dev; 13193b2d17b4SHans Verkuil 13203b2d17b4SHans Verkuil if (chip->match.addr > 1) 13213b2d17b4SHans Verkuil return -EINVAL; 13223b2d17b4SHans Verkuil if (chip->match.addr == 1) 13233b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 13243b2d17b4SHans Verkuil else 13253b2d17b4SHans Verkuil strlcpy(chip->name, dev->v4l2_dev.name, sizeof(chip->name)); 13263b2d17b4SHans Verkuil return 0; 13273b2d17b4SHans Verkuil } 13283b2d17b4SHans Verkuil 132935deba32SFrank Schaefer static int em28xx_reg_len(int reg) 133035deba32SFrank Schaefer { 133135deba32SFrank Schaefer switch (reg) { 133235deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 133335deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 133435deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 133535deba32SFrank Schaefer return 2; 133635deba32SFrank Schaefer default: 133735deba32SFrank Schaefer return 1; 133835deba32SFrank Schaefer } 133935deba32SFrank Schaefer } 13400c0d06caSMauro Carvalho Chehab 13410c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 13420c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 13430c0d06caSMauro Carvalho Chehab { 13440c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13450c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13460c0d06caSMauro Carvalho Chehab int ret; 13470c0d06caSMauro Carvalho Chehab 13483b2d17b4SHans Verkuil if (reg->match.addr > 1) 13493b2d17b4SHans Verkuil return -EINVAL; 1350abca2056SHans Verkuil if (reg->match.addr) { 13510c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 13520c0d06caSMauro Carvalho Chehab if (ret < 0) 13530c0d06caSMauro Carvalho Chehab return ret; 13540c0d06caSMauro Carvalho Chehab 13550c0d06caSMauro Carvalho Chehab reg->val = ret; 13560c0d06caSMauro Carvalho Chehab reg->size = 1; 13570c0d06caSMauro Carvalho Chehab return 0; 13580c0d06caSMauro Carvalho Chehab } 13590c0d06caSMauro Carvalho Chehab 13600c0d06caSMauro Carvalho Chehab /* Match host */ 13610c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 13620c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 13630c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 13640c0d06caSMauro Carvalho Chehab 13650c0d06caSMauro Carvalho Chehab if (ret < 0) 13660c0d06caSMauro Carvalho Chehab return ret; 13670c0d06caSMauro Carvalho Chehab 13680c0d06caSMauro Carvalho Chehab reg->val = ret; 13690c0d06caSMauro Carvalho Chehab } else { 13700c0d06caSMauro Carvalho Chehab __le16 val = 0; 13710c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 13720c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 13730c0d06caSMauro Carvalho Chehab if (ret < 0) 13740c0d06caSMauro Carvalho Chehab return ret; 13750c0d06caSMauro Carvalho Chehab 13760c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 13770c0d06caSMauro Carvalho Chehab } 13780c0d06caSMauro Carvalho Chehab 13790c0d06caSMauro Carvalho Chehab return 0; 13800c0d06caSMauro Carvalho Chehab } 13810c0d06caSMauro Carvalho Chehab 13820c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1383977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 13840c0d06caSMauro Carvalho Chehab { 13850c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13860c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13870c0d06caSMauro Carvalho Chehab __le16 buf; 13880c0d06caSMauro Carvalho Chehab 13893b2d17b4SHans Verkuil if (reg->match.addr > 1) 13903b2d17b4SHans Verkuil return -EINVAL; 1391abca2056SHans Verkuil if (reg->match.addr) 13920c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 13930c0d06caSMauro Carvalho Chehab 13940c0d06caSMauro Carvalho Chehab /* Match host */ 13950c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 13960c0d06caSMauro Carvalho Chehab 13970c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 13980c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 13990c0d06caSMauro Carvalho Chehab } 14000c0d06caSMauro Carvalho Chehab #endif 14010c0d06caSMauro Carvalho Chehab 14020c0d06caSMauro Carvalho Chehab 14030c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 14040c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 14050c0d06caSMauro Carvalho Chehab { 1406a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 14070c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14080c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14090c0d06caSMauro Carvalho Chehab 14100c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 14110c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 14120c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 14130c0d06caSMauro Carvalho Chehab 1414a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1415a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1416a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1417a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1418a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1419a9d79fe5SHans Verkuil else 14201d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 14210c0d06caSMauro Carvalho Chehab 14220c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1423a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 14240c0d06caSMauro Carvalho Chehab 14250c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1426a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 14270c0d06caSMauro Carvalho Chehab 1428a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1429a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1430a9d79fe5SHans Verkuil if (dev->vbi_dev) 14311d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1432a9d79fe5SHans Verkuil if (dev->radio_dev) 1433a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 14340c0d06caSMauro Carvalho Chehab return 0; 14350c0d06caSMauro Carvalho Chehab } 14360c0d06caSMauro Carvalho Chehab 14370c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 14380c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 14390c0d06caSMauro Carvalho Chehab { 14400c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 14410c0d06caSMauro Carvalho Chehab return -EINVAL; 14420c0d06caSMauro Carvalho Chehab 14430c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 14440c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 14450c0d06caSMauro Carvalho Chehab 14460c0d06caSMauro Carvalho Chehab return 0; 14470c0d06caSMauro Carvalho Chehab } 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 14500c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 14510c0d06caSMauro Carvalho Chehab { 14520c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14530c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14540c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14550c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14560c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14570c0d06caSMauro Carvalho Chehab 14580c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 14590c0d06caSMauro Carvalho Chehab if (!fmt) { 14600c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14610c0d06caSMauro Carvalho Chehab fsize->pixel_format); 14620c0d06caSMauro Carvalho Chehab return -EINVAL; 14630c0d06caSMauro Carvalho Chehab } 14640c0d06caSMauro Carvalho Chehab 14650c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14660c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 14670c0d06caSMauro Carvalho Chehab return -EINVAL; 14680c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 14690c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 14700c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 14710c0d06caSMauro Carvalho Chehab return 0; 14720c0d06caSMauro Carvalho Chehab } 14730c0d06caSMauro Carvalho Chehab 14740c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 14750c0d06caSMauro Carvalho Chehab return -EINVAL; 14760c0d06caSMauro Carvalho Chehab 14770c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 14780c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 14796c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 14806c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 14816c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 14820c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 14836c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 14846c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 14850c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 14860c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 14870c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 14880c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 14890c0d06caSMauro Carvalho Chehab return 0; 14900c0d06caSMauro Carvalho Chehab } 14910c0d06caSMauro Carvalho Chehab 14920c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 14930c0d06caSMauro Carvalho Chehab 14940c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 14950c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 14960c0d06caSMauro Carvalho Chehab { 14970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14990c0d06caSMauro Carvalho Chehab 15000c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 15010c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 15020c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 15030c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 15040c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 15050c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 15060c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 15072a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 15100c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 15110c0d06caSMauro Carvalho Chehab /* NTSC */ 15120c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 15130c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 15140c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 15150c0d06caSMauro Carvalho Chehab /* PAL */ 15160c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 15170c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 15180c0d06caSMauro Carvalho Chehab } 15190c0d06caSMauro Carvalho Chehab 15200c0d06caSMauro Carvalho Chehab return 0; 15210c0d06caSMauro Carvalho Chehab } 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 15240c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 15250c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 15260c0d06caSMauro Carvalho Chehab 15270c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 15280c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15290c0d06caSMauro Carvalho Chehab { 15300c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 15310c0d06caSMauro Carvalho Chehab 15320c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 15330c0d06caSMauro Carvalho Chehab return -EINVAL; 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 15360c0d06caSMauro Carvalho Chehab 15370c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 15380c0d06caSMauro Carvalho Chehab 15390c0d06caSMauro Carvalho Chehab return 0; 15400c0d06caSMauro Carvalho Chehab } 15410c0d06caSMauro Carvalho Chehab 15420c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 15432f73c7c5SHans Verkuil const struct v4l2_tuner *t) 15440c0d06caSMauro Carvalho Chehab { 15450c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 15460c0d06caSMauro Carvalho Chehab 15470c0d06caSMauro Carvalho Chehab if (0 != t->index) 15480c0d06caSMauro Carvalho Chehab return -EINVAL; 15490c0d06caSMauro Carvalho Chehab 15500c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 15510c0d06caSMauro Carvalho Chehab 15520c0d06caSMauro Carvalho Chehab return 0; 15530c0d06caSMauro Carvalho Chehab } 15540c0d06caSMauro Carvalho Chehab 15550c0d06caSMauro Carvalho Chehab /* 15560c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 15570c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 15580c0d06caSMauro Carvalho Chehab */ 15590c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 15600c0d06caSMauro Carvalho Chehab { 15610c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 15620c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 15630c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 15640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 15650c0d06caSMauro Carvalho Chehab 15660c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 15670c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 15680c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 15690c0d06caSMauro Carvalho Chehab break; 15700c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 15710c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 15720c0d06caSMauro Carvalho Chehab break; 15730c0d06caSMauro Carvalho Chehab } 15740c0d06caSMauro Carvalho Chehab 15750c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 15760c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 15770c0d06caSMauro Carvalho Chehab dev->users); 15780c0d06caSMauro Carvalho Chehab 15790c0d06caSMauro Carvalho Chehab 15800c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 15810c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 15820c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 15830c0d06caSMauro Carvalho Chehab if (!fh) { 15840c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 15850c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 15860c0d06caSMauro Carvalho Chehab return -ENOMEM; 15870c0d06caSMauro Carvalho Chehab } 158869a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 15890c0d06caSMauro Carvalho Chehab fh->dev = dev; 15900c0d06caSMauro Carvalho Chehab fh->type = fh_type; 15910c0d06caSMauro Carvalho Chehab filp->private_data = fh; 15920c0d06caSMauro Carvalho Chehab 15930c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE && dev->users == 0) { 15940c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 15950c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15960c0d06caSMauro Carvalho Chehab 15970c0d06caSMauro Carvalho Chehab /* Needed, since GPIO might have disabled power of 15980c0d06caSMauro Carvalho Chehab some i2c device 15990c0d06caSMauro Carvalho Chehab */ 16000c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 16010c0d06caSMauro Carvalho Chehab 16020c0d06caSMauro Carvalho Chehab } 1603d3829fadSDevin Heitmueller 1604d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 16050c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 16060c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 16070c0d06caSMauro Carvalho Chehab } 16080c0d06caSMauro Carvalho Chehab 16090c0d06caSMauro Carvalho Chehab dev->users++; 16100c0d06caSMauro Carvalho Chehab 16110c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 161269a61642SHans Verkuil v4l2_fh_add(&fh->fh); 16130c0d06caSMauro Carvalho Chehab 1614d3829fadSDevin Heitmueller return 0; 16150c0d06caSMauro Carvalho Chehab } 16160c0d06caSMauro Carvalho Chehab 16170c0d06caSMauro Carvalho Chehab /* 16180c0d06caSMauro Carvalho Chehab * em28xx_realease_resources() 16190c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 16200c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 16210c0d06caSMauro Carvalho Chehab */ 16220c0d06caSMauro Carvalho Chehab void em28xx_release_analog_resources(struct em28xx *dev) 16230c0d06caSMauro Carvalho Chehab { 16240c0d06caSMauro Carvalho Chehab 16250c0d06caSMauro Carvalho Chehab /*FIXME: I2C IR should be disconnected */ 16260c0d06caSMauro Carvalho Chehab 16270c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 16280c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->radio_dev)) 16290c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 16300c0d06caSMauro Carvalho Chehab else 16310c0d06caSMauro Carvalho Chehab video_device_release(dev->radio_dev); 16320c0d06caSMauro Carvalho Chehab dev->radio_dev = NULL; 16330c0d06caSMauro Carvalho Chehab } 16340c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 16350c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 16360c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 16370c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vbi_dev)) 16380c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 16390c0d06caSMauro Carvalho Chehab else 16400c0d06caSMauro Carvalho Chehab video_device_release(dev->vbi_dev); 16410c0d06caSMauro Carvalho Chehab dev->vbi_dev = NULL; 16420c0d06caSMauro Carvalho Chehab } 16430c0d06caSMauro Carvalho Chehab if (dev->vdev) { 16440c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 16450c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 16460c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vdev)) 16470c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 16480c0d06caSMauro Carvalho Chehab else 16490c0d06caSMauro Carvalho Chehab video_device_release(dev->vdev); 16500c0d06caSMauro Carvalho Chehab dev->vdev = NULL; 16510c0d06caSMauro Carvalho Chehab } 16520c0d06caSMauro Carvalho Chehab } 16530c0d06caSMauro Carvalho Chehab 16540c0d06caSMauro Carvalho Chehab /* 16550c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 16560c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 16570c0d06caSMauro Carvalho Chehab * calls and ioctls 16580c0d06caSMauro Carvalho Chehab */ 16590c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 16600c0d06caSMauro Carvalho Chehab { 16610c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 16620c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16630c0d06caSMauro Carvalho Chehab int errCode; 16640c0d06caSMauro Carvalho Chehab 16650c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 16660c0d06caSMauro Carvalho Chehab 16670c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 1668d3829fadSDevin Heitmueller vb2_fop_release(filp); 16690c0d06caSMauro Carvalho Chehab 16700c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 16710c0d06caSMauro Carvalho Chehab /* the device is already disconnect, 16720c0d06caSMauro Carvalho Chehab free the remaining resources */ 16732665c299SFrank Schaefer if (dev->disconnected) { 16740c0d06caSMauro Carvalho Chehab em28xx_release_resources(dev); 16750cf544a6SFrank Schaefer kfree(dev->alt_max_pkt_size_isoc); 1676e36c92fdSDan Carpenter mutex_unlock(&dev->lock); 16770c0d06caSMauro Carvalho Chehab kfree(dev); 16780c0d06caSMauro Carvalho Chehab return 0; 16790c0d06caSMauro Carvalho Chehab } 16800c0d06caSMauro Carvalho Chehab 16810c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 16820c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 16830c0d06caSMauro Carvalho Chehab 16840c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 16850c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 16860c0d06caSMauro Carvalho Chehab 16870c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 16880c0d06caSMauro Carvalho Chehab dev->alt = 0; 16890c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 16900c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 16910c0d06caSMauro Carvalho Chehab if (errCode < 0) { 16920c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 16930c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 16940c0d06caSMauro Carvalho Chehab } 16950c0d06caSMauro Carvalho Chehab } 16960c0d06caSMauro Carvalho Chehab 16970c0d06caSMauro Carvalho Chehab dev->users--; 16980c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 16990c0d06caSMauro Carvalho Chehab return 0; 17000c0d06caSMauro Carvalho Chehab } 17010c0d06caSMauro Carvalho Chehab 17020c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 17030c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 17040c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 17050c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 1706d3829fadSDevin Heitmueller .read = vb2_fop_read, 1707d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 1708d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 17090c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 17100c0d06caSMauro Carvalho Chehab }; 17110c0d06caSMauro Carvalho Chehab 17120c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 17130c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 17140c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 17150c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 17160c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 17170c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 17180c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 17192a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 1720aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 17210c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 17220c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 17230c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 17240c0d06caSMauro Carvalho Chehab 1725d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 1726d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 1727d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 1728d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 1729d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 1730d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 1731d3829fadSDevin Heitmueller 17320c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 17330c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 17340c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 17350c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 17360c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 17370c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 17380c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 17390c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 1740d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 1741d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 17420c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 17430c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 17440c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 17450c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 174650fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 174750fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 17480c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 174996b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 17500c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 17510c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 17520c0d06caSMauro Carvalho Chehab #endif 17530c0d06caSMauro Carvalho Chehab }; 17540c0d06caSMauro Carvalho Chehab 17550c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 17560c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 1757d3829fadSDevin Heitmueller .release = video_device_release_empty, 17580c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 17590c0d06caSMauro Carvalho Chehab 17600c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 17610c0d06caSMauro Carvalho Chehab }; 17620c0d06caSMauro Carvalho Chehab 17630c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 17640c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 17650c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 17660c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 17670c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 17680c0d06caSMauro Carvalho Chehab }; 17690c0d06caSMauro Carvalho Chehab 17700c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 1771a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 17720c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 17730c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 17740c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 17750c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 177650fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 177750fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 17780c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 1779430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 17800c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 17810c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 17820c0d06caSMauro Carvalho Chehab #endif 17830c0d06caSMauro Carvalho Chehab }; 17840c0d06caSMauro Carvalho Chehab 17850c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 17860c0d06caSMauro Carvalho Chehab .name = "em28xx-radio", 17870c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 17880c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 17890c0d06caSMauro Carvalho Chehab }; 17900c0d06caSMauro Carvalho Chehab 17910c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 17920c0d06caSMauro Carvalho Chehab 17930c0d06caSMauro Carvalho Chehab 17940c0d06caSMauro Carvalho Chehab 17950c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 17960c0d06caSMauro Carvalho Chehab const struct video_device *template, 17970c0d06caSMauro Carvalho Chehab const char *type_name) 17980c0d06caSMauro Carvalho Chehab { 17990c0d06caSMauro Carvalho Chehab struct video_device *vfd; 18000c0d06caSMauro Carvalho Chehab 18010c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 18020c0d06caSMauro Carvalho Chehab if (NULL == vfd) 18030c0d06caSMauro Carvalho Chehab return NULL; 18040c0d06caSMauro Carvalho Chehab 18050c0d06caSMauro Carvalho Chehab *vfd = *template; 18060c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 18070c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 18080c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 180969a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 1810d8c95c08SHans Verkuil if (dev->board.is_webcam) 1811d8c95c08SHans Verkuil vfd->tvnorms = 0; 18120c0d06caSMauro Carvalho Chehab 18130c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 18140c0d06caSMauro Carvalho Chehab dev->name, type_name); 18150c0d06caSMauro Carvalho Chehab 18160c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 18170c0d06caSMauro Carvalho Chehab return vfd; 18180c0d06caSMauro Carvalho Chehab } 18190c0d06caSMauro Carvalho Chehab 18200c0d06caSMauro Carvalho Chehab int em28xx_register_analog_devices(struct em28xx *dev) 18210c0d06caSMauro Carvalho Chehab { 18220c0d06caSMauro Carvalho Chehab u8 val; 18230c0d06caSMauro Carvalho Chehab int ret; 18240c0d06caSMauro Carvalho Chehab unsigned int maxw; 18250c0d06caSMauro Carvalho Chehab 18260c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s: v4l2 driver version %s\n", 18270c0d06caSMauro Carvalho Chehab dev->name, EM28XX_VERSION); 18280c0d06caSMauro Carvalho Chehab 18290c0d06caSMauro Carvalho Chehab /* set default norm */ 1830d8c95c08SHans Verkuil dev->norm = V4L2_STD_PAL; 18310c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 18320c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 18330c0d06caSMauro Carvalho Chehab 18340c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 18350c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 18360c0d06caSMauro Carvalho Chehab 18370c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 18380c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 18390c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 18400c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 18410c0d06caSMauro Carvalho Chehab maxw /= 2; 18420c0d06caSMauro Carvalho Chehab 18430c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 18440c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 18450c0d06caSMauro Carvalho Chehab 18460c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 18470c0d06caSMauro Carvalho Chehab 18480c0d06caSMauro Carvalho Chehab /* Audio defaults */ 18490c0d06caSMauro Carvalho Chehab dev->mute = 1; 18500c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 18530c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 18540c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 18550c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 18560c0d06caSMauro Carvalho Chehab 18570c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 18580c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 18590c0d06caSMauro Carvalho Chehab 18608f8b113aSFrank Schaefer /* Add image controls */ 18618f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 18628f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 18638f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_CONTRAST)) 18648f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 18658f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 18668f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 18678f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_BRIGHTNESS)) 18688f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 18698f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 18708f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 18718f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_SATURATION)) 18728f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 18738f8b113aSFrank Schaefer V4L2_CID_SATURATION, 18748f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 18758f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_BLUE_BALANCE)) 18768f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 18778f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 18788f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 18798f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_RED_BALANCE)) 18808f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 18818f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 18828f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 18838f8b113aSFrank Schaefer if (NULL == v4l2_ctrl_find(&dev->ctrl_handler, V4L2_CID_SHARPNESS)) 18848f8b113aSFrank Schaefer v4l2_ctrl_new_std(&dev->ctrl_handler, &em28xx_ctrl_ops, 18858f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 18868f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 18878f8b113aSFrank Schaefer 18888f8b113aSFrank Schaefer /* Reset image controls */ 18898f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 18908f8b113aSFrank Schaefer v4l2_ctrl_handler_setup(&dev->ctrl_handler); 18918f8b113aSFrank Schaefer if (dev->ctrl_handler.error) 18928f8b113aSFrank Schaefer return dev->ctrl_handler.error; 18938f8b113aSFrank Schaefer 18940c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 18950c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 18960c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 18970c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 18980c0d06caSMauro Carvalho Chehab return -ENODEV; 18990c0d06caSMauro Carvalho Chehab } 1900d3829fadSDevin Heitmueller dev->vdev->queue = &dev->vb_vidq; 1901d3829fadSDevin Heitmueller dev->vdev->queue->lock = &dev->vb_queue_lock; 19020c0d06caSMauro Carvalho Chehab 19036e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 19046e46dabaSFrank Schaefer if (dev->board.is_webcam) { 19056e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_QUERYSTD); 19066e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_STD); 19076e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_STD); 19083bc85cceSFrank Schaefer } else { 19093bc85cceSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_PARM); 19106e46dabaSFrank Schaefer } 191166df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 191266df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_TUNER); 191366df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_TUNER); 191466df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_FREQUENCY); 191566df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_FREQUENCY); 191666df67b7SFrank Schaefer } 1917c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 1918c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_AUDIO); 1919c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_AUDIO); 1920c2dcef83SFrank Schaefer } 19216e46dabaSFrank Schaefer 19220c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 19230c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 19240c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 19250c0d06caSMauro Carvalho Chehab if (ret) { 19260c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 19270c0d06caSMauro Carvalho Chehab ret); 19280c0d06caSMauro Carvalho Chehab return ret; 19290c0d06caSMauro Carvalho Chehab } 19300c0d06caSMauro Carvalho Chehab 19310c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 19320c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 19330c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 19340c0d06caSMauro Carvalho Chehab "vbi"); 19350c0d06caSMauro Carvalho Chehab 1936d3829fadSDevin Heitmueller dev->vbi_dev->queue = &dev->vb_vbiq; 1937d3829fadSDevin Heitmueller dev->vbi_dev->queue->lock = &dev->vb_vbi_queue_lock; 1938d3829fadSDevin Heitmueller 193966df67b7SFrank Schaefer /* disable inapplicable ioctls */ 194083c8bcceSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_PARM); 194166df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 194266df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_TUNER); 194366df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_TUNER); 194466df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_FREQUENCY); 194566df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_FREQUENCY); 194666df67b7SFrank Schaefer } 1947c2dcef83SFrank Schaefer if (!dev->audio_mode.has_audio) { 1948c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_AUDIO); 1949c2dcef83SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_AUDIO); 1950c2dcef83SFrank Schaefer } 195166df67b7SFrank Schaefer 19520c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 19530c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 19540c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 19550c0d06caSMauro Carvalho Chehab if (ret < 0) { 19560c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 19570c0d06caSMauro Carvalho Chehab return ret; 19580c0d06caSMauro Carvalho Chehab } 19590c0d06caSMauro Carvalho Chehab } 19600c0d06caSMauro Carvalho Chehab 19610c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 19620c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 19630c0d06caSMauro Carvalho Chehab "radio"); 19640c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 19650c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 19660c0d06caSMauro Carvalho Chehab return -ENODEV; 19670c0d06caSMauro Carvalho Chehab } 19680c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 19690c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 19700c0d06caSMauro Carvalho Chehab if (ret < 0) { 19710c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 19720c0d06caSMauro Carvalho Chehab return ret; 19730c0d06caSMauro Carvalho Chehab } 19740c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 19750c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 19760c0d06caSMauro Carvalho Chehab } 19770c0d06caSMauro Carvalho Chehab 19780c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 19790c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 19800c0d06caSMauro Carvalho Chehab 19810c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 19820c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 19830c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 19840c0d06caSMauro Carvalho Chehab 19850c0d06caSMauro Carvalho Chehab return 0; 19860c0d06caSMauro Carvalho Chehab } 1987