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/v4l2-chip-ident.h> 450c0d06caSMauro Carvalho Chehab #include <media/msp3400.h> 460c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 470c0d06caSMauro Carvalho Chehab 480c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 490c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 500c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 510c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 520c0d06caSMauro Carvalho Chehab 530c0d06caSMauro Carvalho Chehab #define DRIVER_DESC "Empia em28xx based USB video device driver" 540c0d06caSMauro Carvalho Chehab 550c0d06caSMauro Carvalho Chehab #define EM28XX_VERSION "0.1.3" 560c0d06caSMauro Carvalho Chehab 570c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 580c0d06caSMauro Carvalho Chehab if (video_debug) \ 590c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 600c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 610c0d06caSMauro Carvalho Chehab 620c0d06caSMauro Carvalho Chehab static unsigned int isoc_debug; 630c0d06caSMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 640c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 650c0d06caSMauro Carvalho Chehab 660c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 670c0d06caSMauro Carvalho Chehab do {\ 680c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 690c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 700c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 710c0d06caSMauro Carvalho Chehab } \ 720c0d06caSMauro Carvalho Chehab } while (0) 730c0d06caSMauro Carvalho Chehab 740c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 750c0d06caSMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC); 760c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 770c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 780c0d06caSMauro Carvalho Chehab 79d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 80d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 81d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 820c0d06caSMauro Carvalho Chehab 830c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 840c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 850c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 860c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 870c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 880c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 890c0d06caSMauro Carvalho Chehab 900c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 910c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 920c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 930c0d06caSMauro Carvalho Chehab 940c0d06caSMauro Carvalho Chehab /* supported video standards */ 950c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 960c0d06caSMauro Carvalho Chehab { 970c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 980c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 990c0d06caSMauro Carvalho Chehab .depth = 16, 1000c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1010c0d06caSMauro Carvalho Chehab }, { 1020c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1030c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1040c0d06caSMauro Carvalho Chehab .depth = 16, 1050c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1060c0d06caSMauro Carvalho Chehab }, { 1070c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1080c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1090c0d06caSMauro Carvalho Chehab .depth = 8, 1100c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1110c0d06caSMauro Carvalho Chehab }, { 1120c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1130c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1140c0d06caSMauro Carvalho Chehab .depth = 8, 1150c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1160c0d06caSMauro Carvalho Chehab }, { 1170c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1180c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1190c0d06caSMauro Carvalho Chehab .depth = 8, 1200c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1210c0d06caSMauro Carvalho Chehab }, { 1220c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1230c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1240c0d06caSMauro Carvalho Chehab .depth = 12, 1250c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1260c0d06caSMauro Carvalho Chehab }, 1270c0d06caSMauro Carvalho Chehab }; 1280c0d06caSMauro Carvalho Chehab 1290c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1300c0d06caSMauro Carvalho Chehab DMA and thread functions 1310c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 1320c0d06caSMauro Carvalho Chehab 1330c0d06caSMauro Carvalho Chehab /* 134948a49aaSFrank Schaefer * Finish the current buffer 1350c0d06caSMauro Carvalho Chehab */ 136948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 1370c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 1380c0d06caSMauro Carvalho Chehab { 139d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 140d3829fadSDevin Heitmueller 141d3829fadSDevin Heitmueller buf->vb.v4l2_buf.sequence = dev->field_count++; 142d3829fadSDevin Heitmueller buf->vb.v4l2_buf.field = V4L2_FIELD_INTERLACED; 143d3829fadSDevin Heitmueller v4l2_get_timestamp(&buf->vb.v4l2_buf.timestamp); 144d3829fadSDevin Heitmueller 145d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_DONE); 1460c0d06caSMauro Carvalho Chehab } 1470c0d06caSMauro Carvalho Chehab 1480c0d06caSMauro Carvalho Chehab /* 14936016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 1500c0d06caSMauro Carvalho Chehab */ 1510c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 1520c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 15336016a35SFrank Schaefer unsigned char *usb_buf, 1544078d625SFrank Schaefer unsigned long len) 1550c0d06caSMauro Carvalho Chehab { 1560c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 1570c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 1580c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 1590c0d06caSMauro Carvalho Chehab 160d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 161d3829fadSDevin Heitmueller len = buf->length - buf->pos; 1620c0d06caSMauro Carvalho Chehab 16336016a35SFrank Schaefer startread = usb_buf; 1640c0d06caSMauro Carvalho Chehab remain = len; 1650c0d06caSMauro Carvalho Chehab 166c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 16736016a35SFrank Schaefer fieldstart = buf->vb_buf; 168c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 16936016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 1700c0d06caSMauro Carvalho Chehab 1718732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 1728732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 1730c0d06caSMauro Carvalho Chehab 1740c0d06caSMauro Carvalho Chehab if (dev->progressive) 1750c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 1760c0d06caSMauro Carvalho Chehab else 1770c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 1780c0d06caSMauro Carvalho Chehab 1790c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 1800c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 1810c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 1820c0d06caSMauro Carvalho Chehab 183d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 1840c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 1850c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 186d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 187d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 18836016a35SFrank Schaefer (char *)startwrite; 1890c0d06caSMauro Carvalho Chehab lencopy = remain; 1900c0d06caSMauro Carvalho Chehab } 1910c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 1920c0d06caSMauro Carvalho Chehab return; 1930c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 1940c0d06caSMauro Carvalho Chehab 1950c0d06caSMauro Carvalho Chehab remain -= lencopy; 1960c0d06caSMauro Carvalho Chehab 1970c0d06caSMauro Carvalho Chehab while (remain > 0) { 198c02ec71bSFrank Schaefer if (dev->progressive) 199c02ec71bSFrank Schaefer startwrite += lencopy; 200c02ec71bSFrank Schaefer else 2010c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 2020c0d06caSMauro Carvalho Chehab startread += lencopy; 2030c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 2040c0d06caSMauro Carvalho Chehab lencopy = remain; 2050c0d06caSMauro Carvalho Chehab else 2060c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 2070c0d06caSMauro Carvalho Chehab 20836016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 209d3829fadSDevin Heitmueller buf->length) { 2100c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 2110c0d06caSMauro Carvalho Chehab "(2)\n", 2120c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 213d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 214d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 2150c0d06caSMauro Carvalho Chehab (char *)startwrite; 2160c0d06caSMauro Carvalho Chehab } 2170c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2180c0d06caSMauro Carvalho Chehab break; 2190c0d06caSMauro Carvalho Chehab 2200c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2210c0d06caSMauro Carvalho Chehab 2220c0d06caSMauro Carvalho Chehab remain -= lencopy; 2230c0d06caSMauro Carvalho Chehab } 2240c0d06caSMauro Carvalho Chehab 2258732533bSFrank Schaefer buf->pos += len; 2260c0d06caSMauro Carvalho Chehab } 2270c0d06caSMauro Carvalho Chehab 22836016a35SFrank Schaefer /* 22936016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 23036016a35SFrank Schaefer */ 2310c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 2320c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 23336016a35SFrank Schaefer unsigned char *usb_buf, 2344078d625SFrank Schaefer unsigned long len) 2350c0d06caSMauro Carvalho Chehab { 23636016a35SFrank Schaefer unsigned int offset; 2370c0d06caSMauro Carvalho Chehab 238d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 239d3829fadSDevin Heitmueller len = buf->length - buf->pos; 2400c0d06caSMauro Carvalho Chehab 2418732533bSFrank Schaefer offset = buf->pos; 2420c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 24336016a35SFrank Schaefer if (buf->top_field == 0) 24436016a35SFrank Schaefer offset += dev->vbi_width * dev->vbi_height; 2450c0d06caSMauro Carvalho Chehab 24636016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 2478732533bSFrank Schaefer buf->pos += len; 2480c0d06caSMauro Carvalho Chehab } 2490c0d06caSMauro Carvalho Chehab 2500c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 2510c0d06caSMauro Carvalho Chehab int packet, int status) 2520c0d06caSMauro Carvalho Chehab { 2530c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 2540c0d06caSMauro Carvalho Chehab 2550c0d06caSMauro Carvalho Chehab switch (status) { 2560c0d06caSMauro Carvalho Chehab case -ENOENT: 2570c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 2580c0d06caSMauro Carvalho Chehab break; 2590c0d06caSMauro Carvalho Chehab case -ECONNRESET: 2600c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 2610c0d06caSMauro Carvalho Chehab break; 2620c0d06caSMauro Carvalho Chehab case -ENOSR: 2630c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 2640c0d06caSMauro Carvalho Chehab break; 2650c0d06caSMauro Carvalho Chehab case -EPIPE: 2660c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 2670c0d06caSMauro Carvalho Chehab break; 2680c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 2690c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 2700c0d06caSMauro Carvalho Chehab break; 2710c0d06caSMauro Carvalho Chehab case -EPROTO: 2720c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 2730c0d06caSMauro Carvalho Chehab break; 2740c0d06caSMauro Carvalho Chehab case -EILSEQ: 2750c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 2760c0d06caSMauro Carvalho Chehab break; 2770c0d06caSMauro Carvalho Chehab case -ETIME: 2780c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 2790c0d06caSMauro Carvalho Chehab break; 2800c0d06caSMauro Carvalho Chehab } 2810c0d06caSMauro Carvalho Chehab if (packet < 0) { 2820c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 2830c0d06caSMauro Carvalho Chehab } else { 2840c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 2850c0d06caSMauro Carvalho Chehab packet, status, errmsg); 2860c0d06caSMauro Carvalho Chehab } 2870c0d06caSMauro Carvalho Chehab } 2880c0d06caSMauro Carvalho Chehab 2890c0d06caSMauro Carvalho Chehab /* 29024a6d849SFrank Schaefer * get the next available buffer from dma queue 2910c0d06caSMauro Carvalho Chehab */ 29224a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 29324a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 2940c0d06caSMauro Carvalho Chehab { 29524a6d849SFrank Schaefer struct em28xx_buffer *buf; 2960c0d06caSMauro Carvalho Chehab 2970c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 2980c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 29924a6d849SFrank Schaefer return NULL; 3000c0d06caSMauro Carvalho Chehab } 3010c0d06caSMauro Carvalho Chehab 3020c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 303d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 3040c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 305d3829fadSDevin Heitmueller list_del(&buf->list); 3068732533bSFrank Schaefer buf->pos = 0; 307d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 3080c0d06caSMauro Carvalho Chehab 30924a6d849SFrank Schaefer return buf; 3100c0d06caSMauro Carvalho Chehab } 3110c0d06caSMauro Carvalho Chehab 312e04c00d9SFrank Schaefer /* 313e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 314e04c00d9SFrank Schaefer */ 315e04c00d9SFrank Schaefer static struct em28xx_buffer * 316e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 317e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 318e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 319e04c00d9SFrank Schaefer { 320e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 321e04c00d9SFrank Schaefer if (buf != NULL) 322e04c00d9SFrank Schaefer finish_buffer(dev, buf); 323e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 324e04c00d9SFrank Schaefer } 325e04c00d9SFrank Schaefer if (buf != NULL) { 326e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 327e04c00d9SFrank Schaefer buf->pos = 0; 328e04c00d9SFrank Schaefer } 329e04c00d9SFrank Schaefer 330e04c00d9SFrank Schaefer return buf; 331e04c00d9SFrank Schaefer } 332e04c00d9SFrank Schaefer 333227b7c90SFrank Schaefer /* 334227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 335227b7c90SFrank Schaefer */ 336227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 337227b7c90SFrank Schaefer unsigned char *data_pkt, 338227b7c90SFrank Schaefer unsigned int data_len) 339227b7c90SFrank Schaefer { 340227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 341227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 342227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 343227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 344227b7c90SFrank Schaefer 345227b7c90SFrank Schaefer /* capture type 0 = vbi start 346227b7c90SFrank Schaefer capture type 1 = vbi in progress 347227b7c90SFrank Schaefer capture type 2 = video start 348227b7c90SFrank Schaefer capture type 3 = video in progress */ 349227b7c90SFrank Schaefer if (data_len >= 4) { 350227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 351227b7c90SFrank Schaefer * never split across packets */ 352227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 353227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 354227b7c90SFrank Schaefer /* Continuation */ 355227b7c90SFrank Schaefer data_pkt += 4; 356227b7c90SFrank Schaefer data_len -= 4; 357227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 358227b7c90SFrank Schaefer /* Field start (VBI mode) */ 359227b7c90SFrank Schaefer dev->capture_type = 0; 360227b7c90SFrank Schaefer dev->vbi_read = 0; 361227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 362227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 363227b7c90SFrank Schaefer data_pkt += 4; 364227b7c90SFrank Schaefer data_len -= 4; 365227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 366227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 367227b7c90SFrank Schaefer dev->capture_type = 2; 368227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 369227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 370227b7c90SFrank Schaefer data_pkt += 4; 371227b7c90SFrank Schaefer data_len -= 4; 372227b7c90SFrank Schaefer } 373227b7c90SFrank Schaefer } 374227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 375227b7c90SFrank Schaefer * have no continuation header */ 376227b7c90SFrank Schaefer 377227b7c90SFrank Schaefer if (dev->capture_type == 0) { 378227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 379227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 380227b7c90SFrank Schaefer dev->capture_type = 1; 381227b7c90SFrank Schaefer } 382227b7c90SFrank Schaefer 383227b7c90SFrank Schaefer if (dev->capture_type == 1) { 384227b7c90SFrank Schaefer int vbi_size = dev->vbi_width * dev->vbi_height; 385227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 386227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 387227b7c90SFrank Schaefer 388227b7c90SFrank Schaefer /* Copy VBI data */ 389227b7c90SFrank Schaefer if (vbi_buf != NULL) 390227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 391227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 392227b7c90SFrank Schaefer 393227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 394227b7c90SFrank Schaefer /* Continue with copying video data */ 395227b7c90SFrank Schaefer dev->capture_type = 2; 396227b7c90SFrank Schaefer data_pkt += vbi_data_len; 397227b7c90SFrank Schaefer data_len -= vbi_data_len; 398227b7c90SFrank Schaefer } 399227b7c90SFrank Schaefer } 400227b7c90SFrank Schaefer 401227b7c90SFrank Schaefer if (dev->capture_type == 2) { 402227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 403227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 404227b7c90SFrank Schaefer dev->capture_type = 3; 405227b7c90SFrank Schaefer } 406227b7c90SFrank Schaefer 407227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 408227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 409227b7c90SFrank Schaefer } 410227b7c90SFrank Schaefer 411960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 4120fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 4130c0d06caSMauro Carvalho Chehab { 414227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 415227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 416227b7c90SFrank Schaefer unsigned int usb_data_len; 4170c0d06caSMauro Carvalho Chehab 4180c0d06caSMauro Carvalho Chehab if (!dev) 4190c0d06caSMauro Carvalho Chehab return 0; 4200c0d06caSMauro Carvalho Chehab 4212665c299SFrank Schaefer if (dev->disconnected) 4220c0d06caSMauro Carvalho Chehab return 0; 4230c0d06caSMauro Carvalho Chehab 4241653cb0cSFrank Schaefer if (urb->status < 0) 4250c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 4260c0d06caSMauro Carvalho Chehab 4274601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 4284601cc39SFrank Schaefer 4294601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 4304601cc39SFrank Schaefer num_packets = 1; 4314601cc39SFrank Schaefer else /* isoc */ 4324601cc39SFrank Schaefer num_packets = urb->number_of_packets; 4330c0d06caSMauro Carvalho Chehab 4344601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 4354601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 436227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 4374601cc39SFrank Schaefer 438227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 4394601cc39SFrank Schaefer } else { /* isoc */ 4404601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 4414601cc39SFrank Schaefer print_err_status(dev, i, 4424601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 4430c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 4440c0d06caSMauro Carvalho Chehab continue; 4450c0d06caSMauro Carvalho Chehab } 4460c0d06caSMauro Carvalho Chehab 447227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 448227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 4490c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 4500c0d06caSMauro Carvalho Chehab continue; 4510c0d06caSMauro Carvalho Chehab } 4520c0d06caSMauro Carvalho Chehab 453227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 4544601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 4554601cc39SFrank Schaefer } 4564601cc39SFrank Schaefer 457227b7c90SFrank Schaefer if (usb_data_len == 0) { 4584601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 4594601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 4604601cc39SFrank Schaefer continue; 4614601cc39SFrank Schaefer } 4620c0d06caSMauro Carvalho Chehab 463227b7c90SFrank Schaefer process_frame_data_em28xx(dev, usb_data_pkt, usb_data_len); 4640c0d06caSMauro Carvalho Chehab } 465227b7c90SFrank Schaefer return 1; 4660c0d06caSMauro Carvalho Chehab } 4670c0d06caSMauro Carvalho Chehab 4680c0d06caSMauro Carvalho Chehab 469d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 470d3829fadSDevin Heitmueller { 471d3829fadSDevin Heitmueller switch (f_type) { 472d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 473d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 474d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 475d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 476d3829fadSDevin Heitmueller default: 477d3829fadSDevin Heitmueller BUG(); 478d3829fadSDevin Heitmueller return 0; 479d3829fadSDevin Heitmueller } 480d3829fadSDevin Heitmueller } 481d3829fadSDevin Heitmueller 482d3829fadSDevin Heitmueller /* Usage lock check functions */ 483d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 484d3829fadSDevin Heitmueller { 485d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 486d3829fadSDevin Heitmueller 487d3829fadSDevin Heitmueller /* is it free? */ 488d3829fadSDevin Heitmueller if (dev->resources & res_type) { 489d3829fadSDevin Heitmueller /* no, someone else uses it */ 490d3829fadSDevin Heitmueller return -EBUSY; 491d3829fadSDevin Heitmueller } 492d3829fadSDevin Heitmueller 493d3829fadSDevin Heitmueller /* it's free, grab it */ 494d3829fadSDevin Heitmueller dev->resources |= res_type; 495d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 496d3829fadSDevin Heitmueller return 0; 497d3829fadSDevin Heitmueller } 498d3829fadSDevin Heitmueller 499d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 500d3829fadSDevin Heitmueller { 501d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 502d3829fadSDevin Heitmueller 503d3829fadSDevin Heitmueller dev->resources &= ~res_type; 504d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 505d3829fadSDevin Heitmueller } 506d3829fadSDevin Heitmueller 5070c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 508d3829fadSDevin Heitmueller Videobuf2 operations 5090c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 5100c0d06caSMauro Carvalho Chehab 511d3829fadSDevin Heitmueller static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *fmt, 512d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 513d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 5140c0d06caSMauro Carvalho Chehab { 515d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 516d3829fadSDevin Heitmueller unsigned long size; 5170c0d06caSMauro Carvalho Chehab 518d3829fadSDevin Heitmueller if (fmt) 519d3829fadSDevin Heitmueller size = fmt->fmt.pix.sizeimage; 520d3829fadSDevin Heitmueller else 521d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 5220c0d06caSMauro Carvalho Chehab 523d3829fadSDevin Heitmueller if (size == 0) 524d3829fadSDevin Heitmueller return -EINVAL; 5250c0d06caSMauro Carvalho Chehab 526d3829fadSDevin Heitmueller if (0 == *nbuffers) 527d3829fadSDevin Heitmueller *nbuffers = 32; 5280c0d06caSMauro Carvalho Chehab 529d3829fadSDevin Heitmueller *nplanes = 1; 530d3829fadSDevin Heitmueller sizes[0] = size; 5310c0d06caSMauro Carvalho Chehab 5320c0d06caSMauro Carvalho Chehab return 0; 5330c0d06caSMauro Carvalho Chehab } 5340c0d06caSMauro Carvalho Chehab 5350c0d06caSMauro Carvalho Chehab static int 536d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 5370c0d06caSMauro Carvalho Chehab { 538d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 5390c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 540d3829fadSDevin Heitmueller unsigned long size; 5410c0d06caSMauro Carvalho Chehab 542d3829fadSDevin Heitmueller em28xx_videodbg("%s, field=%d\n", __func__, vb->v4l2_buf.field); 5430c0d06caSMauro Carvalho Chehab 544d3829fadSDevin Heitmueller size = (dev->width * dev->height * dev->format->depth + 7) >> 3; 545d3829fadSDevin Heitmueller 546d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 547d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 548d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 5490c0d06caSMauro Carvalho Chehab return -EINVAL; 550d3829fadSDevin Heitmueller } 551d3829fadSDevin Heitmueller vb2_set_plane_payload(&buf->vb, 0, size); 5520c0d06caSMauro Carvalho Chehab 553d3829fadSDevin Heitmueller return 0; 5540c0d06caSMauro Carvalho Chehab } 5550c0d06caSMauro Carvalho Chehab 556d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 557d3829fadSDevin Heitmueller { 558d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 559d3829fadSDevin Heitmueller struct v4l2_frequency f; 560d3829fadSDevin Heitmueller int rc = 0; 5610c0d06caSMauro Carvalho Chehab 562d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 563d3829fadSDevin Heitmueller 564d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 565d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 566d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 567d3829fadSDevin Heitmueller if (rc) 568d3829fadSDevin Heitmueller return rc; 569d3829fadSDevin Heitmueller 570d3829fadSDevin Heitmueller if (dev->streaming_users++ == 0) { 571d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 572d3829fadSDevin Heitmueller 573d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 574d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 575d3829fadSDevin Heitmueller 576d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 577d3829fadSDevin Heitmueller some i2c device 578d3829fadSDevin Heitmueller */ 579d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 580d3829fadSDevin Heitmueller 5810455eebfSFrank Schaefer dev->capture_type = -1; 582c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 583c647a91aSFrank Schaefer dev->analog_xfer_bulk, 5840c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 5850c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 586c647a91aSFrank Schaefer dev->packet_multiplier, 5870fa4a402SFrank Schaefer em28xx_urb_data_copy); 5880c0d06caSMauro Carvalho Chehab if (rc < 0) 5890c0d06caSMauro Carvalho Chehab goto fail; 590d3829fadSDevin Heitmueller 591d3829fadSDevin Heitmueller /* 592d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 593d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 594d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 595d3829fadSDevin Heitmueller */ 596d3829fadSDevin Heitmueller 597d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 598d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 599d3829fadSDevin Heitmueller f.frequency = dev->ctl_freq; 600d3829fadSDevin Heitmueller if (vq->owner && vq->owner->vdev->vfl_type == VFL_TYPE_RADIO) 601d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 602d3829fadSDevin Heitmueller else 603d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 604d3829fadSDevin Heitmueller v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 6050c0d06caSMauro Carvalho Chehab } 6060c0d06caSMauro Carvalho Chehab 6070c0d06caSMauro Carvalho Chehab fail: 6080c0d06caSMauro Carvalho Chehab return rc; 6090c0d06caSMauro Carvalho Chehab } 6100c0d06caSMauro Carvalho Chehab 6113a799c27SMauro Carvalho Chehab static int em28xx_stop_streaming(struct vb2_queue *vq) 6120c0d06caSMauro Carvalho Chehab { 613d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 6140c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 615d3829fadSDevin Heitmueller unsigned long flags = 0; 6160c0d06caSMauro Carvalho Chehab 617d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 6180c0d06caSMauro Carvalho Chehab 619d3829fadSDevin Heitmueller res_free(dev, vq->type); 620d3829fadSDevin Heitmueller 621d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 622d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 623d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 6240c0d06caSMauro Carvalho Chehab } 6250c0d06caSMauro Carvalho Chehab 626d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 627d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 628d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 629d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 630d3829fadSDevin Heitmueller list_del(&buf->list); 631d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 632d3829fadSDevin Heitmueller } 633d3829fadSDevin Heitmueller dev->usb_ctl.vid_buf = NULL; 634d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 635d3829fadSDevin Heitmueller 636d3829fadSDevin Heitmueller return 0; 637d3829fadSDevin Heitmueller } 638d3829fadSDevin Heitmueller 639d3829fadSDevin Heitmueller int em28xx_stop_vbi_streaming(struct vb2_queue *vq) 6400c0d06caSMauro Carvalho Chehab { 641d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 642d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 643d3829fadSDevin Heitmueller unsigned long flags = 0; 6440c0d06caSMauro Carvalho Chehab 645d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 6460c0d06caSMauro Carvalho Chehab 647d3829fadSDevin Heitmueller res_free(dev, vq->type); 648d3829fadSDevin Heitmueller 649d3829fadSDevin Heitmueller if (dev->streaming_users-- == 1) { 650d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 651d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 6520c0d06caSMauro Carvalho Chehab } 6530c0d06caSMauro Carvalho Chehab 654d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 655d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 656d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 657d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 658d3829fadSDevin Heitmueller list_del(&buf->list); 659d3829fadSDevin Heitmueller vb2_buffer_done(&buf->vb, VB2_BUF_STATE_ERROR); 660d3829fadSDevin Heitmueller } 661d3829fadSDevin Heitmueller dev->usb_ctl.vbi_buf = NULL; 662d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 663d3829fadSDevin Heitmueller 664d3829fadSDevin Heitmueller return 0; 665d3829fadSDevin Heitmueller } 666d3829fadSDevin Heitmueller 667d3829fadSDevin Heitmueller static void 668d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 669d3829fadSDevin Heitmueller { 670d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 671d3829fadSDevin Heitmueller struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 672d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 673d3829fadSDevin Heitmueller unsigned long flags = 0; 674d3829fadSDevin Heitmueller 675d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 676d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 677d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 678d3829fadSDevin Heitmueller 679d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 680d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 681d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 682d3829fadSDevin Heitmueller } 683d3829fadSDevin Heitmueller 684d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 685d3829fadSDevin Heitmueller .queue_setup = queue_setup, 6860c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 6870c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 688d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 689d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 690d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 691d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 6920c0d06caSMauro Carvalho Chehab }; 6930c0d06caSMauro Carvalho Chehab 694d3829fadSDevin Heitmueller int em28xx_vb2_setup(struct em28xx *dev) 695d3829fadSDevin Heitmueller { 696d3829fadSDevin Heitmueller int rc; 697d3829fadSDevin Heitmueller struct vb2_queue *q; 698d3829fadSDevin Heitmueller 699d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 700d3829fadSDevin Heitmueller q = &dev->vb_vidq; 701d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 702ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 703d3829fadSDevin Heitmueller q->drv_priv = dev; 704d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 705d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 706d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 707d3829fadSDevin Heitmueller 708d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 709d3829fadSDevin Heitmueller if (rc < 0) 710d3829fadSDevin Heitmueller return rc; 711d3829fadSDevin Heitmueller 712d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 713d3829fadSDevin Heitmueller q = &dev->vb_vbiq; 714d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 715d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 716d3829fadSDevin Heitmueller q->drv_priv = dev; 717d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 718d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 719d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 720d3829fadSDevin Heitmueller 721d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 722d3829fadSDevin Heitmueller if (rc < 0) 723d3829fadSDevin Heitmueller return rc; 724d3829fadSDevin Heitmueller 725d3829fadSDevin Heitmueller return 0; 726d3829fadSDevin Heitmueller } 727d3829fadSDevin Heitmueller 7280c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 7290c0d06caSMauro Carvalho Chehab 7300c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 7310c0d06caSMauro Carvalho Chehab { 7320c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 7330c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 7340c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 7350c0d06caSMauro Carvalho Chehab 7360c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 7370c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 7380c0d06caSMauro Carvalho Chehab 7390c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 7400c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 7410c0d06caSMauro Carvalho Chehab 7420c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 7430c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 7440c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 7450c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 7460c0d06caSMauro Carvalho Chehab } 7470c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 7480c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 7490c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 7500c0d06caSMauro Carvalho Chehab } 7510c0d06caSMauro Carvalho Chehab 7520c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 7530c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 7540c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 7550c0d06caSMauro Carvalho Chehab } 7560c0d06caSMauro Carvalho Chehab 7570c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 7580c0d06caSMauro Carvalho Chehab } 7590c0d06caSMauro Carvalho Chehab 760081b945eSHans Verkuil void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 7610c0d06caSMauro Carvalho Chehab { 762081b945eSHans Verkuil struct em28xx *dev = priv; 7630c0d06caSMauro Carvalho Chehab 7640c0d06caSMauro Carvalho Chehab /* 765081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 766081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 767081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 768081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 7690c0d06caSMauro Carvalho Chehab */ 7700c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 7710c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 772081b945eSHans Verkuil dev->mute = ctrl->val; 773081b945eSHans Verkuil em28xx_audio_analog_set(dev); 7740c0d06caSMauro Carvalho Chehab break; 7750c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 776081b945eSHans Verkuil dev->volume = ctrl->val; 777081b945eSHans Verkuil em28xx_audio_analog_set(dev); 778081b945eSHans Verkuil break; 779081b945eSHans Verkuil } 780081b945eSHans Verkuil } 781081b945eSHans Verkuil 782081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 783081b945eSHans Verkuil { 784081b945eSHans Verkuil struct em28xx *dev = container_of(ctrl->handler, struct em28xx, ctrl_handler); 785081b945eSHans Verkuil 786081b945eSHans Verkuil switch (ctrl->id) { 787081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 788081b945eSHans Verkuil dev->mute = ctrl->val; 789081b945eSHans Verkuil break; 790081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 791081b945eSHans Verkuil dev->volume = ctrl->val; 7920c0d06caSMauro Carvalho Chehab break; 7930c0d06caSMauro Carvalho Chehab } 7940c0d06caSMauro Carvalho Chehab 7950c0d06caSMauro Carvalho Chehab return em28xx_audio_analog_set(dev); 7960c0d06caSMauro Carvalho Chehab } 7970c0d06caSMauro Carvalho Chehab 798081b945eSHans Verkuil const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 799081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 800081b945eSHans Verkuil }; 801081b945eSHans Verkuil 8020c0d06caSMauro Carvalho Chehab static int check_dev(struct em28xx *dev) 8030c0d06caSMauro Carvalho Chehab { 8042665c299SFrank Schaefer if (dev->disconnected) { 8050c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device not present\n"); 8060c0d06caSMauro Carvalho Chehab return -ENODEV; 8070c0d06caSMauro Carvalho Chehab } 8080c0d06caSMauro Carvalho Chehab return 0; 8090c0d06caSMauro Carvalho Chehab } 8100c0d06caSMauro Carvalho Chehab 8110c0d06caSMauro Carvalho Chehab static void get_scale(struct em28xx *dev, 8120c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 8130c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 8140c0d06caSMauro Carvalho Chehab { 8150c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 8160c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 8170c0d06caSMauro Carvalho Chehab 8180c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 8190c0d06caSMauro Carvalho Chehab if (*hscale >= 0x4000) 8200c0d06caSMauro Carvalho Chehab *hscale = 0x3fff; 8210c0d06caSMauro Carvalho Chehab 8220c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 8230c0d06caSMauro Carvalho Chehab if (*vscale >= 0x4000) 8240c0d06caSMauro Carvalho Chehab *vscale = 0x3fff; 8250c0d06caSMauro Carvalho Chehab } 8260c0d06caSMauro Carvalho Chehab 8270c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 8280c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 8290c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 8300c0d06caSMauro Carvalho Chehab 8310c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 8320c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 8330c0d06caSMauro Carvalho Chehab { 8340c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 8350c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8360c0d06caSMauro Carvalho Chehab 8370c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 8380c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 8390c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 8400c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 8410c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 8420c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 8430c0d06caSMauro Carvalho Chehab 8440c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 8450c0d06caSMauro Carvalho Chehab if (dev->progressive) 8460c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 8470c0d06caSMauro Carvalho Chehab else 8480c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 8490c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 8500c0d06caSMauro Carvalho Chehab return 0; 8510c0d06caSMauro Carvalho Chehab } 8520c0d06caSMauro Carvalho Chehab 8530c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 8540c0d06caSMauro Carvalho Chehab { 8550c0d06caSMauro Carvalho Chehab unsigned int i; 8560c0d06caSMauro Carvalho Chehab 8570c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 8580c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 8590c0d06caSMauro Carvalho Chehab return &format[i]; 8600c0d06caSMauro Carvalho Chehab 8610c0d06caSMauro Carvalho Chehab return NULL; 8620c0d06caSMauro Carvalho Chehab } 8630c0d06caSMauro Carvalho Chehab 8640c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 8650c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 8660c0d06caSMauro Carvalho Chehab { 8670c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 8680c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8690c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 8700c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 8710c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 8720c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 8730c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 8740c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 8750c0d06caSMauro Carvalho Chehab 8760c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 8770c0d06caSMauro Carvalho Chehab if (!fmt) { 8780c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 8790c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 8800c0d06caSMauro Carvalho Chehab return -EINVAL; 8810c0d06caSMauro Carvalho Chehab } 8820c0d06caSMauro Carvalho Chehab 8830c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 8840c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 8850c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 8860c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 887d3829fadSDevin Heitmueller /* 888d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 889d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 890d3829fadSDevin Heitmueller * to 50% 891d3829fadSDevin Heitmueller */ 8920c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 8930c0d06caSMauro Carvalho Chehab width /= 2; 8940c0d06caSMauro Carvalho Chehab } else { 8950c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 8960c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 8970c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 8980c0d06caSMauro Carvalho Chehab 1, 0); 8990c0d06caSMauro Carvalho Chehab } 9000c0d06caSMauro Carvalho Chehab 9010c0d06caSMauro Carvalho Chehab get_scale(dev, width, height, &hscale, &vscale); 9020c0d06caSMauro Carvalho Chehab 9030c0d06caSMauro Carvalho Chehab width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 9040c0d06caSMauro Carvalho Chehab height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 9050c0d06caSMauro Carvalho Chehab 9060c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 9070c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 9080c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 909e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 9100c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 9110c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 9120c0d06caSMauro Carvalho Chehab if (dev->progressive) 9130c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 9140c0d06caSMauro Carvalho Chehab else 9150c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 9160c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 9170c0d06caSMauro Carvalho Chehab 9180c0d06caSMauro Carvalho Chehab return 0; 9190c0d06caSMauro Carvalho Chehab } 9200c0d06caSMauro Carvalho Chehab 9210c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 9220c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 9230c0d06caSMauro Carvalho Chehab { 9240c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 9250c0d06caSMauro Carvalho Chehab 9260c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 9270c0d06caSMauro Carvalho Chehab if (!fmt) 9280c0d06caSMauro Carvalho Chehab return -EINVAL; 9290c0d06caSMauro Carvalho Chehab 9300c0d06caSMauro Carvalho Chehab dev->format = fmt; 9310c0d06caSMauro Carvalho Chehab dev->width = width; 9320c0d06caSMauro Carvalho Chehab dev->height = height; 9330c0d06caSMauro Carvalho Chehab 9340c0d06caSMauro Carvalho Chehab /* set new image size */ 9350c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 9360c0d06caSMauro Carvalho Chehab 9370c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 9380c0d06caSMauro Carvalho Chehab 9390c0d06caSMauro Carvalho Chehab return 0; 9400c0d06caSMauro Carvalho Chehab } 9410c0d06caSMauro Carvalho Chehab 9420c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 9430c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 9440c0d06caSMauro Carvalho Chehab { 945d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 9460c0d06caSMauro Carvalho Chehab 947d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 948d3829fadSDevin Heitmueller return -EBUSY; 9490c0d06caSMauro Carvalho Chehab 9500c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 9510c0d06caSMauro Carvalho Chehab 9520c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 9530c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 9540c0d06caSMauro Carvalho Chehab } 9550c0d06caSMauro Carvalho Chehab 9560c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 9570c0d06caSMauro Carvalho Chehab { 9580c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9590c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9600c0d06caSMauro Carvalho Chehab int rc; 9610c0d06caSMauro Carvalho Chehab 9620c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9630c0d06caSMauro Carvalho Chehab if (rc < 0) 9640c0d06caSMauro Carvalho Chehab return rc; 9650c0d06caSMauro Carvalho Chehab 9660c0d06caSMauro Carvalho Chehab *norm = dev->norm; 9670c0d06caSMauro Carvalho Chehab 9680c0d06caSMauro Carvalho Chehab return 0; 9690c0d06caSMauro Carvalho Chehab } 9700c0d06caSMauro Carvalho Chehab 9710c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 9720c0d06caSMauro Carvalho Chehab { 9730c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9740c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9750c0d06caSMauro Carvalho Chehab int rc; 9760c0d06caSMauro Carvalho Chehab 9770c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9780c0d06caSMauro Carvalho Chehab if (rc < 0) 9790c0d06caSMauro Carvalho Chehab return rc; 9800c0d06caSMauro Carvalho Chehab 9810c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 9820c0d06caSMauro Carvalho Chehab 9830c0d06caSMauro Carvalho Chehab return 0; 9840c0d06caSMauro Carvalho Chehab } 9850c0d06caSMauro Carvalho Chehab 9860c0d06caSMauro Carvalho Chehab static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *norm) 9870c0d06caSMauro Carvalho Chehab { 9880c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9890c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9900c0d06caSMauro Carvalho Chehab struct v4l2_format f; 9910c0d06caSMauro Carvalho Chehab int rc; 9920c0d06caSMauro Carvalho Chehab 993d8c95c08SHans Verkuil if (*norm == dev->norm) 994d8c95c08SHans Verkuil return 0; 9950c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9960c0d06caSMauro Carvalho Chehab if (rc < 0) 9970c0d06caSMauro Carvalho Chehab return rc; 9980c0d06caSMauro Carvalho Chehab 999d3829fadSDevin Heitmueller if (dev->streaming_users > 0) 1000d8c95c08SHans Verkuil return -EBUSY; 1001d8c95c08SHans Verkuil 10020c0d06caSMauro Carvalho Chehab dev->norm = *norm; 10030c0d06caSMauro Carvalho Chehab 10040c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1005d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1006d8c95c08SHans Verkuil f.fmt.pix.height = (*norm & V4L2_STD_525_60) ? 480 : 576; 10070c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 10080c0d06caSMauro Carvalho Chehab 10090c0d06caSMauro Carvalho Chehab /* set new image size */ 10100c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 10110c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 10120c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 10130c0d06caSMauro Carvalho Chehab 10140c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 10150c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 10160c0d06caSMauro Carvalho Chehab 10170c0d06caSMauro Carvalho Chehab return 0; 10180c0d06caSMauro Carvalho Chehab } 10190c0d06caSMauro Carvalho Chehab 10200c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 10210c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 10220c0d06caSMauro Carvalho Chehab { 10230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10240c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10250c0d06caSMauro Carvalho Chehab int rc = 0; 10260c0d06caSMauro Carvalho Chehab 10270c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 10280c0d06caSMauro Carvalho Chehab return -EINVAL; 10290c0d06caSMauro Carvalho Chehab 103086ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 10310c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 10320c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 10330c0d06caSMauro Carvalho Chehab video, g_parm, p); 10340c0d06caSMauro Carvalho Chehab else 10350c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 10360c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 10370c0d06caSMauro Carvalho Chehab 10380c0d06caSMauro Carvalho Chehab return rc; 10390c0d06caSMauro Carvalho Chehab } 10400c0d06caSMauro Carvalho Chehab 10410c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 10420c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 10430c0d06caSMauro Carvalho Chehab { 10440c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10450c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10460c0d06caSMauro Carvalho Chehab 10470c0d06caSMauro Carvalho Chehab if (!dev->board.is_webcam) 104886ff7f1dSHans Verkuil return -ENOTTY; 10490c0d06caSMauro Carvalho Chehab 10500c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 10510c0d06caSMauro Carvalho Chehab return -EINVAL; 10520c0d06caSMauro Carvalho Chehab 105386ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 10540c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 10550c0d06caSMauro Carvalho Chehab } 10560c0d06caSMauro Carvalho Chehab 10570c0d06caSMauro Carvalho Chehab static const char *iname[] = { 10580c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 10590c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 10600c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 10610c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 10620c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 10630c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 10640c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 10650c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 10660c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 10670c0d06caSMauro Carvalho Chehab }; 10680c0d06caSMauro Carvalho Chehab 10690c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 10700c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 10710c0d06caSMauro Carvalho Chehab { 10720c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10730c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10740c0d06caSMauro Carvalho Chehab unsigned int n; 10750c0d06caSMauro Carvalho Chehab 10760c0d06caSMauro Carvalho Chehab n = i->index; 10770c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 10780c0d06caSMauro Carvalho Chehab return -EINVAL; 10790c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 10800c0d06caSMauro Carvalho Chehab return -EINVAL; 10810c0d06caSMauro Carvalho Chehab 10820c0d06caSMauro Carvalho Chehab i->index = n; 10830c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 10840c0d06caSMauro Carvalho Chehab 10850c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 10860c0d06caSMauro Carvalho Chehab 10870c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 10880c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 10890c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 10900c0d06caSMauro Carvalho Chehab 10910c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 1092d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1093d8c95c08SHans Verkuil if (dev->board.is_webcam) 1094d8c95c08SHans Verkuil i->capabilities = 0; 10950c0d06caSMauro Carvalho Chehab 10960c0d06caSMauro Carvalho Chehab return 0; 10970c0d06caSMauro Carvalho Chehab } 10980c0d06caSMauro Carvalho Chehab 10990c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 11000c0d06caSMauro Carvalho Chehab { 11010c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11020c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11030c0d06caSMauro Carvalho Chehab 11040c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 11050c0d06caSMauro Carvalho Chehab 11060c0d06caSMauro Carvalho Chehab return 0; 11070c0d06caSMauro Carvalho Chehab } 11080c0d06caSMauro Carvalho Chehab 11090c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 11100c0d06caSMauro Carvalho Chehab { 11110c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11120c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11130c0d06caSMauro Carvalho Chehab int rc; 11140c0d06caSMauro Carvalho Chehab 11150c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11160c0d06caSMauro Carvalho Chehab if (rc < 0) 11170c0d06caSMauro Carvalho Chehab return rc; 11180c0d06caSMauro Carvalho Chehab 11190c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 11200c0d06caSMauro Carvalho Chehab return -EINVAL; 11210c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 11220c0d06caSMauro Carvalho Chehab return -EINVAL; 11230c0d06caSMauro Carvalho Chehab 11240c0d06caSMauro Carvalho Chehab video_mux(dev, i); 11250c0d06caSMauro Carvalho Chehab return 0; 11260c0d06caSMauro Carvalho Chehab } 11270c0d06caSMauro Carvalho Chehab 11280c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 11290c0d06caSMauro Carvalho Chehab { 11300c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11310c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11320c0d06caSMauro Carvalho Chehab 11330c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 11340c0d06caSMauro Carvalho Chehab return -EINVAL; 11350c0d06caSMauro Carvalho Chehab 11360c0d06caSMauro Carvalho Chehab switch (a->index) { 11370c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 11380c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 11390c0d06caSMauro Carvalho Chehab break; 11400c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 11410c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 11420c0d06caSMauro Carvalho Chehab break; 11430c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 11440c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 11450c0d06caSMauro Carvalho Chehab break; 11460c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 11470c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 11480c0d06caSMauro Carvalho Chehab break; 11490c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 11500c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 11510c0d06caSMauro Carvalho Chehab break; 11520c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 11530c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 11540c0d06caSMauro Carvalho Chehab break; 11550c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 11560c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 11570c0d06caSMauro Carvalho Chehab break; 11580c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 11590c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 11600c0d06caSMauro Carvalho Chehab break; 11610c0d06caSMauro Carvalho Chehab default: 11620c0d06caSMauro Carvalho Chehab return -EINVAL; 11630c0d06caSMauro Carvalho Chehab } 11640c0d06caSMauro Carvalho Chehab 11650c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 11660c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 11670c0d06caSMauro Carvalho Chehab 11680c0d06caSMauro Carvalho Chehab return 0; 11690c0d06caSMauro Carvalho Chehab } 11700c0d06caSMauro Carvalho Chehab 11710e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 11720c0d06caSMauro Carvalho Chehab { 11730c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11740c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11750c0d06caSMauro Carvalho Chehab 11760c0d06caSMauro Carvalho Chehab 11770c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 11780c0d06caSMauro Carvalho Chehab return -EINVAL; 11790c0d06caSMauro Carvalho Chehab 11800c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 11810c0d06caSMauro Carvalho Chehab return -EINVAL; 11820c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 11830c0d06caSMauro Carvalho Chehab return -EINVAL; 11840c0d06caSMauro Carvalho Chehab 11850c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 11860c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 11870c0d06caSMauro Carvalho Chehab 11880c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 11890c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 11900c0d06caSMauro Carvalho Chehab 11910c0d06caSMauro Carvalho Chehab return 0; 11920c0d06caSMauro Carvalho Chehab } 11930c0d06caSMauro Carvalho Chehab 11940c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 11950c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 11960c0d06caSMauro Carvalho Chehab { 11970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11990c0d06caSMauro Carvalho Chehab int rc; 12000c0d06caSMauro Carvalho Chehab 12010c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 12020c0d06caSMauro Carvalho Chehab if (rc < 0) 12030c0d06caSMauro Carvalho Chehab return rc; 12040c0d06caSMauro Carvalho Chehab 12050c0d06caSMauro Carvalho Chehab if (0 != t->index) 12060c0d06caSMauro Carvalho Chehab return -EINVAL; 12070c0d06caSMauro Carvalho Chehab 12080c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 12090c0d06caSMauro Carvalho Chehab 12100c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 12110c0d06caSMauro Carvalho Chehab return 0; 12120c0d06caSMauro Carvalho Chehab } 12130c0d06caSMauro Carvalho Chehab 12140c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 12150c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 12160c0d06caSMauro Carvalho Chehab { 12170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12180c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12190c0d06caSMauro Carvalho Chehab int rc; 12200c0d06caSMauro Carvalho Chehab 12210c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 12220c0d06caSMauro Carvalho Chehab if (rc < 0) 12230c0d06caSMauro Carvalho Chehab return rc; 12240c0d06caSMauro Carvalho Chehab 12250c0d06caSMauro Carvalho Chehab if (0 != t->index) 12260c0d06caSMauro Carvalho Chehab return -EINVAL; 12270c0d06caSMauro Carvalho Chehab 12280c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 12290c0d06caSMauro Carvalho Chehab return 0; 12300c0d06caSMauro Carvalho Chehab } 12310c0d06caSMauro Carvalho Chehab 12320c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 12330c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 12340c0d06caSMauro Carvalho Chehab { 12350c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12360c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12370c0d06caSMauro Carvalho Chehab 123820deebfeSHans Verkuil if (0 != f->tuner) 123920deebfeSHans Verkuil return -EINVAL; 124020deebfeSHans Verkuil 12410c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 12420c0d06caSMauro Carvalho Chehab return 0; 12430c0d06caSMauro Carvalho Chehab } 12440c0d06caSMauro Carvalho Chehab 12450c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 12460c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 12470c0d06caSMauro Carvalho Chehab { 12480c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12490c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12500c0d06caSMauro Carvalho Chehab int rc; 12510c0d06caSMauro Carvalho Chehab 12520c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 12530c0d06caSMauro Carvalho Chehab if (rc < 0) 12540c0d06caSMauro Carvalho Chehab return rc; 12550c0d06caSMauro Carvalho Chehab 12560c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 12570c0d06caSMauro Carvalho Chehab return -EINVAL; 12580c0d06caSMauro Carvalho Chehab 12590c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 126020deebfeSHans Verkuil v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_frequency, f); 126120deebfeSHans Verkuil dev->ctl_freq = f->frequency; 12620c0d06caSMauro Carvalho Chehab 12630c0d06caSMauro Carvalho Chehab return 0; 12640c0d06caSMauro Carvalho Chehab } 12650c0d06caSMauro Carvalho Chehab 12660c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 12670c0d06caSMauro Carvalho Chehab static int em28xx_reg_len(int reg) 12680c0d06caSMauro Carvalho Chehab { 12690c0d06caSMauro Carvalho Chehab switch (reg) { 12700c0d06caSMauro Carvalho Chehab case EM28XX_R40_AC97LSB: 12710c0d06caSMauro Carvalho Chehab case EM28XX_R30_HSCALELOW: 12720c0d06caSMauro Carvalho Chehab case EM28XX_R32_VSCALELOW: 12730c0d06caSMauro Carvalho Chehab return 2; 12740c0d06caSMauro Carvalho Chehab default: 12750c0d06caSMauro Carvalho Chehab return 1; 12760c0d06caSMauro Carvalho Chehab } 12770c0d06caSMauro Carvalho Chehab } 12780c0d06caSMauro Carvalho Chehab 12790c0d06caSMauro Carvalho Chehab static int vidioc_g_chip_ident(struct file *file, void *priv, 12800c0d06caSMauro Carvalho Chehab struct v4l2_dbg_chip_ident *chip) 12810c0d06caSMauro Carvalho Chehab { 12820c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12830c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12840c0d06caSMauro Carvalho Chehab 12850c0d06caSMauro Carvalho Chehab chip->ident = V4L2_IDENT_NONE; 12860c0d06caSMauro Carvalho Chehab chip->revision = 0; 1287319a55fbSHans Verkuil if (chip->match.type == V4L2_CHIP_MATCH_HOST) { 1288319a55fbSHans Verkuil if (v4l2_chip_match_host(&chip->match)) 1289319a55fbSHans Verkuil chip->ident = V4L2_IDENT_NONE; 1290319a55fbSHans Verkuil return 0; 1291319a55fbSHans Verkuil } 1292319a55fbSHans Verkuil if (chip->match.type != V4L2_CHIP_MATCH_I2C_DRIVER && 1293319a55fbSHans Verkuil chip->match.type != V4L2_CHIP_MATCH_I2C_ADDR) 1294319a55fbSHans Verkuil return -EINVAL; 12950c0d06caSMauro Carvalho Chehab 12960c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_chip_ident, chip); 12970c0d06caSMauro Carvalho Chehab 12980c0d06caSMauro Carvalho Chehab return 0; 12990c0d06caSMauro Carvalho Chehab } 13000c0d06caSMauro Carvalho Chehab 13010c0d06caSMauro Carvalho Chehab 13020c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 13030c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 13040c0d06caSMauro Carvalho Chehab { 13050c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13060c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13070c0d06caSMauro Carvalho Chehab int ret; 13080c0d06caSMauro Carvalho Chehab 13090c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 13100c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 13110c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 13120c0d06caSMauro Carvalho Chehab if (ret < 0) 13130c0d06caSMauro Carvalho Chehab return ret; 13140c0d06caSMauro Carvalho Chehab 13150c0d06caSMauro Carvalho Chehab reg->val = ret; 13160c0d06caSMauro Carvalho Chehab reg->size = 1; 13170c0d06caSMauro Carvalho Chehab return 0; 13180c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 13190c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 13200c0d06caSMauro Carvalho Chehab return 0; 13210c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 13220c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 13230c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 13240c0d06caSMauro Carvalho Chehab return 0; 13250c0d06caSMauro Carvalho Chehab default: 13260c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 13270c0d06caSMauro Carvalho Chehab return -EINVAL; 13280c0d06caSMauro Carvalho Chehab } 13290c0d06caSMauro Carvalho Chehab 13300c0d06caSMauro Carvalho Chehab /* Match host */ 13310c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 13320c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 13330c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 13340c0d06caSMauro Carvalho Chehab 13350c0d06caSMauro Carvalho Chehab if (ret < 0) 13360c0d06caSMauro Carvalho Chehab return ret; 13370c0d06caSMauro Carvalho Chehab 13380c0d06caSMauro Carvalho Chehab reg->val = ret; 13390c0d06caSMauro Carvalho Chehab } else { 13400c0d06caSMauro Carvalho Chehab __le16 val = 0; 13410c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 13420c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 13430c0d06caSMauro Carvalho Chehab if (ret < 0) 13440c0d06caSMauro Carvalho Chehab return ret; 13450c0d06caSMauro Carvalho Chehab 13460c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 13470c0d06caSMauro Carvalho Chehab } 13480c0d06caSMauro Carvalho Chehab 13490c0d06caSMauro Carvalho Chehab return 0; 13500c0d06caSMauro Carvalho Chehab } 13510c0d06caSMauro Carvalho Chehab 13520c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 13530c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 13540c0d06caSMauro Carvalho Chehab { 13550c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13560c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13570c0d06caSMauro Carvalho Chehab __le16 buf; 13580c0d06caSMauro Carvalho Chehab 13590c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 13600c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 13610c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 13620c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 13630c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 13640c0d06caSMauro Carvalho Chehab return 0; 13650c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 13660c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 13670c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 13680c0d06caSMauro Carvalho Chehab return 0; 13690c0d06caSMauro Carvalho Chehab default: 13700c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 13710c0d06caSMauro Carvalho Chehab return -EINVAL; 13720c0d06caSMauro Carvalho Chehab } 13730c0d06caSMauro Carvalho Chehab 13740c0d06caSMauro Carvalho Chehab /* Match host */ 13750c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 13760c0d06caSMauro Carvalho Chehab 13770c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 13780c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 13790c0d06caSMauro Carvalho Chehab } 13800c0d06caSMauro Carvalho Chehab #endif 13810c0d06caSMauro Carvalho Chehab 13820c0d06caSMauro Carvalho Chehab 13830c0d06caSMauro Carvalho Chehab static int vidioc_cropcap(struct file *file, void *priv, 13840c0d06caSMauro Carvalho Chehab struct v4l2_cropcap *cc) 13850c0d06caSMauro Carvalho Chehab { 13860c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13870c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13880c0d06caSMauro Carvalho Chehab 13890c0d06caSMauro Carvalho Chehab if (cc->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 13900c0d06caSMauro Carvalho Chehab return -EINVAL; 13910c0d06caSMauro Carvalho Chehab 13920c0d06caSMauro Carvalho Chehab cc->bounds.left = 0; 13930c0d06caSMauro Carvalho Chehab cc->bounds.top = 0; 13940c0d06caSMauro Carvalho Chehab cc->bounds.width = dev->width; 13950c0d06caSMauro Carvalho Chehab cc->bounds.height = dev->height; 13960c0d06caSMauro Carvalho Chehab cc->defrect = cc->bounds; 13970c0d06caSMauro Carvalho Chehab cc->pixelaspect.numerator = 54; /* 4:3 FIXME: remove magic numbers */ 13980c0d06caSMauro Carvalho Chehab cc->pixelaspect.denominator = 59; 13990c0d06caSMauro Carvalho Chehab 14000c0d06caSMauro Carvalho Chehab return 0; 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; 14790c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 14800c0d06caSMauro Carvalho Chehab fsize->stepwise.min_height = 32; 14810c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 14820c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 14830c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 14840c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 14850c0d06caSMauro Carvalho Chehab return 0; 14860c0d06caSMauro Carvalho Chehab } 14870c0d06caSMauro Carvalho Chehab 14880c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 14890c0d06caSMauro Carvalho Chehab 14900c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 14910c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 14920c0d06caSMauro Carvalho Chehab { 14930c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14940c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14950c0d06caSMauro Carvalho Chehab 14960c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 14970c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 14980c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 14990c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 15000c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 15010c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 15020c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 15032a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 15060c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 15070c0d06caSMauro Carvalho Chehab /* NTSC */ 15080c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 15090c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 15100c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 15110c0d06caSMauro Carvalho Chehab /* PAL */ 15120c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 15130c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 15140c0d06caSMauro Carvalho Chehab } 15150c0d06caSMauro Carvalho Chehab 15160c0d06caSMauro Carvalho Chehab return 0; 15170c0d06caSMauro Carvalho Chehab } 15180c0d06caSMauro Carvalho Chehab 15190c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vbi_cap(struct file *file, void *priv, 15200c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 15210c0d06caSMauro Carvalho Chehab { 15220c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15230c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15240c0d06caSMauro Carvalho Chehab 15250c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 15260c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 15270c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 15280c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 15290c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 15300c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 15310c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 15322a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 15330c0d06caSMauro Carvalho Chehab 15340c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 15350c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 15360c0d06caSMauro Carvalho Chehab /* NTSC */ 15370c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 15380c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 15390c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 15400c0d06caSMauro Carvalho Chehab /* PAL */ 15410c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 15420c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 15430c0d06caSMauro Carvalho Chehab } 15440c0d06caSMauro Carvalho Chehab 15450c0d06caSMauro Carvalho Chehab return 0; 15460c0d06caSMauro Carvalho Chehab } 15470c0d06caSMauro Carvalho Chehab 15480c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 15490c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 15500c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 15510c0d06caSMauro Carvalho Chehab 15520c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 15530c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15540c0d06caSMauro Carvalho Chehab { 15550c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 15560c0d06caSMauro Carvalho Chehab 15570c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 15580c0d06caSMauro Carvalho Chehab return -EINVAL; 15590c0d06caSMauro Carvalho Chehab 15600c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 15610c0d06caSMauro Carvalho Chehab t->type = V4L2_TUNER_RADIO; 15620c0d06caSMauro Carvalho Chehab 15630c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 15640c0d06caSMauro Carvalho Chehab 15650c0d06caSMauro Carvalho Chehab return 0; 15660c0d06caSMauro Carvalho Chehab } 15670c0d06caSMauro Carvalho Chehab 15680c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 15690c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 15700c0d06caSMauro Carvalho Chehab { 15710c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 15720c0d06caSMauro Carvalho Chehab 15730c0d06caSMauro Carvalho Chehab if (0 != t->index) 15740c0d06caSMauro Carvalho Chehab return -EINVAL; 15750c0d06caSMauro Carvalho Chehab 15760c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 15770c0d06caSMauro Carvalho Chehab 15780c0d06caSMauro Carvalho Chehab return 0; 15790c0d06caSMauro Carvalho Chehab } 15800c0d06caSMauro Carvalho Chehab 15810c0d06caSMauro Carvalho Chehab /* 15820c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 15830c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 15840c0d06caSMauro Carvalho Chehab */ 15850c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 15860c0d06caSMauro Carvalho Chehab { 15870c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 15880c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 15890c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 15900c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 15910c0d06caSMauro Carvalho Chehab 15920c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 15930c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 15940c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 15950c0d06caSMauro Carvalho Chehab break; 15960c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 15970c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 15980c0d06caSMauro Carvalho Chehab break; 15990c0d06caSMauro Carvalho Chehab } 16000c0d06caSMauro Carvalho Chehab 16010c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 16020c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 16030c0d06caSMauro Carvalho Chehab dev->users); 16040c0d06caSMauro Carvalho Chehab 16050c0d06caSMauro Carvalho Chehab 16060c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 16070c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 16080c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 16090c0d06caSMauro Carvalho Chehab if (!fh) { 16100c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 16110c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 16120c0d06caSMauro Carvalho Chehab return -ENOMEM; 16130c0d06caSMauro Carvalho Chehab } 161469a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 16150c0d06caSMauro Carvalho Chehab fh->dev = dev; 16160c0d06caSMauro Carvalho Chehab fh->type = fh_type; 16170c0d06caSMauro Carvalho Chehab filp->private_data = fh; 16180c0d06caSMauro Carvalho Chehab 16190c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE && dev->users == 0) { 16200c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 16210c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 16220c0d06caSMauro Carvalho Chehab 16230c0d06caSMauro Carvalho Chehab /* Needed, since GPIO might have disabled power of 16240c0d06caSMauro Carvalho Chehab some i2c device 16250c0d06caSMauro Carvalho Chehab */ 16260c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 16270c0d06caSMauro Carvalho Chehab 16280c0d06caSMauro Carvalho Chehab } 1629d3829fadSDevin Heitmueller 1630d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 16310c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 16320c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 16330c0d06caSMauro Carvalho Chehab } 16340c0d06caSMauro Carvalho Chehab 16350c0d06caSMauro Carvalho Chehab dev->users++; 16360c0d06caSMauro Carvalho Chehab 16370c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 163869a61642SHans Verkuil v4l2_fh_add(&fh->fh); 16390c0d06caSMauro Carvalho Chehab 1640d3829fadSDevin Heitmueller return 0; 16410c0d06caSMauro Carvalho Chehab } 16420c0d06caSMauro Carvalho Chehab 16430c0d06caSMauro Carvalho Chehab /* 16440c0d06caSMauro Carvalho Chehab * em28xx_realease_resources() 16450c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 16460c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 16470c0d06caSMauro Carvalho Chehab */ 16480c0d06caSMauro Carvalho Chehab void em28xx_release_analog_resources(struct em28xx *dev) 16490c0d06caSMauro Carvalho Chehab { 16500c0d06caSMauro Carvalho Chehab 16510c0d06caSMauro Carvalho Chehab /*FIXME: I2C IR should be disconnected */ 16520c0d06caSMauro Carvalho Chehab 16530c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 16540c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->radio_dev)) 16550c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 16560c0d06caSMauro Carvalho Chehab else 16570c0d06caSMauro Carvalho Chehab video_device_release(dev->radio_dev); 16580c0d06caSMauro Carvalho Chehab dev->radio_dev = NULL; 16590c0d06caSMauro Carvalho Chehab } 16600c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 16610c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 16620c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 16630c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vbi_dev)) 16640c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 16650c0d06caSMauro Carvalho Chehab else 16660c0d06caSMauro Carvalho Chehab video_device_release(dev->vbi_dev); 16670c0d06caSMauro Carvalho Chehab dev->vbi_dev = NULL; 16680c0d06caSMauro Carvalho Chehab } 16690c0d06caSMauro Carvalho Chehab if (dev->vdev) { 16700c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 16710c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 16720c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vdev)) 16730c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 16740c0d06caSMauro Carvalho Chehab else 16750c0d06caSMauro Carvalho Chehab video_device_release(dev->vdev); 16760c0d06caSMauro Carvalho Chehab dev->vdev = NULL; 16770c0d06caSMauro Carvalho Chehab } 16780c0d06caSMauro Carvalho Chehab } 16790c0d06caSMauro Carvalho Chehab 16800c0d06caSMauro Carvalho Chehab /* 16810c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 16820c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 16830c0d06caSMauro Carvalho Chehab * calls and ioctls 16840c0d06caSMauro Carvalho Chehab */ 16850c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 16860c0d06caSMauro Carvalho Chehab { 16870c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 16880c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16890c0d06caSMauro Carvalho Chehab int errCode; 16900c0d06caSMauro Carvalho Chehab 16910c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 16920c0d06caSMauro Carvalho Chehab 16930c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 1694d3829fadSDevin Heitmueller vb2_fop_release(filp); 16950c0d06caSMauro Carvalho Chehab 16960c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 16970c0d06caSMauro Carvalho Chehab /* the device is already disconnect, 16980c0d06caSMauro Carvalho Chehab free the remaining resources */ 16992665c299SFrank Schaefer if (dev->disconnected) { 17000c0d06caSMauro Carvalho Chehab em28xx_release_resources(dev); 17010cf544a6SFrank Schaefer kfree(dev->alt_max_pkt_size_isoc); 1702e36c92fdSDan Carpenter mutex_unlock(&dev->lock); 17030c0d06caSMauro Carvalho Chehab kfree(dev); 17040c0d06caSMauro Carvalho Chehab return 0; 17050c0d06caSMauro Carvalho Chehab } 17060c0d06caSMauro Carvalho Chehab 17070c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 17080c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 17090c0d06caSMauro Carvalho Chehab 17100c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 17110c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 17120c0d06caSMauro Carvalho Chehab 17130c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 17140c0d06caSMauro Carvalho Chehab dev->alt = 0; 17150c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 17160c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 17170c0d06caSMauro Carvalho Chehab if (errCode < 0) { 17180c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 17190c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 17200c0d06caSMauro Carvalho Chehab } 17210c0d06caSMauro Carvalho Chehab } 17220c0d06caSMauro Carvalho Chehab 17230c0d06caSMauro Carvalho Chehab dev->users--; 17240c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 17250c0d06caSMauro Carvalho Chehab return 0; 17260c0d06caSMauro Carvalho Chehab } 17270c0d06caSMauro Carvalho Chehab 17280c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 17290c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 17300c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 17310c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 1732d3829fadSDevin Heitmueller .read = vb2_fop_read, 1733d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 1734d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 17350c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 17360c0d06caSMauro Carvalho Chehab }; 17370c0d06caSMauro Carvalho Chehab 17380c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 17390c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 17400c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 17410c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 17420c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 17430c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 17440c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 17452a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 17460c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vbi_cap = vidioc_s_fmt_vbi_cap, 17470c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 17480c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 17490c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 17500c0d06caSMauro Carvalho Chehab .vidioc_cropcap = vidioc_cropcap, 17510c0d06caSMauro Carvalho Chehab 1752d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 1753d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 1754d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 1755d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 1756d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 1757d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 1758d3829fadSDevin Heitmueller 17590c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 17600c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 17610c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 17620c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 17630c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 17640c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 17650c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 17660c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 1767d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 1768d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 17690c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 17700c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 17710c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 17720c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 177350fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 177450fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 17750c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 17760c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 17770c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 17780c0d06caSMauro Carvalho Chehab .vidioc_g_chip_ident = vidioc_g_chip_ident, 17790c0d06caSMauro Carvalho Chehab #endif 17800c0d06caSMauro Carvalho Chehab }; 17810c0d06caSMauro Carvalho Chehab 17820c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 17830c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 1784d3829fadSDevin Heitmueller .release = video_device_release_empty, 17850c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 17860c0d06caSMauro Carvalho Chehab 17870c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 17880c0d06caSMauro Carvalho Chehab }; 17890c0d06caSMauro Carvalho Chehab 17900c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 17910c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 17920c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 17930c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 17940c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 17950c0d06caSMauro Carvalho Chehab }; 17960c0d06caSMauro Carvalho Chehab 17970c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 1798a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 17990c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 18000c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 18010c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 18020c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 180350fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 180450fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 18050c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 18060c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 18070c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 18080c0d06caSMauro Carvalho Chehab #endif 18090c0d06caSMauro Carvalho Chehab }; 18100c0d06caSMauro Carvalho Chehab 18110c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 18120c0d06caSMauro Carvalho Chehab .name = "em28xx-radio", 18130c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 18140c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 18150c0d06caSMauro Carvalho Chehab }; 18160c0d06caSMauro Carvalho Chehab 18170c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 18180c0d06caSMauro Carvalho Chehab 18190c0d06caSMauro Carvalho Chehab 18200c0d06caSMauro Carvalho Chehab 18210c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 18220c0d06caSMauro Carvalho Chehab const struct video_device *template, 18230c0d06caSMauro Carvalho Chehab const char *type_name) 18240c0d06caSMauro Carvalho Chehab { 18250c0d06caSMauro Carvalho Chehab struct video_device *vfd; 18260c0d06caSMauro Carvalho Chehab 18270c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 18280c0d06caSMauro Carvalho Chehab if (NULL == vfd) 18290c0d06caSMauro Carvalho Chehab return NULL; 18300c0d06caSMauro Carvalho Chehab 18310c0d06caSMauro Carvalho Chehab *vfd = *template; 18320c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 18330c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 18340c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 183569a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 1836d8c95c08SHans Verkuil if (dev->board.is_webcam) 1837d8c95c08SHans Verkuil vfd->tvnorms = 0; 18380c0d06caSMauro Carvalho Chehab 18390c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 18400c0d06caSMauro Carvalho Chehab dev->name, type_name); 18410c0d06caSMauro Carvalho Chehab 18420c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 18430c0d06caSMauro Carvalho Chehab return vfd; 18440c0d06caSMauro Carvalho Chehab } 18450c0d06caSMauro Carvalho Chehab 18460c0d06caSMauro Carvalho Chehab int em28xx_register_analog_devices(struct em28xx *dev) 18470c0d06caSMauro Carvalho Chehab { 18480c0d06caSMauro Carvalho Chehab u8 val; 18490c0d06caSMauro Carvalho Chehab int ret; 18500c0d06caSMauro Carvalho Chehab unsigned int maxw; 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s: v4l2 driver version %s\n", 18530c0d06caSMauro Carvalho Chehab dev->name, EM28XX_VERSION); 18540c0d06caSMauro Carvalho Chehab 18550c0d06caSMauro Carvalho Chehab /* set default norm */ 1856d8c95c08SHans Verkuil dev->norm = V4L2_STD_PAL; 18570c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 18580c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 18590c0d06caSMauro Carvalho Chehab 18600c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 18610c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 18620c0d06caSMauro Carvalho Chehab 18630c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 18640c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 18650c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 18660c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 18670c0d06caSMauro Carvalho Chehab maxw /= 2; 18680c0d06caSMauro Carvalho Chehab 18690c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 18700c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 18710c0d06caSMauro Carvalho Chehab 18720c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 18730c0d06caSMauro Carvalho Chehab 18740c0d06caSMauro Carvalho Chehab /* Audio defaults */ 18750c0d06caSMauro Carvalho Chehab dev->mute = 1; 18760c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 18770c0d06caSMauro Carvalho Chehab 18780c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 18790c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 18800c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 18810c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 18820c0d06caSMauro Carvalho Chehab 18830c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 18840c0d06caSMauro Carvalho Chehab em28xx_colorlevels_set_default(dev); 18850c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 18860c0d06caSMauro Carvalho Chehab 18870c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 18880c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 18890c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 18900c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 18910c0d06caSMauro Carvalho Chehab return -ENODEV; 18920c0d06caSMauro Carvalho Chehab } 1893d3829fadSDevin Heitmueller dev->vdev->queue = &dev->vb_vidq; 1894d3829fadSDevin Heitmueller dev->vdev->queue->lock = &dev->vb_queue_lock; 18950c0d06caSMauro Carvalho Chehab 18966e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 18976e46dabaSFrank Schaefer if (dev->board.is_webcam) { 18986e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_QUERYSTD); 18996e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_STD); 19006e46dabaSFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_STD); 19016e46dabaSFrank Schaefer } 190266df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 190366df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_TUNER); 190466df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_TUNER); 190566df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_G_FREQUENCY); 190666df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vdev, VIDIOC_S_FREQUENCY); 190766df67b7SFrank Schaefer } 19086e46dabaSFrank Schaefer 19090c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 19100c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 19110c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 19120c0d06caSMauro Carvalho Chehab if (ret) { 19130c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 19140c0d06caSMauro Carvalho Chehab ret); 19150c0d06caSMauro Carvalho Chehab return ret; 19160c0d06caSMauro Carvalho Chehab } 19170c0d06caSMauro Carvalho Chehab 19180c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 19190c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 19200c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 19210c0d06caSMauro Carvalho Chehab "vbi"); 19220c0d06caSMauro Carvalho Chehab 1923d3829fadSDevin Heitmueller dev->vbi_dev->queue = &dev->vb_vbiq; 1924d3829fadSDevin Heitmueller dev->vbi_dev->queue->lock = &dev->vb_vbi_queue_lock; 1925d3829fadSDevin Heitmueller 192666df67b7SFrank Schaefer /* disable inapplicable ioctls */ 192766df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 192866df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_TUNER); 192966df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_TUNER); 193066df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_G_FREQUENCY); 193166df67b7SFrank Schaefer v4l2_disable_ioctl(dev->vbi_dev, VIDIOC_S_FREQUENCY); 193266df67b7SFrank Schaefer } 193366df67b7SFrank Schaefer 19340c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 19350c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 19360c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 19370c0d06caSMauro Carvalho Chehab if (ret < 0) { 19380c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 19390c0d06caSMauro Carvalho Chehab return ret; 19400c0d06caSMauro Carvalho Chehab } 19410c0d06caSMauro Carvalho Chehab } 19420c0d06caSMauro Carvalho Chehab 19430c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 19440c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 19450c0d06caSMauro Carvalho Chehab "radio"); 19460c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 19470c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 19480c0d06caSMauro Carvalho Chehab return -ENODEV; 19490c0d06caSMauro Carvalho Chehab } 19500c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 19510c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 19520c0d06caSMauro Carvalho Chehab if (ret < 0) { 19530c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 19540c0d06caSMauro Carvalho Chehab return ret; 19550c0d06caSMauro Carvalho Chehab } 19560c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 19570c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 19580c0d06caSMauro Carvalho Chehab } 19590c0d06caSMauro Carvalho Chehab 19600c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 19610c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 19620c0d06caSMauro Carvalho Chehab 19630c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 19640c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 19650c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 19660c0d06caSMauro Carvalho Chehab 19670c0d06caSMauro Carvalho Chehab return 0; 19680c0d06caSMauro Carvalho Chehab } 1969