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 790c0d06caSMauro Carvalho Chehab static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 800c0d06caSMauro Carvalho Chehab static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 810c0d06caSMauro Carvalho Chehab static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = UNSET }; 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 { 1390c0d06caSMauro Carvalho Chehab em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->vb.i); 1400c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_DONE; 1410c0d06caSMauro Carvalho Chehab buf->vb.field_count++; 1428e6057b5SSakari Ailus v4l2_get_timestamp(&buf->vb.ts); 1430c0d06caSMauro Carvalho Chehab list_del(&buf->vb.queue); 1440c0d06caSMauro Carvalho Chehab wake_up(&buf->vb.done); 1450c0d06caSMauro Carvalho Chehab } 1460c0d06caSMauro Carvalho Chehab 1470c0d06caSMauro Carvalho Chehab /* 14836016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 1490c0d06caSMauro Carvalho Chehab */ 1500c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 1510c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 15236016a35SFrank Schaefer unsigned char *usb_buf, 1534078d625SFrank Schaefer unsigned long len) 1540c0d06caSMauro Carvalho Chehab { 1550c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 1560c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 1570c0d06caSMauro Carvalho Chehab int bytesperline = dev->width << 1; 1580c0d06caSMauro Carvalho Chehab 1598732533bSFrank Schaefer if (buf->pos + len > buf->vb.size) 1608732533bSFrank Schaefer len = buf->vb.size - buf->pos; 1610c0d06caSMauro Carvalho Chehab 16236016a35SFrank Schaefer startread = usb_buf; 1630c0d06caSMauro Carvalho Chehab remain = len; 1640c0d06caSMauro Carvalho Chehab 165c02ec71bSFrank Schaefer if (dev->progressive || buf->top_field) 16636016a35SFrank Schaefer fieldstart = buf->vb_buf; 167c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 16836016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 1690c0d06caSMauro Carvalho Chehab 1708732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 1718732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 1720c0d06caSMauro Carvalho Chehab 1730c0d06caSMauro Carvalho Chehab if (dev->progressive) 1740c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 1750c0d06caSMauro Carvalho Chehab else 1760c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 1770c0d06caSMauro Carvalho Chehab 1780c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 1790c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 1800c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 1810c0d06caSMauro Carvalho Chehab 18236016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->vb.size) { 1830c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", 1840c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 18536016a35SFrank Schaefer ((char *)buf->vb_buf + buf->vb.size)); 18636016a35SFrank Schaefer remain = (char *)buf->vb_buf + buf->vb.size - 18736016a35SFrank Schaefer (char *)startwrite; 1880c0d06caSMauro Carvalho Chehab lencopy = remain; 1890c0d06caSMauro Carvalho Chehab } 1900c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 1910c0d06caSMauro Carvalho Chehab return; 1920c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 1930c0d06caSMauro Carvalho Chehab 1940c0d06caSMauro Carvalho Chehab remain -= lencopy; 1950c0d06caSMauro Carvalho Chehab 1960c0d06caSMauro Carvalho Chehab while (remain > 0) { 197c02ec71bSFrank Schaefer if (dev->progressive) 198c02ec71bSFrank Schaefer startwrite += lencopy; 199c02ec71bSFrank Schaefer else 2000c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 2010c0d06caSMauro Carvalho Chehab startread += lencopy; 2020c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 2030c0d06caSMauro Carvalho Chehab lencopy = remain; 2040c0d06caSMauro Carvalho Chehab else 2050c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 2060c0d06caSMauro Carvalho Chehab 20736016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 2080c0d06caSMauro Carvalho Chehab buf->vb.size) { 2090c0d06caSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zi bytes past buffer end" 2100c0d06caSMauro Carvalho Chehab "(2)\n", 2110c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 21236016a35SFrank Schaefer ((char *)buf->vb_buf + buf->vb.size)); 21336016a35SFrank Schaefer lencopy = remain = (char *)buf->vb_buf + buf->vb.size - 2140c0d06caSMauro Carvalho Chehab (char *)startwrite; 2150c0d06caSMauro Carvalho Chehab } 2160c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 2170c0d06caSMauro Carvalho Chehab break; 2180c0d06caSMauro Carvalho Chehab 2190c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 2200c0d06caSMauro Carvalho Chehab 2210c0d06caSMauro Carvalho Chehab remain -= lencopy; 2220c0d06caSMauro Carvalho Chehab } 2230c0d06caSMauro Carvalho Chehab 2248732533bSFrank Schaefer buf->pos += len; 2250c0d06caSMauro Carvalho Chehab } 2260c0d06caSMauro Carvalho Chehab 22736016a35SFrank Schaefer /* 22836016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 22936016a35SFrank Schaefer */ 2300c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 2310c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 23236016a35SFrank Schaefer unsigned char *usb_buf, 2334078d625SFrank Schaefer unsigned long len) 2340c0d06caSMauro Carvalho Chehab { 23536016a35SFrank Schaefer unsigned int offset; 2360c0d06caSMauro Carvalho Chehab 2378732533bSFrank Schaefer if (buf->pos + len > buf->vb.size) 2388732533bSFrank Schaefer len = buf->vb.size - buf->pos; 2390c0d06caSMauro Carvalho Chehab 2408732533bSFrank Schaefer offset = buf->pos; 2410c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 24236016a35SFrank Schaefer if (buf->top_field == 0) 24336016a35SFrank Schaefer offset += dev->vbi_width * dev->vbi_height; 2440c0d06caSMauro Carvalho Chehab 24536016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 2468732533bSFrank Schaefer buf->pos += len; 2470c0d06caSMauro Carvalho Chehab } 2480c0d06caSMauro Carvalho Chehab 2490c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 2500c0d06caSMauro Carvalho Chehab int packet, int status) 2510c0d06caSMauro Carvalho Chehab { 2520c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 2530c0d06caSMauro Carvalho Chehab 2540c0d06caSMauro Carvalho Chehab switch (status) { 2550c0d06caSMauro Carvalho Chehab case -ENOENT: 2560c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 2570c0d06caSMauro Carvalho Chehab break; 2580c0d06caSMauro Carvalho Chehab case -ECONNRESET: 2590c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 2600c0d06caSMauro Carvalho Chehab break; 2610c0d06caSMauro Carvalho Chehab case -ENOSR: 2620c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 2630c0d06caSMauro Carvalho Chehab break; 2640c0d06caSMauro Carvalho Chehab case -EPIPE: 2650c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 2660c0d06caSMauro Carvalho Chehab break; 2670c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 2680c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 2690c0d06caSMauro Carvalho Chehab break; 2700c0d06caSMauro Carvalho Chehab case -EPROTO: 2710c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 2720c0d06caSMauro Carvalho Chehab break; 2730c0d06caSMauro Carvalho Chehab case -EILSEQ: 2740c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 2750c0d06caSMauro Carvalho Chehab break; 2760c0d06caSMauro Carvalho Chehab case -ETIME: 2770c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 2780c0d06caSMauro Carvalho Chehab break; 2790c0d06caSMauro Carvalho Chehab } 2800c0d06caSMauro Carvalho Chehab if (packet < 0) { 2810c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 2820c0d06caSMauro Carvalho Chehab } else { 2830c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 2840c0d06caSMauro Carvalho Chehab packet, status, errmsg); 2850c0d06caSMauro Carvalho Chehab } 2860c0d06caSMauro Carvalho Chehab } 2870c0d06caSMauro Carvalho Chehab 2880c0d06caSMauro Carvalho Chehab /* 28924a6d849SFrank Schaefer * get the next available buffer from dma queue 2900c0d06caSMauro Carvalho Chehab */ 29124a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 29224a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 2930c0d06caSMauro Carvalho Chehab { 29424a6d849SFrank Schaefer struct em28xx_buffer *buf; 2950c0d06caSMauro Carvalho Chehab char *outp; 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 */ 30324a6d849SFrank Schaefer buf = list_entry(dma_q->active.next, struct em28xx_buffer, vb.queue); 3040c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 30524a6d849SFrank Schaefer outp = videobuf_to_vmalloc(&buf->vb); 30624a6d849SFrank Schaefer memset(outp, 0, buf->vb.size); 3078732533bSFrank Schaefer buf->pos = 0; 3084078d625SFrank Schaefer buf->vb_buf = outp; 3090c0d06caSMauro Carvalho Chehab 31024a6d849SFrank Schaefer return buf; 3110c0d06caSMauro Carvalho Chehab } 3120c0d06caSMauro Carvalho Chehab 313e04c00d9SFrank Schaefer /* 314e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 315e04c00d9SFrank Schaefer */ 316e04c00d9SFrank Schaefer static struct em28xx_buffer * 317e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 318e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 319e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 320e04c00d9SFrank Schaefer { 321e04c00d9SFrank Schaefer if (dev->progressive || dev->top_field) { /* Brand new frame */ 322e04c00d9SFrank Schaefer if (buf != NULL) 323e04c00d9SFrank Schaefer finish_buffer(dev, buf); 324e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 325e04c00d9SFrank Schaefer } 326e04c00d9SFrank Schaefer if (buf != NULL) { 327e04c00d9SFrank Schaefer buf->top_field = dev->top_field; 328e04c00d9SFrank Schaefer buf->pos = 0; 329e04c00d9SFrank Schaefer } 330e04c00d9SFrank Schaefer 331e04c00d9SFrank Schaefer return buf; 332e04c00d9SFrank Schaefer } 333e04c00d9SFrank Schaefer 334227b7c90SFrank Schaefer /* 335227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 336227b7c90SFrank Schaefer */ 337227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 338227b7c90SFrank Schaefer unsigned char *data_pkt, 339227b7c90SFrank Schaefer unsigned int data_len) 340227b7c90SFrank Schaefer { 341227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 342227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 343227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 344227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 345227b7c90SFrank Schaefer 346227b7c90SFrank Schaefer /* capture type 0 = vbi start 347227b7c90SFrank Schaefer capture type 1 = vbi in progress 348227b7c90SFrank Schaefer capture type 2 = video start 349227b7c90SFrank Schaefer capture type 3 = video in progress */ 350227b7c90SFrank Schaefer if (data_len >= 4) { 351227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 352227b7c90SFrank Schaefer * never split across packets */ 353227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 354227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 355227b7c90SFrank Schaefer /* Continuation */ 356227b7c90SFrank Schaefer data_pkt += 4; 357227b7c90SFrank Schaefer data_len -= 4; 358227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 359227b7c90SFrank Schaefer /* Field start (VBI mode) */ 360227b7c90SFrank Schaefer dev->capture_type = 0; 361227b7c90SFrank Schaefer dev->vbi_read = 0; 362227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 363227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 364227b7c90SFrank Schaefer data_pkt += 4; 365227b7c90SFrank Schaefer data_len -= 4; 366227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 367227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 368227b7c90SFrank Schaefer dev->capture_type = 2; 369227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 370227b7c90SFrank Schaefer dev->top_field = !(data_pkt[2] & 1); 371227b7c90SFrank Schaefer data_pkt += 4; 372227b7c90SFrank Schaefer data_len -= 4; 373227b7c90SFrank Schaefer } 374227b7c90SFrank Schaefer } 375227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 376227b7c90SFrank Schaefer * have no continuation header */ 377227b7c90SFrank Schaefer 378227b7c90SFrank Schaefer if (dev->capture_type == 0) { 379227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 380227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 381227b7c90SFrank Schaefer dev->capture_type = 1; 382227b7c90SFrank Schaefer } 383227b7c90SFrank Schaefer 384227b7c90SFrank Schaefer if (dev->capture_type == 1) { 385227b7c90SFrank Schaefer int vbi_size = dev->vbi_width * dev->vbi_height; 386227b7c90SFrank Schaefer int vbi_data_len = ((dev->vbi_read + data_len) > vbi_size) ? 387227b7c90SFrank Schaefer (vbi_size - dev->vbi_read) : data_len; 388227b7c90SFrank Schaefer 389227b7c90SFrank Schaefer /* Copy VBI data */ 390227b7c90SFrank Schaefer if (vbi_buf != NULL) 391227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 392227b7c90SFrank Schaefer dev->vbi_read += vbi_data_len; 393227b7c90SFrank Schaefer 394227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 395227b7c90SFrank Schaefer /* Continue with copying video data */ 396227b7c90SFrank Schaefer dev->capture_type = 2; 397227b7c90SFrank Schaefer data_pkt += vbi_data_len; 398227b7c90SFrank Schaefer data_len -= vbi_data_len; 399227b7c90SFrank Schaefer } 400227b7c90SFrank Schaefer } 401227b7c90SFrank Schaefer 402227b7c90SFrank Schaefer if (dev->capture_type == 2) { 403227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 404227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 405227b7c90SFrank Schaefer dev->capture_type = 3; 406227b7c90SFrank Schaefer } 407227b7c90SFrank Schaefer 408227b7c90SFrank Schaefer if (dev->capture_type == 3 && buf != NULL && data_len > 0) 409227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 410227b7c90SFrank Schaefer } 411227b7c90SFrank Schaefer 412960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 4130fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 4140c0d06caSMauro Carvalho Chehab { 415227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 416227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 417227b7c90SFrank Schaefer unsigned int usb_data_len; 4180c0d06caSMauro Carvalho Chehab 4190c0d06caSMauro Carvalho Chehab if (!dev) 4200c0d06caSMauro Carvalho Chehab return 0; 4210c0d06caSMauro Carvalho Chehab 4220c0d06caSMauro Carvalho Chehab if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED)) 4230c0d06caSMauro Carvalho Chehab return 0; 4240c0d06caSMauro Carvalho Chehab 4251653cb0cSFrank Schaefer if (urb->status < 0) 4260c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 4270c0d06caSMauro Carvalho Chehab 4284601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 4294601cc39SFrank Schaefer 4304601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 4314601cc39SFrank Schaefer num_packets = 1; 4324601cc39SFrank Schaefer else /* isoc */ 4334601cc39SFrank Schaefer num_packets = urb->number_of_packets; 4340c0d06caSMauro Carvalho Chehab 4354601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 4364601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 437227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 4384601cc39SFrank Schaefer 439227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 4404601cc39SFrank Schaefer } else { /* isoc */ 4414601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 4424601cc39SFrank Schaefer print_err_status(dev, i, 4434601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 4440c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 4450c0d06caSMauro Carvalho Chehab continue; 4460c0d06caSMauro Carvalho Chehab } 4470c0d06caSMauro Carvalho Chehab 448227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 449227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 4500c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 4510c0d06caSMauro Carvalho Chehab continue; 4520c0d06caSMauro Carvalho Chehab } 4530c0d06caSMauro Carvalho Chehab 454227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 4554601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 4564601cc39SFrank Schaefer } 4574601cc39SFrank Schaefer 458227b7c90SFrank Schaefer if (usb_data_len == 0) { 4594601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 4604601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 4614601cc39SFrank Schaefer continue; 4624601cc39SFrank Schaefer } 4630c0d06caSMauro Carvalho Chehab 464227b7c90SFrank Schaefer process_frame_data_em28xx(dev, usb_data_pkt, usb_data_len); 4650c0d06caSMauro Carvalho Chehab } 466227b7c90SFrank Schaefer return 1; 4670c0d06caSMauro Carvalho Chehab } 4680c0d06caSMauro Carvalho Chehab 4690c0d06caSMauro Carvalho Chehab 4700c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4710c0d06caSMauro Carvalho Chehab Videobuf operations 4720c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4730c0d06caSMauro Carvalho Chehab 4740c0d06caSMauro Carvalho Chehab static int 4750c0d06caSMauro Carvalho Chehab buffer_setup(struct videobuf_queue *vq, unsigned int *count, unsigned int *size) 4760c0d06caSMauro Carvalho Chehab { 4770c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 4780c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 4790c0d06caSMauro Carvalho Chehab struct v4l2_frequency f; 4800c0d06caSMauro Carvalho Chehab 4810c0d06caSMauro Carvalho Chehab *size = (fh->dev->width * fh->dev->height * dev->format->depth + 7) 4820c0d06caSMauro Carvalho Chehab >> 3; 4830c0d06caSMauro Carvalho Chehab 4840c0d06caSMauro Carvalho Chehab if (0 == *count) 4850c0d06caSMauro Carvalho Chehab *count = EM28XX_DEF_BUF; 4860c0d06caSMauro Carvalho Chehab 4870c0d06caSMauro Carvalho Chehab if (*count < EM28XX_MIN_BUF) 4880c0d06caSMauro Carvalho Chehab *count = EM28XX_MIN_BUF; 4890c0d06caSMauro Carvalho Chehab 4900c0d06caSMauro Carvalho Chehab /* Ask tuner to go to analog or radio mode */ 4910c0d06caSMauro Carvalho Chehab memset(&f, 0, sizeof(f)); 4920c0d06caSMauro Carvalho Chehab f.frequency = dev->ctl_freq; 4930c0d06caSMauro Carvalho Chehab f.type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV; 4940c0d06caSMauro Carvalho Chehab 4950c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f); 4960c0d06caSMauro Carvalho Chehab 4970c0d06caSMauro Carvalho Chehab return 0; 4980c0d06caSMauro Carvalho Chehab } 4990c0d06caSMauro Carvalho Chehab 5000c0d06caSMauro Carvalho Chehab /* This is called *without* dev->slock held; please keep it that way */ 5010c0d06caSMauro Carvalho Chehab static void free_buffer(struct videobuf_queue *vq, struct em28xx_buffer *buf) 5020c0d06caSMauro Carvalho Chehab { 5030c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5040c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 5050c0d06caSMauro Carvalho Chehab unsigned long flags = 0; 5060c0d06caSMauro Carvalho Chehab if (in_interrupt()) 5070c0d06caSMauro Carvalho Chehab BUG(); 5080c0d06caSMauro Carvalho Chehab 5090c0d06caSMauro Carvalho Chehab /* We used to wait for the buffer to finish here, but this didn't work 5100c0d06caSMauro Carvalho Chehab because, as we were keeping the state as VIDEOBUF_QUEUED, 5110c0d06caSMauro Carvalho Chehab videobuf_queue_cancel marked it as finished for us. 5120c0d06caSMauro Carvalho Chehab (Also, it could wedge forever if the hardware was misconfigured.) 5130c0d06caSMauro Carvalho Chehab 5140c0d06caSMauro Carvalho Chehab This should be safe; by the time we get here, the buffer isn't 5150c0d06caSMauro Carvalho Chehab queued anymore. If we ever start marking the buffers as 5160c0d06caSMauro Carvalho Chehab VIDEOBUF_ACTIVE, it won't be, though. 5170c0d06caSMauro Carvalho Chehab */ 5180c0d06caSMauro Carvalho Chehab spin_lock_irqsave(&dev->slock, flags); 51974209dc0SFrank Schaefer if (dev->usb_ctl.vid_buf == buf) 52074209dc0SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 5210c0d06caSMauro Carvalho Chehab spin_unlock_irqrestore(&dev->slock, flags); 5220c0d06caSMauro Carvalho Chehab 5230c0d06caSMauro Carvalho Chehab videobuf_vmalloc_free(&buf->vb); 5240c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_NEEDS_INIT; 5250c0d06caSMauro Carvalho Chehab } 5260c0d06caSMauro Carvalho Chehab 5270c0d06caSMauro Carvalho Chehab static int 5280c0d06caSMauro Carvalho Chehab buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb, 5290c0d06caSMauro Carvalho Chehab enum v4l2_field field) 5300c0d06caSMauro Carvalho Chehab { 5310c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5320c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, struct em28xx_buffer, vb); 5330c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 5340c0d06caSMauro Carvalho Chehab int rc = 0, urb_init = 0; 5350c0d06caSMauro Carvalho Chehab 5360c0d06caSMauro Carvalho Chehab buf->vb.size = (fh->dev->width * fh->dev->height * dev->format->depth 5370c0d06caSMauro Carvalho Chehab + 7) >> 3; 5380c0d06caSMauro Carvalho Chehab 5390c0d06caSMauro Carvalho Chehab if (0 != buf->vb.baddr && buf->vb.bsize < buf->vb.size) 5400c0d06caSMauro Carvalho Chehab return -EINVAL; 5410c0d06caSMauro Carvalho Chehab 5420c0d06caSMauro Carvalho Chehab buf->vb.width = dev->width; 5430c0d06caSMauro Carvalho Chehab buf->vb.height = dev->height; 5440c0d06caSMauro Carvalho Chehab buf->vb.field = field; 5450c0d06caSMauro Carvalho Chehab 5460c0d06caSMauro Carvalho Chehab if (VIDEOBUF_NEEDS_INIT == buf->vb.state) { 5470c0d06caSMauro Carvalho Chehab rc = videobuf_iolock(vq, &buf->vb, NULL); 5480c0d06caSMauro Carvalho Chehab if (rc < 0) 5490c0d06caSMauro Carvalho Chehab goto fail; 5500c0d06caSMauro Carvalho Chehab } 5510c0d06caSMauro Carvalho Chehab 55274209dc0SFrank Schaefer if (!dev->usb_ctl.analog_bufs.num_bufs) 5530c0d06caSMauro Carvalho Chehab urb_init = 1; 5540c0d06caSMauro Carvalho Chehab 5550c0d06caSMauro Carvalho Chehab if (urb_init) { 5560455eebfSFrank Schaefer dev->capture_type = -1; 557c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 558c647a91aSFrank Schaefer dev->analog_xfer_bulk, 5590c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 5600c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 561c647a91aSFrank Schaefer dev->packet_multiplier, 5620fa4a402SFrank Schaefer em28xx_urb_data_copy); 5630c0d06caSMauro Carvalho Chehab if (rc < 0) 5640c0d06caSMauro Carvalho Chehab goto fail; 5650c0d06caSMauro Carvalho Chehab } 5660c0d06caSMauro Carvalho Chehab 5670c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_PREPARED; 5680c0d06caSMauro Carvalho Chehab return 0; 5690c0d06caSMauro Carvalho Chehab 5700c0d06caSMauro Carvalho Chehab fail: 5710c0d06caSMauro Carvalho Chehab free_buffer(vq, buf); 5720c0d06caSMauro Carvalho Chehab return rc; 5730c0d06caSMauro Carvalho Chehab } 5740c0d06caSMauro Carvalho Chehab 5750c0d06caSMauro Carvalho Chehab static void 5760c0d06caSMauro Carvalho Chehab buffer_queue(struct videobuf_queue *vq, struct videobuf_buffer *vb) 5770c0d06caSMauro Carvalho Chehab { 5780c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, 5790c0d06caSMauro Carvalho Chehab struct em28xx_buffer, 5800c0d06caSMauro Carvalho Chehab vb); 5810c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5820c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 5830c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 5840c0d06caSMauro Carvalho Chehab 5850c0d06caSMauro Carvalho Chehab buf->vb.state = VIDEOBUF_QUEUED; 5860c0d06caSMauro Carvalho Chehab list_add_tail(&buf->vb.queue, &vidq->active); 5870c0d06caSMauro Carvalho Chehab 5880c0d06caSMauro Carvalho Chehab } 5890c0d06caSMauro Carvalho Chehab 5900c0d06caSMauro Carvalho Chehab static void buffer_release(struct videobuf_queue *vq, 5910c0d06caSMauro Carvalho Chehab struct videobuf_buffer *vb) 5920c0d06caSMauro Carvalho Chehab { 5930c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf = container_of(vb, 5940c0d06caSMauro Carvalho Chehab struct em28xx_buffer, 5950c0d06caSMauro Carvalho Chehab vb); 5960c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = vq->priv_data; 5970c0d06caSMauro Carvalho Chehab struct em28xx *dev = (struct em28xx *)fh->dev; 5980c0d06caSMauro Carvalho Chehab 5990c0d06caSMauro Carvalho Chehab em28xx_isocdbg("em28xx: called buffer_release\n"); 6000c0d06caSMauro Carvalho Chehab 6010c0d06caSMauro Carvalho Chehab free_buffer(vq, buf); 6020c0d06caSMauro Carvalho Chehab } 6030c0d06caSMauro Carvalho Chehab 6040c0d06caSMauro Carvalho Chehab static struct videobuf_queue_ops em28xx_video_qops = { 6050c0d06caSMauro Carvalho Chehab .buf_setup = buffer_setup, 6060c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 6070c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 6080c0d06caSMauro Carvalho Chehab .buf_release = buffer_release, 6090c0d06caSMauro Carvalho Chehab }; 6100c0d06caSMauro Carvalho Chehab 6110c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 6120c0d06caSMauro Carvalho Chehab 6130c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 6140c0d06caSMauro Carvalho Chehab { 6150c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 6160c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 6170c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 6180c0d06caSMauro Carvalho Chehab 6190c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 6200c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 6210c0d06caSMauro Carvalho Chehab 6220c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, s_routing, 6230c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 6240c0d06caSMauro Carvalho Chehab 6250c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 6260c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 6270c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, 6280c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 6290c0d06caSMauro Carvalho Chehab } 6300c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 6310c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 6320c0d06caSMauro Carvalho Chehab dev->ctl_ainput, MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 6330c0d06caSMauro Carvalho Chehab } 6340c0d06caSMauro Carvalho Chehab 6350c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 6360c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, audio, s_routing, 6370c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 6380c0d06caSMauro Carvalho Chehab } 6390c0d06caSMauro Carvalho Chehab 6400c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 6410c0d06caSMauro Carvalho Chehab } 6420c0d06caSMauro Carvalho Chehab 6430c0d06caSMauro Carvalho Chehab /* Usage lock check functions */ 6440c0d06caSMauro Carvalho Chehab static int res_get(struct em28xx_fh *fh, unsigned int bit) 6450c0d06caSMauro Carvalho Chehab { 6460c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 6470c0d06caSMauro Carvalho Chehab 6480c0d06caSMauro Carvalho Chehab if (fh->resources & bit) 6490c0d06caSMauro Carvalho Chehab /* have it already allocated */ 6500c0d06caSMauro Carvalho Chehab return 1; 6510c0d06caSMauro Carvalho Chehab 6520c0d06caSMauro Carvalho Chehab /* is it free? */ 6530c0d06caSMauro Carvalho Chehab if (dev->resources & bit) { 6540c0d06caSMauro Carvalho Chehab /* no, someone else uses it */ 6550c0d06caSMauro Carvalho Chehab return 0; 6560c0d06caSMauro Carvalho Chehab } 6570c0d06caSMauro Carvalho Chehab /* it's free, grab it */ 6580c0d06caSMauro Carvalho Chehab fh->resources |= bit; 6590c0d06caSMauro Carvalho Chehab dev->resources |= bit; 6600c0d06caSMauro Carvalho Chehab em28xx_videodbg("res: get %d\n", bit); 6610c0d06caSMauro Carvalho Chehab return 1; 6620c0d06caSMauro Carvalho Chehab } 6630c0d06caSMauro Carvalho Chehab 6640c0d06caSMauro Carvalho Chehab static int res_check(struct em28xx_fh *fh, unsigned int bit) 6650c0d06caSMauro Carvalho Chehab { 6660c0d06caSMauro Carvalho Chehab return fh->resources & bit; 6670c0d06caSMauro Carvalho Chehab } 6680c0d06caSMauro Carvalho Chehab 6690c0d06caSMauro Carvalho Chehab static int res_locked(struct em28xx *dev, unsigned int bit) 6700c0d06caSMauro Carvalho Chehab { 6710c0d06caSMauro Carvalho Chehab return dev->resources & bit; 6720c0d06caSMauro Carvalho Chehab } 6730c0d06caSMauro Carvalho Chehab 6740c0d06caSMauro Carvalho Chehab static void res_free(struct em28xx_fh *fh, unsigned int bits) 6750c0d06caSMauro Carvalho Chehab { 6760c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 6770c0d06caSMauro Carvalho Chehab 6780c0d06caSMauro Carvalho Chehab BUG_ON((fh->resources & bits) != bits); 6790c0d06caSMauro Carvalho Chehab 6800c0d06caSMauro Carvalho Chehab fh->resources &= ~bits; 6810c0d06caSMauro Carvalho Chehab dev->resources &= ~bits; 6820c0d06caSMauro Carvalho Chehab em28xx_videodbg("res: put %d\n", bits); 6830c0d06caSMauro Carvalho Chehab } 6840c0d06caSMauro Carvalho Chehab 6850c0d06caSMauro Carvalho Chehab static int get_ressource(struct em28xx_fh *fh) 6860c0d06caSMauro Carvalho Chehab { 6870c0d06caSMauro Carvalho Chehab switch (fh->type) { 6880c0d06caSMauro Carvalho Chehab case V4L2_BUF_TYPE_VIDEO_CAPTURE: 6890c0d06caSMauro Carvalho Chehab return EM28XX_RESOURCE_VIDEO; 6900c0d06caSMauro Carvalho Chehab case V4L2_BUF_TYPE_VBI_CAPTURE: 6910c0d06caSMauro Carvalho Chehab return EM28XX_RESOURCE_VBI; 6920c0d06caSMauro Carvalho Chehab default: 6930c0d06caSMauro Carvalho Chehab BUG(); 6940c0d06caSMauro Carvalho Chehab return 0; 6950c0d06caSMauro Carvalho Chehab } 6960c0d06caSMauro Carvalho Chehab } 6970c0d06caSMauro Carvalho Chehab 698081b945eSHans Verkuil void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 6990c0d06caSMauro Carvalho Chehab { 700081b945eSHans Verkuil struct em28xx *dev = priv; 7010c0d06caSMauro Carvalho Chehab 7020c0d06caSMauro Carvalho Chehab /* 703081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 704081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 705081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 706081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 7070c0d06caSMauro Carvalho Chehab */ 7080c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 7090c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 710081b945eSHans Verkuil dev->mute = ctrl->val; 711081b945eSHans Verkuil em28xx_audio_analog_set(dev); 7120c0d06caSMauro Carvalho Chehab break; 7130c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 714081b945eSHans Verkuil dev->volume = ctrl->val; 715081b945eSHans Verkuil em28xx_audio_analog_set(dev); 716081b945eSHans Verkuil break; 717081b945eSHans Verkuil } 718081b945eSHans Verkuil } 719081b945eSHans Verkuil 720081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 721081b945eSHans Verkuil { 722081b945eSHans Verkuil struct em28xx *dev = container_of(ctrl->handler, struct em28xx, ctrl_handler); 723081b945eSHans Verkuil 724081b945eSHans Verkuil switch (ctrl->id) { 725081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 726081b945eSHans Verkuil dev->mute = ctrl->val; 727081b945eSHans Verkuil break; 728081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 729081b945eSHans Verkuil dev->volume = ctrl->val; 7300c0d06caSMauro Carvalho Chehab break; 7310c0d06caSMauro Carvalho Chehab } 7320c0d06caSMauro Carvalho Chehab 7330c0d06caSMauro Carvalho Chehab return em28xx_audio_analog_set(dev); 7340c0d06caSMauro Carvalho Chehab } 7350c0d06caSMauro Carvalho Chehab 736081b945eSHans Verkuil const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 737081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 738081b945eSHans Verkuil }; 739081b945eSHans Verkuil 7400c0d06caSMauro Carvalho Chehab static int check_dev(struct em28xx *dev) 7410c0d06caSMauro Carvalho Chehab { 7420c0d06caSMauro Carvalho Chehab if (dev->state & DEV_DISCONNECTED) { 7430c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device not present\n"); 7440c0d06caSMauro Carvalho Chehab return -ENODEV; 7450c0d06caSMauro Carvalho Chehab } 7460c0d06caSMauro Carvalho Chehab 7470c0d06caSMauro Carvalho Chehab if (dev->state & DEV_MISCONFIGURED) { 7480c0d06caSMauro Carvalho Chehab em28xx_errdev("v4l2 ioctl: device is misconfigured; " 7490c0d06caSMauro Carvalho Chehab "close and open it again\n"); 7500c0d06caSMauro Carvalho Chehab return -EIO; 7510c0d06caSMauro Carvalho Chehab } 7520c0d06caSMauro Carvalho Chehab return 0; 7530c0d06caSMauro Carvalho Chehab } 7540c0d06caSMauro Carvalho Chehab 7550c0d06caSMauro Carvalho Chehab static void get_scale(struct em28xx *dev, 7560c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 7570c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 7580c0d06caSMauro Carvalho Chehab { 7590c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 7600c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 7610c0d06caSMauro Carvalho Chehab 7620c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 7630c0d06caSMauro Carvalho Chehab if (*hscale >= 0x4000) 7640c0d06caSMauro Carvalho Chehab *hscale = 0x3fff; 7650c0d06caSMauro Carvalho Chehab 7660c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 7670c0d06caSMauro Carvalho Chehab if (*vscale >= 0x4000) 7680c0d06caSMauro Carvalho Chehab *vscale = 0x3fff; 7690c0d06caSMauro Carvalho Chehab } 7700c0d06caSMauro Carvalho Chehab 7710c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 7720c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 7730c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 7740c0d06caSMauro Carvalho Chehab 7750c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 7760c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 7770c0d06caSMauro Carvalho Chehab { 7780c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 7790c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 7800c0d06caSMauro Carvalho Chehab 7810c0d06caSMauro Carvalho Chehab f->fmt.pix.width = dev->width; 7820c0d06caSMauro Carvalho Chehab f->fmt.pix.height = dev->height; 7830c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = dev->format->fourcc; 7840c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * dev->format->depth + 7) >> 3; 7850c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * dev->height; 7860c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 7870c0d06caSMauro Carvalho Chehab 7880c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 7890c0d06caSMauro Carvalho Chehab if (dev->progressive) 7900c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 7910c0d06caSMauro Carvalho Chehab else 7920c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 7930c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 7940c0d06caSMauro Carvalho Chehab return 0; 7950c0d06caSMauro Carvalho Chehab } 7960c0d06caSMauro Carvalho Chehab 7970c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 7980c0d06caSMauro Carvalho Chehab { 7990c0d06caSMauro Carvalho Chehab unsigned int i; 8000c0d06caSMauro Carvalho Chehab 8010c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 8020c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 8030c0d06caSMauro Carvalho Chehab return &format[i]; 8040c0d06caSMauro Carvalho Chehab 8050c0d06caSMauro Carvalho Chehab return NULL; 8060c0d06caSMauro Carvalho Chehab } 8070c0d06caSMauro Carvalho Chehab 8080c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 8090c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 8100c0d06caSMauro Carvalho Chehab { 8110c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 8120c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8130c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 8140c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 8150c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 8160c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 8170c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 8180c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 8190c0d06caSMauro Carvalho Chehab 8200c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 8210c0d06caSMauro Carvalho Chehab if (!fmt) { 8220c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 8230c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 8240c0d06caSMauro Carvalho Chehab return -EINVAL; 8250c0d06caSMauro Carvalho Chehab } 8260c0d06caSMauro Carvalho Chehab 8270c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 8280c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 8290c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 8300c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 8310c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 8320c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 8330c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 8340c0d06caSMauro Carvalho Chehab width /= 2; 8350c0d06caSMauro Carvalho Chehab } else { 8360c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 8370c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 8380c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 8390c0d06caSMauro Carvalho Chehab 1, 0); 8400c0d06caSMauro Carvalho Chehab } 8410c0d06caSMauro Carvalho Chehab 8420c0d06caSMauro Carvalho Chehab get_scale(dev, width, height, &hscale, &vscale); 8430c0d06caSMauro Carvalho Chehab 8440c0d06caSMauro Carvalho Chehab width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 8450c0d06caSMauro Carvalho Chehab height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 8460c0d06caSMauro Carvalho Chehab 8470c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 8480c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 8490c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 8500c0d06caSMauro Carvalho Chehab f->fmt.pix.bytesperline = (dev->width * fmt->depth + 7) >> 3; 8510c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 8520c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 8530c0d06caSMauro Carvalho Chehab if (dev->progressive) 8540c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 8550c0d06caSMauro Carvalho Chehab else 8560c0d06caSMauro Carvalho Chehab f->fmt.pix.field = dev->interlaced ? 8570c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 8580c0d06caSMauro Carvalho Chehab 8590c0d06caSMauro Carvalho Chehab return 0; 8600c0d06caSMauro Carvalho Chehab } 8610c0d06caSMauro Carvalho Chehab 8620c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 8630c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 8640c0d06caSMauro Carvalho Chehab { 8650c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 8660c0d06caSMauro Carvalho Chehab 8670c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 8680c0d06caSMauro Carvalho Chehab if (!fmt) 8690c0d06caSMauro Carvalho Chehab return -EINVAL; 8700c0d06caSMauro Carvalho Chehab 8710c0d06caSMauro Carvalho Chehab dev->format = fmt; 8720c0d06caSMauro Carvalho Chehab dev->width = width; 8730c0d06caSMauro Carvalho Chehab dev->height = height; 8740c0d06caSMauro Carvalho Chehab 8750c0d06caSMauro Carvalho Chehab /* set new image size */ 8760c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 8770c0d06caSMauro Carvalho Chehab 8780c0d06caSMauro Carvalho Chehab em28xx_set_alternate(dev); 8790c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 8800c0d06caSMauro Carvalho Chehab 8810c0d06caSMauro Carvalho Chehab return 0; 8820c0d06caSMauro Carvalho Chehab } 8830c0d06caSMauro Carvalho Chehab 8840c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 8850c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 8860c0d06caSMauro Carvalho Chehab { 8870c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 8880c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 8890c0d06caSMauro Carvalho Chehab int rc; 8900c0d06caSMauro Carvalho Chehab 8910c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 8920c0d06caSMauro Carvalho Chehab if (rc < 0) 8930c0d06caSMauro Carvalho Chehab return rc; 8940c0d06caSMauro Carvalho Chehab 8950c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 8960c0d06caSMauro Carvalho Chehab 8970c0d06caSMauro Carvalho Chehab if (videobuf_queue_is_busy(&fh->vb_vidq)) { 8980c0d06caSMauro Carvalho Chehab em28xx_errdev("%s queue busy\n", __func__); 8990c0d06caSMauro Carvalho Chehab return -EBUSY; 9000c0d06caSMauro Carvalho Chehab } 9010c0d06caSMauro Carvalho Chehab 9020c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 9030c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 9040c0d06caSMauro Carvalho Chehab } 9050c0d06caSMauro Carvalho Chehab 9060c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 9070c0d06caSMauro Carvalho Chehab { 9080c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9090c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9100c0d06caSMauro Carvalho Chehab int rc; 9110c0d06caSMauro Carvalho Chehab 9120c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9130c0d06caSMauro Carvalho Chehab if (rc < 0) 9140c0d06caSMauro Carvalho Chehab return rc; 9150c0d06caSMauro Carvalho Chehab 9160c0d06caSMauro Carvalho Chehab *norm = dev->norm; 9170c0d06caSMauro Carvalho Chehab 9180c0d06caSMauro Carvalho Chehab return 0; 9190c0d06caSMauro Carvalho Chehab } 9200c0d06caSMauro Carvalho Chehab 9210c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 9220c0d06caSMauro Carvalho Chehab { 9230c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9240c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9250c0d06caSMauro Carvalho Chehab int rc; 9260c0d06caSMauro Carvalho Chehab 9270c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9280c0d06caSMauro Carvalho Chehab if (rc < 0) 9290c0d06caSMauro Carvalho Chehab return rc; 9300c0d06caSMauro Carvalho Chehab 9310c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, video, querystd, norm); 9320c0d06caSMauro Carvalho Chehab 9330c0d06caSMauro Carvalho Chehab return 0; 9340c0d06caSMauro Carvalho Chehab } 9350c0d06caSMauro Carvalho Chehab 9360c0d06caSMauro Carvalho Chehab static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id *norm) 9370c0d06caSMauro Carvalho Chehab { 9380c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9390c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9400c0d06caSMauro Carvalho Chehab struct v4l2_format f; 9410c0d06caSMauro Carvalho Chehab int rc; 9420c0d06caSMauro Carvalho Chehab 9430c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 9440c0d06caSMauro Carvalho Chehab if (rc < 0) 9450c0d06caSMauro Carvalho Chehab return rc; 9460c0d06caSMauro Carvalho Chehab 9470c0d06caSMauro Carvalho Chehab dev->norm = *norm; 9480c0d06caSMauro Carvalho Chehab 9490c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 9500c0d06caSMauro Carvalho Chehab f.fmt.pix.width = dev->width; 9510c0d06caSMauro Carvalho Chehab f.fmt.pix.height = dev->height; 9520c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 9530c0d06caSMauro Carvalho Chehab 9540c0d06caSMauro Carvalho Chehab /* set new image size */ 9550c0d06caSMauro Carvalho Chehab dev->width = f.fmt.pix.width; 9560c0d06caSMauro Carvalho Chehab dev->height = f.fmt.pix.height; 9570c0d06caSMauro Carvalho Chehab get_scale(dev, dev->width, dev->height, &dev->hscale, &dev->vscale); 9580c0d06caSMauro Carvalho Chehab 9590c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 9600c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 9610c0d06caSMauro Carvalho Chehab 9620c0d06caSMauro Carvalho Chehab return 0; 9630c0d06caSMauro Carvalho Chehab } 9640c0d06caSMauro Carvalho Chehab 9650c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 9660c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 9670c0d06caSMauro Carvalho Chehab { 9680c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9690c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9700c0d06caSMauro Carvalho Chehab int rc = 0; 9710c0d06caSMauro Carvalho Chehab 9720c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 9730c0d06caSMauro Carvalho Chehab return -EINVAL; 9740c0d06caSMauro Carvalho Chehab 97586ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 9760c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 9770c0d06caSMauro Carvalho Chehab rc = v4l2_device_call_until_err(&dev->v4l2_dev, 0, 9780c0d06caSMauro Carvalho Chehab video, g_parm, p); 9790c0d06caSMauro Carvalho Chehab else 9800c0d06caSMauro Carvalho Chehab v4l2_video_std_frame_period(dev->norm, 9810c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 9820c0d06caSMauro Carvalho Chehab 9830c0d06caSMauro Carvalho Chehab return rc; 9840c0d06caSMauro Carvalho Chehab } 9850c0d06caSMauro Carvalho Chehab 9860c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 9870c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 9880c0d06caSMauro Carvalho Chehab { 9890c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 9900c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 9910c0d06caSMauro Carvalho Chehab 9920c0d06caSMauro Carvalho Chehab if (!dev->board.is_webcam) 99386ff7f1dSHans Verkuil return -ENOTTY; 9940c0d06caSMauro Carvalho Chehab 9950c0d06caSMauro Carvalho Chehab if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 9960c0d06caSMauro Carvalho Chehab return -EINVAL; 9970c0d06caSMauro Carvalho Chehab 99886ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 9990c0d06caSMauro Carvalho Chehab return v4l2_device_call_until_err(&dev->v4l2_dev, 0, video, s_parm, p); 10000c0d06caSMauro Carvalho Chehab } 10010c0d06caSMauro Carvalho Chehab 10020c0d06caSMauro Carvalho Chehab static const char *iname[] = { 10030c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE1] = "Composite1", 10040c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE2] = "Composite2", 10050c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE3] = "Composite3", 10060c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE4] = "Composite4", 10070c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 10080c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 10090c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_CABLE] = "Cable TV", 10100c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DVB] = "DVB", 10110c0d06caSMauro Carvalho Chehab [EM28XX_VMUX_DEBUG] = "for debug only", 10120c0d06caSMauro Carvalho Chehab }; 10130c0d06caSMauro Carvalho Chehab 10140c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 10150c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 10160c0d06caSMauro Carvalho Chehab { 10170c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10180c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10190c0d06caSMauro Carvalho Chehab unsigned int n; 10200c0d06caSMauro Carvalho Chehab 10210c0d06caSMauro Carvalho Chehab n = i->index; 10220c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 10230c0d06caSMauro Carvalho Chehab return -EINVAL; 10240c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 10250c0d06caSMauro Carvalho Chehab return -EINVAL; 10260c0d06caSMauro Carvalho Chehab 10270c0d06caSMauro Carvalho Chehab i->index = n; 10280c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 10290c0d06caSMauro Carvalho Chehab 10300c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 10310c0d06caSMauro Carvalho Chehab 10320c0d06caSMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type) || 10330c0d06caSMauro Carvalho Chehab (EM28XX_VMUX_CABLE == INPUT(n)->type)) 10340c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 10350c0d06caSMauro Carvalho Chehab 10360c0d06caSMauro Carvalho Chehab i->std = dev->vdev->tvnorms; 10370c0d06caSMauro Carvalho Chehab 10380c0d06caSMauro Carvalho Chehab return 0; 10390c0d06caSMauro Carvalho Chehab } 10400c0d06caSMauro Carvalho Chehab 10410c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 10420c0d06caSMauro Carvalho Chehab { 10430c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10440c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10450c0d06caSMauro Carvalho Chehab 10460c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 10470c0d06caSMauro Carvalho Chehab 10480c0d06caSMauro Carvalho Chehab return 0; 10490c0d06caSMauro Carvalho Chehab } 10500c0d06caSMauro Carvalho Chehab 10510c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 10520c0d06caSMauro Carvalho Chehab { 10530c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10540c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10550c0d06caSMauro Carvalho Chehab int rc; 10560c0d06caSMauro Carvalho Chehab 10570c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 10580c0d06caSMauro Carvalho Chehab if (rc < 0) 10590c0d06caSMauro Carvalho Chehab return rc; 10600c0d06caSMauro Carvalho Chehab 10610c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 10620c0d06caSMauro Carvalho Chehab return -EINVAL; 10630c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 10640c0d06caSMauro Carvalho Chehab return -EINVAL; 10650c0d06caSMauro Carvalho Chehab 10660c0d06caSMauro Carvalho Chehab video_mux(dev, i); 10670c0d06caSMauro Carvalho Chehab return 0; 10680c0d06caSMauro Carvalho Chehab } 10690c0d06caSMauro Carvalho Chehab 10700c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 10710c0d06caSMauro Carvalho Chehab { 10720c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 10730c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 10740c0d06caSMauro Carvalho Chehab 10750c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 10760c0d06caSMauro Carvalho Chehab return -EINVAL; 10770c0d06caSMauro Carvalho Chehab 10780c0d06caSMauro Carvalho Chehab switch (a->index) { 10790c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 10800c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 10810c0d06caSMauro Carvalho Chehab break; 10820c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 10830c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 10840c0d06caSMauro Carvalho Chehab break; 10850c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 10860c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 10870c0d06caSMauro Carvalho Chehab break; 10880c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 10890c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 10900c0d06caSMauro Carvalho Chehab break; 10910c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 10920c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 10930c0d06caSMauro Carvalho Chehab break; 10940c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 10950c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 10960c0d06caSMauro Carvalho Chehab break; 10970c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 10980c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 10990c0d06caSMauro Carvalho Chehab break; 11000c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 11010c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 11020c0d06caSMauro Carvalho Chehab break; 11030c0d06caSMauro Carvalho Chehab default: 11040c0d06caSMauro Carvalho Chehab return -EINVAL; 11050c0d06caSMauro Carvalho Chehab } 11060c0d06caSMauro Carvalho Chehab 11070c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 11080c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 11090c0d06caSMauro Carvalho Chehab 11100c0d06caSMauro Carvalho Chehab return 0; 11110c0d06caSMauro Carvalho Chehab } 11120c0d06caSMauro Carvalho Chehab 11130e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 11140c0d06caSMauro Carvalho Chehab { 11150c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11160c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11170c0d06caSMauro Carvalho Chehab 11180c0d06caSMauro Carvalho Chehab 11190c0d06caSMauro Carvalho Chehab if (!dev->audio_mode.has_audio) 11200c0d06caSMauro Carvalho Chehab return -EINVAL; 11210c0d06caSMauro Carvalho Chehab 11220c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 11230c0d06caSMauro Carvalho Chehab return -EINVAL; 11240c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 11250c0d06caSMauro Carvalho Chehab return -EINVAL; 11260c0d06caSMauro Carvalho Chehab 11270c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 11280c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 11290c0d06caSMauro Carvalho Chehab 11300c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 11310c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 11320c0d06caSMauro Carvalho Chehab 11330c0d06caSMauro Carvalho Chehab return 0; 11340c0d06caSMauro Carvalho Chehab } 11350c0d06caSMauro Carvalho Chehab 11360c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 11370c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 11380c0d06caSMauro Carvalho Chehab { 11390c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11400c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11410c0d06caSMauro Carvalho Chehab int rc; 11420c0d06caSMauro Carvalho Chehab 11430c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11440c0d06caSMauro Carvalho Chehab if (rc < 0) 11450c0d06caSMauro Carvalho Chehab return rc; 11460c0d06caSMauro Carvalho Chehab 11470c0d06caSMauro Carvalho Chehab if (0 != t->index) 11480c0d06caSMauro Carvalho Chehab return -EINVAL; 11490c0d06caSMauro Carvalho Chehab 11500c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 11510c0d06caSMauro Carvalho Chehab 11520c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 11530c0d06caSMauro Carvalho Chehab return 0; 11540c0d06caSMauro Carvalho Chehab } 11550c0d06caSMauro Carvalho Chehab 11560c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 11570c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 11580c0d06caSMauro Carvalho Chehab { 11590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11610c0d06caSMauro Carvalho Chehab int rc; 11620c0d06caSMauro Carvalho Chehab 11630c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11640c0d06caSMauro Carvalho Chehab if (rc < 0) 11650c0d06caSMauro Carvalho Chehab return rc; 11660c0d06caSMauro Carvalho Chehab 11670c0d06caSMauro Carvalho Chehab if (0 != t->index) 11680c0d06caSMauro Carvalho Chehab return -EINVAL; 11690c0d06caSMauro Carvalho Chehab 11700c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 11710c0d06caSMauro Carvalho Chehab return 0; 11720c0d06caSMauro Carvalho Chehab } 11730c0d06caSMauro Carvalho Chehab 11740c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 11750c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 11760c0d06caSMauro Carvalho Chehab { 11770c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11780c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11790c0d06caSMauro Carvalho Chehab 118020deebfeSHans Verkuil if (0 != f->tuner) 118120deebfeSHans Verkuil return -EINVAL; 118220deebfeSHans Verkuil 11830c0d06caSMauro Carvalho Chehab f->frequency = dev->ctl_freq; 11840c0d06caSMauro Carvalho Chehab return 0; 11850c0d06caSMauro Carvalho Chehab } 11860c0d06caSMauro Carvalho Chehab 11870c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 11880c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 11890c0d06caSMauro Carvalho Chehab { 11900c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 11910c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 11920c0d06caSMauro Carvalho Chehab int rc; 11930c0d06caSMauro Carvalho Chehab 11940c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 11950c0d06caSMauro Carvalho Chehab if (rc < 0) 11960c0d06caSMauro Carvalho Chehab return rc; 11970c0d06caSMauro Carvalho Chehab 11980c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 11990c0d06caSMauro Carvalho Chehab return -EINVAL; 12000c0d06caSMauro Carvalho Chehab 12010c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, f); 120220deebfeSHans Verkuil v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_frequency, f); 120320deebfeSHans Verkuil dev->ctl_freq = f->frequency; 12040c0d06caSMauro Carvalho Chehab 12050c0d06caSMauro Carvalho Chehab return 0; 12060c0d06caSMauro Carvalho Chehab } 12070c0d06caSMauro Carvalho Chehab 12080c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 12090c0d06caSMauro Carvalho Chehab static int em28xx_reg_len(int reg) 12100c0d06caSMauro Carvalho Chehab { 12110c0d06caSMauro Carvalho Chehab switch (reg) { 12120c0d06caSMauro Carvalho Chehab case EM28XX_R40_AC97LSB: 12130c0d06caSMauro Carvalho Chehab case EM28XX_R30_HSCALELOW: 12140c0d06caSMauro Carvalho Chehab case EM28XX_R32_VSCALELOW: 12150c0d06caSMauro Carvalho Chehab return 2; 12160c0d06caSMauro Carvalho Chehab default: 12170c0d06caSMauro Carvalho Chehab return 1; 12180c0d06caSMauro Carvalho Chehab } 12190c0d06caSMauro Carvalho Chehab } 12200c0d06caSMauro Carvalho Chehab 12210c0d06caSMauro Carvalho Chehab static int vidioc_g_chip_ident(struct file *file, void *priv, 12220c0d06caSMauro Carvalho Chehab struct v4l2_dbg_chip_ident *chip) 12230c0d06caSMauro Carvalho Chehab { 12240c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12250c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12260c0d06caSMauro Carvalho Chehab 12270c0d06caSMauro Carvalho Chehab chip->ident = V4L2_IDENT_NONE; 12280c0d06caSMauro Carvalho Chehab chip->revision = 0; 1229319a55fbSHans Verkuil if (chip->match.type == V4L2_CHIP_MATCH_HOST) { 1230319a55fbSHans Verkuil if (v4l2_chip_match_host(&chip->match)) 1231319a55fbSHans Verkuil chip->ident = V4L2_IDENT_NONE; 1232319a55fbSHans Verkuil return 0; 1233319a55fbSHans Verkuil } 1234319a55fbSHans Verkuil if (chip->match.type != V4L2_CHIP_MATCH_I2C_DRIVER && 1235319a55fbSHans Verkuil chip->match.type != V4L2_CHIP_MATCH_I2C_ADDR) 1236319a55fbSHans Verkuil return -EINVAL; 12370c0d06caSMauro Carvalho Chehab 12380c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_chip_ident, chip); 12390c0d06caSMauro Carvalho Chehab 12400c0d06caSMauro Carvalho Chehab return 0; 12410c0d06caSMauro Carvalho Chehab } 12420c0d06caSMauro Carvalho Chehab 12430c0d06caSMauro Carvalho Chehab 12440c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 12450c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 12460c0d06caSMauro Carvalho Chehab { 12470c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12480c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12490c0d06caSMauro Carvalho Chehab int ret; 12500c0d06caSMauro Carvalho Chehab 12510c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 12520c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 12530c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 12540c0d06caSMauro Carvalho Chehab if (ret < 0) 12550c0d06caSMauro Carvalho Chehab return ret; 12560c0d06caSMauro Carvalho Chehab 12570c0d06caSMauro Carvalho Chehab reg->val = ret; 12580c0d06caSMauro Carvalho Chehab reg->size = 1; 12590c0d06caSMauro Carvalho Chehab return 0; 12600c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 12610c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 12620c0d06caSMauro Carvalho Chehab return 0; 12630c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 12640c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 12650c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, g_register, reg); 12660c0d06caSMauro Carvalho Chehab return 0; 12670c0d06caSMauro Carvalho Chehab default: 12680c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 12690c0d06caSMauro Carvalho Chehab return -EINVAL; 12700c0d06caSMauro Carvalho Chehab } 12710c0d06caSMauro Carvalho Chehab 12720c0d06caSMauro Carvalho Chehab /* Match host */ 12730c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 12740c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 12750c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 12760c0d06caSMauro Carvalho Chehab 12770c0d06caSMauro Carvalho Chehab if (ret < 0) 12780c0d06caSMauro Carvalho Chehab return ret; 12790c0d06caSMauro Carvalho Chehab 12800c0d06caSMauro Carvalho Chehab reg->val = ret; 12810c0d06caSMauro Carvalho Chehab } else { 12820c0d06caSMauro Carvalho Chehab __le16 val = 0; 12830c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 12840c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 12850c0d06caSMauro Carvalho Chehab if (ret < 0) 12860c0d06caSMauro Carvalho Chehab return ret; 12870c0d06caSMauro Carvalho Chehab 12880c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 12890c0d06caSMauro Carvalho Chehab } 12900c0d06caSMauro Carvalho Chehab 12910c0d06caSMauro Carvalho Chehab return 0; 12920c0d06caSMauro Carvalho Chehab } 12930c0d06caSMauro Carvalho Chehab 12940c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 12950c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 12960c0d06caSMauro Carvalho Chehab { 12970c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 12980c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 12990c0d06caSMauro Carvalho Chehab __le16 buf; 13000c0d06caSMauro Carvalho Chehab 13010c0d06caSMauro Carvalho Chehab switch (reg->match.type) { 13020c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_AC97: 13030c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 13040c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_DRIVER: 13050c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 13060c0d06caSMauro Carvalho Chehab return 0; 13070c0d06caSMauro Carvalho Chehab case V4L2_CHIP_MATCH_I2C_ADDR: 13080c0d06caSMauro Carvalho Chehab /* TODO: is this correct? */ 13090c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_register, reg); 13100c0d06caSMauro Carvalho Chehab return 0; 13110c0d06caSMauro Carvalho Chehab default: 13120c0d06caSMauro Carvalho Chehab if (!v4l2_chip_match_host(®->match)) 13130c0d06caSMauro Carvalho Chehab return -EINVAL; 13140c0d06caSMauro Carvalho Chehab } 13150c0d06caSMauro Carvalho Chehab 13160c0d06caSMauro Carvalho Chehab /* Match host */ 13170c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 13180c0d06caSMauro Carvalho Chehab 13190c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 13200c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 13210c0d06caSMauro Carvalho Chehab } 13220c0d06caSMauro Carvalho Chehab #endif 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab 13250c0d06caSMauro Carvalho Chehab static int vidioc_cropcap(struct file *file, void *priv, 13260c0d06caSMauro Carvalho Chehab struct v4l2_cropcap *cc) 13270c0d06caSMauro Carvalho Chehab { 13280c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13290c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13300c0d06caSMauro Carvalho Chehab 13310c0d06caSMauro Carvalho Chehab if (cc->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) 13320c0d06caSMauro Carvalho Chehab return -EINVAL; 13330c0d06caSMauro Carvalho Chehab 13340c0d06caSMauro Carvalho Chehab cc->bounds.left = 0; 13350c0d06caSMauro Carvalho Chehab cc->bounds.top = 0; 13360c0d06caSMauro Carvalho Chehab cc->bounds.width = dev->width; 13370c0d06caSMauro Carvalho Chehab cc->bounds.height = dev->height; 13380c0d06caSMauro Carvalho Chehab cc->defrect = cc->bounds; 13390c0d06caSMauro Carvalho Chehab cc->pixelaspect.numerator = 54; /* 4:3 FIXME: remove magic numbers */ 13400c0d06caSMauro Carvalho Chehab cc->pixelaspect.denominator = 59; 13410c0d06caSMauro Carvalho Chehab 13420c0d06caSMauro Carvalho Chehab return 0; 13430c0d06caSMauro Carvalho Chehab } 13440c0d06caSMauro Carvalho Chehab 13450c0d06caSMauro Carvalho Chehab static int vidioc_streamon(struct file *file, void *priv, 13460c0d06caSMauro Carvalho Chehab enum v4l2_buf_type type) 13470c0d06caSMauro Carvalho Chehab { 13480c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13490c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13500c0d06caSMauro Carvalho Chehab int rc = -EINVAL; 13510c0d06caSMauro Carvalho Chehab 13520c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13530c0d06caSMauro Carvalho Chehab if (rc < 0) 13540c0d06caSMauro Carvalho Chehab return rc; 13550c0d06caSMauro Carvalho Chehab 13560c0d06caSMauro Carvalho Chehab if (unlikely(type != fh->type)) 13570c0d06caSMauro Carvalho Chehab return -EINVAL; 13580c0d06caSMauro Carvalho Chehab 13590c0d06caSMauro Carvalho Chehab em28xx_videodbg("vidioc_streamon fh=%p t=%d fh->res=%d dev->res=%d\n", 13600c0d06caSMauro Carvalho Chehab fh, type, fh->resources, dev->resources); 13610c0d06caSMauro Carvalho Chehab 13620c0d06caSMauro Carvalho Chehab if (unlikely(!res_get(fh, get_ressource(fh)))) 13630c0d06caSMauro Carvalho Chehab return -EBUSY; 13640c0d06caSMauro Carvalho Chehab 13650c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 13660c0d06caSMauro Carvalho Chehab rc = videobuf_streamon(&fh->vb_vidq); 13670c0d06caSMauro Carvalho Chehab else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) 13680c0d06caSMauro Carvalho Chehab rc = videobuf_streamon(&fh->vb_vbiq); 13690c0d06caSMauro Carvalho Chehab 13700c0d06caSMauro Carvalho Chehab return rc; 13710c0d06caSMauro Carvalho Chehab } 13720c0d06caSMauro Carvalho Chehab 13730c0d06caSMauro Carvalho Chehab static int vidioc_streamoff(struct file *file, void *priv, 13740c0d06caSMauro Carvalho Chehab enum v4l2_buf_type type) 13750c0d06caSMauro Carvalho Chehab { 13760c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 13770c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 13780c0d06caSMauro Carvalho Chehab int rc; 13790c0d06caSMauro Carvalho Chehab 13800c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 13810c0d06caSMauro Carvalho Chehab if (rc < 0) 13820c0d06caSMauro Carvalho Chehab return rc; 13830c0d06caSMauro Carvalho Chehab 13840c0d06caSMauro Carvalho Chehab if (fh->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 13850c0d06caSMauro Carvalho Chehab fh->type != V4L2_BUF_TYPE_VBI_CAPTURE) 13860c0d06caSMauro Carvalho Chehab return -EINVAL; 13870c0d06caSMauro Carvalho Chehab if (type != fh->type) 13880c0d06caSMauro Carvalho Chehab return -EINVAL; 13890c0d06caSMauro Carvalho Chehab 13900c0d06caSMauro Carvalho Chehab em28xx_videodbg("vidioc_streamoff fh=%p t=%d fh->res=%d dev->res=%d\n", 13910c0d06caSMauro Carvalho Chehab fh, type, fh->resources, dev->resources); 13920c0d06caSMauro Carvalho Chehab 13930c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 13940c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VIDEO)) { 13950c0d06caSMauro Carvalho Chehab videobuf_streamoff(&fh->vb_vidq); 13960c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VIDEO); 13970c0d06caSMauro Carvalho Chehab } 13980c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 13990c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VBI)) { 14000c0d06caSMauro Carvalho Chehab videobuf_streamoff(&fh->vb_vbiq); 14010c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VBI); 14020c0d06caSMauro Carvalho Chehab } 14030c0d06caSMauro Carvalho Chehab } 14040c0d06caSMauro Carvalho Chehab 14050c0d06caSMauro Carvalho Chehab return 0; 14060c0d06caSMauro Carvalho Chehab } 14070c0d06caSMauro Carvalho Chehab 14080c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 14090c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 14100c0d06caSMauro Carvalho Chehab { 1411a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 14120c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14130c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14140c0d06caSMauro Carvalho Chehab 14150c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 14160c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 14170c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 14180c0d06caSMauro Carvalho Chehab 1419a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1420a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1421a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1422a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1423a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1424a9d79fe5SHans Verkuil else 1425a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1426a9d79fe5SHans Verkuil V4L2_CAP_VBI_CAPTURE | V4L2_CAP_SLICED_VBI_CAPTURE; 14270c0d06caSMauro Carvalho Chehab 14280c0d06caSMauro Carvalho Chehab if (dev->audio_mode.has_audio) 1429a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 14300c0d06caSMauro Carvalho Chehab 14310c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1432a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 14330c0d06caSMauro Carvalho Chehab 1434a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1435a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1436a9d79fe5SHans Verkuil if (dev->vbi_dev) 1437a9d79fe5SHans Verkuil cap->capabilities |= 1438a9d79fe5SHans Verkuil V4L2_CAP_VBI_CAPTURE | V4L2_CAP_SLICED_VBI_CAPTURE; 1439a9d79fe5SHans Verkuil if (dev->radio_dev) 1440a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 14410c0d06caSMauro Carvalho Chehab return 0; 14420c0d06caSMauro Carvalho Chehab } 14430c0d06caSMauro Carvalho Chehab 14440c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 14450c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 14460c0d06caSMauro Carvalho Chehab { 14470c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 14480c0d06caSMauro Carvalho Chehab return -EINVAL; 14490c0d06caSMauro Carvalho Chehab 14500c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 14510c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 14520c0d06caSMauro Carvalho Chehab 14530c0d06caSMauro Carvalho Chehab return 0; 14540c0d06caSMauro Carvalho Chehab } 14550c0d06caSMauro Carvalho Chehab 14560c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 14570c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 14580c0d06caSMauro Carvalho Chehab { 14590c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 14600c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 14610c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14620c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14630c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14640c0d06caSMauro Carvalho Chehab 14650c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 14660c0d06caSMauro Carvalho Chehab if (!fmt) { 14670c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14680c0d06caSMauro Carvalho Chehab fsize->pixel_format); 14690c0d06caSMauro Carvalho Chehab return -EINVAL; 14700c0d06caSMauro Carvalho Chehab } 14710c0d06caSMauro Carvalho Chehab 14720c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14730c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 14740c0d06caSMauro Carvalho Chehab return -EINVAL; 14750c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 14760c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 14770c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 14780c0d06caSMauro Carvalho Chehab return 0; 14790c0d06caSMauro Carvalho Chehab } 14800c0d06caSMauro Carvalho Chehab 14810c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 14820c0d06caSMauro Carvalho Chehab return -EINVAL; 14830c0d06caSMauro Carvalho Chehab 14840c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 14850c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 14860c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 14870c0d06caSMauro Carvalho Chehab fsize->stepwise.min_height = 32; 14880c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 14890c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 14900c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 14910c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 14920c0d06caSMauro Carvalho Chehab return 0; 14930c0d06caSMauro Carvalho Chehab } 14940c0d06caSMauro Carvalho Chehab 14950c0d06caSMauro Carvalho Chehab /* Sliced VBI ioctls */ 14960c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_sliced_vbi_cap(struct file *file, void *priv, 14970c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14980c0d06caSMauro Carvalho Chehab { 14990c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15000c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15010c0d06caSMauro Carvalho Chehab int rc; 15020c0d06caSMauro Carvalho Chehab 15030c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15040c0d06caSMauro Carvalho Chehab if (rc < 0) 15050c0d06caSMauro Carvalho Chehab return rc; 15060c0d06caSMauro Carvalho Chehab 15070c0d06caSMauro Carvalho Chehab f->fmt.sliced.service_set = 0; 15080c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, vbi, g_sliced_fmt, &f->fmt.sliced); 15090c0d06caSMauro Carvalho Chehab 15100c0d06caSMauro Carvalho Chehab if (f->fmt.sliced.service_set == 0) 15110c0d06caSMauro Carvalho Chehab rc = -EINVAL; 15120c0d06caSMauro Carvalho Chehab 15130c0d06caSMauro Carvalho Chehab return rc; 15140c0d06caSMauro Carvalho Chehab } 15150c0d06caSMauro Carvalho Chehab 15160c0d06caSMauro Carvalho Chehab static int vidioc_try_set_sliced_vbi_cap(struct file *file, void *priv, 15170c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15180c0d06caSMauro Carvalho Chehab { 15190c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15200c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15210c0d06caSMauro Carvalho Chehab int rc; 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 15240c0d06caSMauro Carvalho Chehab if (rc < 0) 15250c0d06caSMauro Carvalho Chehab return rc; 15260c0d06caSMauro Carvalho Chehab 15270c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, vbi, g_sliced_fmt, &f->fmt.sliced); 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab if (f->fmt.sliced.service_set == 0) 15300c0d06caSMauro Carvalho Chehab return -EINVAL; 15310c0d06caSMauro Carvalho Chehab 15320c0d06caSMauro Carvalho Chehab return 0; 15330c0d06caSMauro Carvalho Chehab } 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 15360c0d06caSMauro Carvalho Chehab 15370c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 15380c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 15390c0d06caSMauro Carvalho Chehab { 15400c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15410c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15420c0d06caSMauro Carvalho Chehab 15430c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 15440c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 15450c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 15460c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 15470c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 15480c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 15490c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 15500c0d06caSMauro Carvalho Chehab 15510c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 15520c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 15530c0d06caSMauro Carvalho Chehab /* NTSC */ 15540c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 15550c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 15560c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 15570c0d06caSMauro Carvalho Chehab /* PAL */ 15580c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 15590c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 15600c0d06caSMauro Carvalho Chehab } 15610c0d06caSMauro Carvalho Chehab 15620c0d06caSMauro Carvalho Chehab return 0; 15630c0d06caSMauro Carvalho Chehab } 15640c0d06caSMauro Carvalho Chehab 15650c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vbi_cap(struct file *file, void *priv, 15660c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 15670c0d06caSMauro Carvalho Chehab { 15680c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15690c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15700c0d06caSMauro Carvalho Chehab 15710c0d06caSMauro Carvalho Chehab format->fmt.vbi.samples_per_line = dev->vbi_width; 15720c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 15730c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 15740c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 15750c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 15760c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[0] = dev->vbi_height; 15770c0d06caSMauro Carvalho Chehab format->fmt.vbi.count[1] = dev->vbi_height; 15780c0d06caSMauro Carvalho Chehab 15790c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 15800c0d06caSMauro Carvalho Chehab if (dev->norm & V4L2_STD_525_60) { 15810c0d06caSMauro Carvalho Chehab /* NTSC */ 15820c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 15830c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 15840c0d06caSMauro Carvalho Chehab } else if (dev->norm & V4L2_STD_625_50) { 15850c0d06caSMauro Carvalho Chehab /* PAL */ 15860c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 15870c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 15880c0d06caSMauro Carvalho Chehab } 15890c0d06caSMauro Carvalho Chehab 15900c0d06caSMauro Carvalho Chehab return 0; 15910c0d06caSMauro Carvalho Chehab } 15920c0d06caSMauro Carvalho Chehab 15930c0d06caSMauro Carvalho Chehab static int vidioc_reqbufs(struct file *file, void *priv, 15940c0d06caSMauro Carvalho Chehab struct v4l2_requestbuffers *rb) 15950c0d06caSMauro Carvalho Chehab { 15960c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 15970c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 15980c0d06caSMauro Carvalho Chehab int rc; 15990c0d06caSMauro Carvalho Chehab 16000c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 16010c0d06caSMauro Carvalho Chehab if (rc < 0) 16020c0d06caSMauro Carvalho Chehab return rc; 16030c0d06caSMauro Carvalho Chehab 16040c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 16050c0d06caSMauro Carvalho Chehab return videobuf_reqbufs(&fh->vb_vidq, rb); 16060c0d06caSMauro Carvalho Chehab else 16070c0d06caSMauro Carvalho Chehab return videobuf_reqbufs(&fh->vb_vbiq, rb); 16080c0d06caSMauro Carvalho Chehab } 16090c0d06caSMauro Carvalho Chehab 16100c0d06caSMauro Carvalho Chehab static int vidioc_querybuf(struct file *file, void *priv, 16110c0d06caSMauro Carvalho Chehab struct v4l2_buffer *b) 16120c0d06caSMauro Carvalho Chehab { 16130c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16140c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16150c0d06caSMauro Carvalho Chehab int rc; 16160c0d06caSMauro Carvalho Chehab 16170c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 16180c0d06caSMauro Carvalho Chehab if (rc < 0) 16190c0d06caSMauro Carvalho Chehab return rc; 16200c0d06caSMauro Carvalho Chehab 16210c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 16220c0d06caSMauro Carvalho Chehab return videobuf_querybuf(&fh->vb_vidq, b); 16230c0d06caSMauro Carvalho Chehab else { 16240c0d06caSMauro Carvalho Chehab /* FIXME: I'm not sure yet whether this is a bug in zvbi or 16250c0d06caSMauro Carvalho Chehab the videobuf framework, but we probably shouldn't be 16260c0d06caSMauro Carvalho Chehab returning a buffer larger than that which was asked for. 16270c0d06caSMauro Carvalho Chehab At a minimum, it causes a crash in zvbi since it does 16280c0d06caSMauro Carvalho Chehab a memcpy based on the source buffer length */ 16290c0d06caSMauro Carvalho Chehab int result = videobuf_querybuf(&fh->vb_vbiq, b); 16300c0d06caSMauro Carvalho Chehab b->length = dev->vbi_width * dev->vbi_height * 2; 16310c0d06caSMauro Carvalho Chehab 16320c0d06caSMauro Carvalho Chehab return result; 16330c0d06caSMauro Carvalho Chehab } 16340c0d06caSMauro Carvalho Chehab } 16350c0d06caSMauro Carvalho Chehab 16360c0d06caSMauro Carvalho Chehab static int vidioc_qbuf(struct file *file, void *priv, struct v4l2_buffer *b) 16370c0d06caSMauro Carvalho Chehab { 16380c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16390c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16400c0d06caSMauro Carvalho Chehab int rc; 16410c0d06caSMauro Carvalho Chehab 16420c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 16430c0d06caSMauro Carvalho Chehab if (rc < 0) 16440c0d06caSMauro Carvalho Chehab return rc; 16450c0d06caSMauro Carvalho Chehab 16460c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 16470c0d06caSMauro Carvalho Chehab return videobuf_qbuf(&fh->vb_vidq, b); 16480c0d06caSMauro Carvalho Chehab else 16490c0d06caSMauro Carvalho Chehab return videobuf_qbuf(&fh->vb_vbiq, b); 16500c0d06caSMauro Carvalho Chehab } 16510c0d06caSMauro Carvalho Chehab 16520c0d06caSMauro Carvalho Chehab static int vidioc_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b) 16530c0d06caSMauro Carvalho Chehab { 16540c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = priv; 16550c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 16560c0d06caSMauro Carvalho Chehab int rc; 16570c0d06caSMauro Carvalho Chehab 16580c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 16590c0d06caSMauro Carvalho Chehab if (rc < 0) 16600c0d06caSMauro Carvalho Chehab return rc; 16610c0d06caSMauro Carvalho Chehab 16620c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 16630c0d06caSMauro Carvalho Chehab return videobuf_dqbuf(&fh->vb_vidq, b, file->f_flags & 16640c0d06caSMauro Carvalho Chehab O_NONBLOCK); 16650c0d06caSMauro Carvalho Chehab else 16660c0d06caSMauro Carvalho Chehab return videobuf_dqbuf(&fh->vb_vbiq, b, file->f_flags & 16670c0d06caSMauro Carvalho Chehab O_NONBLOCK); 16680c0d06caSMauro Carvalho Chehab } 16690c0d06caSMauro Carvalho Chehab 16700c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 16710c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 16720c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 16730c0d06caSMauro Carvalho Chehab 16740c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 16750c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 16760c0d06caSMauro Carvalho Chehab { 16770c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 16780c0d06caSMauro Carvalho Chehab 16790c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 16800c0d06caSMauro Carvalho Chehab return -EINVAL; 16810c0d06caSMauro Carvalho Chehab 16820c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 16830c0d06caSMauro Carvalho Chehab t->type = V4L2_TUNER_RADIO; 16840c0d06caSMauro Carvalho Chehab 16850c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, g_tuner, t); 16860c0d06caSMauro Carvalho Chehab 16870c0d06caSMauro Carvalho Chehab return 0; 16880c0d06caSMauro Carvalho Chehab } 16890c0d06caSMauro Carvalho Chehab 16900c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 16910c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 16920c0d06caSMauro Carvalho Chehab { 16930c0d06caSMauro Carvalho Chehab struct em28xx *dev = ((struct em28xx_fh *)priv)->dev; 16940c0d06caSMauro Carvalho Chehab 16950c0d06caSMauro Carvalho Chehab if (0 != t->index) 16960c0d06caSMauro Carvalho Chehab return -EINVAL; 16970c0d06caSMauro Carvalho Chehab 16980c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_tuner, t); 16990c0d06caSMauro Carvalho Chehab 17000c0d06caSMauro Carvalho Chehab return 0; 17010c0d06caSMauro Carvalho Chehab } 17020c0d06caSMauro Carvalho Chehab 17030c0d06caSMauro Carvalho Chehab /* 17040c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 17050c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 17060c0d06caSMauro Carvalho Chehab */ 17070c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 17080c0d06caSMauro Carvalho Chehab { 17090c0d06caSMauro Carvalho Chehab int errCode = 0, radio = 0; 17100c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 17110c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 17120c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 17130c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh; 17140c0d06caSMauro Carvalho Chehab enum v4l2_field field; 17150c0d06caSMauro Carvalho Chehab 17160c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 17170c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 17180c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 17190c0d06caSMauro Carvalho Chehab break; 17200c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 17210c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 17220c0d06caSMauro Carvalho Chehab break; 17230c0d06caSMauro Carvalho Chehab case VFL_TYPE_RADIO: 17240c0d06caSMauro Carvalho Chehab radio = 1; 17250c0d06caSMauro Carvalho Chehab break; 17260c0d06caSMauro Carvalho Chehab } 17270c0d06caSMauro Carvalho Chehab 17280c0d06caSMauro Carvalho Chehab em28xx_videodbg("open dev=%s type=%s users=%d\n", 17290c0d06caSMauro Carvalho Chehab video_device_node_name(vdev), v4l2_type_names[fh_type], 17300c0d06caSMauro Carvalho Chehab dev->users); 17310c0d06caSMauro Carvalho Chehab 17320c0d06caSMauro Carvalho Chehab 17330c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 17340c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 17350c0d06caSMauro Carvalho Chehab fh = kzalloc(sizeof(struct em28xx_fh), GFP_KERNEL); 17360c0d06caSMauro Carvalho Chehab if (!fh) { 17370c0d06caSMauro Carvalho Chehab em28xx_errdev("em28xx-video.c: Out of memory?!\n"); 17380c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 17390c0d06caSMauro Carvalho Chehab return -ENOMEM; 17400c0d06caSMauro Carvalho Chehab } 174169a61642SHans Verkuil v4l2_fh_init(&fh->fh, vdev); 17420c0d06caSMauro Carvalho Chehab fh->dev = dev; 17430c0d06caSMauro Carvalho Chehab fh->radio = radio; 17440c0d06caSMauro Carvalho Chehab fh->type = fh_type; 17450c0d06caSMauro Carvalho Chehab filp->private_data = fh; 17460c0d06caSMauro Carvalho Chehab 17470c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE && dev->users == 0) { 17480c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 17490c0d06caSMauro Carvalho Chehab em28xx_set_alternate(dev); 17500c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 17510c0d06caSMauro Carvalho Chehab 17520c0d06caSMauro Carvalho Chehab /* Needed, since GPIO might have disabled power of 17530c0d06caSMauro Carvalho Chehab some i2c device 17540c0d06caSMauro Carvalho Chehab */ 17550c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 17560c0d06caSMauro Carvalho Chehab 17570c0d06caSMauro Carvalho Chehab } 17580c0d06caSMauro Carvalho Chehab if (fh->radio) { 17590c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 17600c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_radio); 17610c0d06caSMauro Carvalho Chehab } 17620c0d06caSMauro Carvalho Chehab 17630c0d06caSMauro Carvalho Chehab dev->users++; 17640c0d06caSMauro Carvalho Chehab 17650c0d06caSMauro Carvalho Chehab if (dev->progressive) 17660c0d06caSMauro Carvalho Chehab field = V4L2_FIELD_NONE; 17670c0d06caSMauro Carvalho Chehab else 17680c0d06caSMauro Carvalho Chehab field = V4L2_FIELD_INTERLACED; 17690c0d06caSMauro Carvalho Chehab 17700c0d06caSMauro Carvalho Chehab videobuf_queue_vmalloc_init(&fh->vb_vidq, &em28xx_video_qops, 17710c0d06caSMauro Carvalho Chehab NULL, &dev->slock, 17720c0d06caSMauro Carvalho Chehab V4L2_BUF_TYPE_VIDEO_CAPTURE, field, 17730c0d06caSMauro Carvalho Chehab sizeof(struct em28xx_buffer), fh, &dev->lock); 17740c0d06caSMauro Carvalho Chehab 17750c0d06caSMauro Carvalho Chehab videobuf_queue_vmalloc_init(&fh->vb_vbiq, &em28xx_vbi_qops, 17760c0d06caSMauro Carvalho Chehab NULL, &dev->slock, 17770c0d06caSMauro Carvalho Chehab V4L2_BUF_TYPE_VBI_CAPTURE, 17780c0d06caSMauro Carvalho Chehab V4L2_FIELD_SEQ_TB, 17790c0d06caSMauro Carvalho Chehab sizeof(struct em28xx_buffer), fh, &dev->lock); 17800c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 178169a61642SHans Verkuil v4l2_fh_add(&fh->fh); 17820c0d06caSMauro Carvalho Chehab 17830c0d06caSMauro Carvalho Chehab return errCode; 17840c0d06caSMauro Carvalho Chehab } 17850c0d06caSMauro Carvalho Chehab 17860c0d06caSMauro Carvalho Chehab /* 17870c0d06caSMauro Carvalho Chehab * em28xx_realease_resources() 17880c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 17890c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 17900c0d06caSMauro Carvalho Chehab */ 17910c0d06caSMauro Carvalho Chehab void em28xx_release_analog_resources(struct em28xx *dev) 17920c0d06caSMauro Carvalho Chehab { 17930c0d06caSMauro Carvalho Chehab 17940c0d06caSMauro Carvalho Chehab /*FIXME: I2C IR should be disconnected */ 17950c0d06caSMauro Carvalho Chehab 17960c0d06caSMauro Carvalho Chehab if (dev->radio_dev) { 17970c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->radio_dev)) 17980c0d06caSMauro Carvalho Chehab video_unregister_device(dev->radio_dev); 17990c0d06caSMauro Carvalho Chehab else 18000c0d06caSMauro Carvalho Chehab video_device_release(dev->radio_dev); 18010c0d06caSMauro Carvalho Chehab dev->radio_dev = NULL; 18020c0d06caSMauro Carvalho Chehab } 18030c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) { 18040c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 18050c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 18060c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vbi_dev)) 18070c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vbi_dev); 18080c0d06caSMauro Carvalho Chehab else 18090c0d06caSMauro Carvalho Chehab video_device_release(dev->vbi_dev); 18100c0d06caSMauro Carvalho Chehab dev->vbi_dev = NULL; 18110c0d06caSMauro Carvalho Chehab } 18120c0d06caSMauro Carvalho Chehab if (dev->vdev) { 18130c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 18140c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 18150c0d06caSMauro Carvalho Chehab if (video_is_registered(dev->vdev)) 18160c0d06caSMauro Carvalho Chehab video_unregister_device(dev->vdev); 18170c0d06caSMauro Carvalho Chehab else 18180c0d06caSMauro Carvalho Chehab video_device_release(dev->vdev); 18190c0d06caSMauro Carvalho Chehab dev->vdev = NULL; 18200c0d06caSMauro Carvalho Chehab } 18210c0d06caSMauro Carvalho Chehab } 18220c0d06caSMauro Carvalho Chehab 18230c0d06caSMauro Carvalho Chehab /* 18240c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 18250c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 18260c0d06caSMauro Carvalho Chehab * calls and ioctls 18270c0d06caSMauro Carvalho Chehab */ 18280c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 18290c0d06caSMauro Carvalho Chehab { 18300c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 18310c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18320c0d06caSMauro Carvalho Chehab int errCode; 18330c0d06caSMauro Carvalho Chehab 18340c0d06caSMauro Carvalho Chehab em28xx_videodbg("users=%d\n", dev->users); 18350c0d06caSMauro Carvalho Chehab 18360c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 18370c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VIDEO)) { 18380c0d06caSMauro Carvalho Chehab videobuf_stop(&fh->vb_vidq); 18390c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VIDEO); 18400c0d06caSMauro Carvalho Chehab } 18410c0d06caSMauro Carvalho Chehab 18420c0d06caSMauro Carvalho Chehab if (res_check(fh, EM28XX_RESOURCE_VBI)) { 18430c0d06caSMauro Carvalho Chehab videobuf_stop(&fh->vb_vbiq); 18440c0d06caSMauro Carvalho Chehab res_free(fh, EM28XX_RESOURCE_VBI); 18450c0d06caSMauro Carvalho Chehab } 18460c0d06caSMauro Carvalho Chehab 18470c0d06caSMauro Carvalho Chehab if (dev->users == 1) { 18480c0d06caSMauro Carvalho Chehab /* the device is already disconnect, 18490c0d06caSMauro Carvalho Chehab free the remaining resources */ 18500c0d06caSMauro Carvalho Chehab if (dev->state & DEV_DISCONNECTED) { 18510c0d06caSMauro Carvalho Chehab em28xx_release_resources(dev); 18520cf544a6SFrank Schaefer kfree(dev->alt_max_pkt_size_isoc); 1853e36c92fdSDan Carpenter mutex_unlock(&dev->lock); 18540c0d06caSMauro Carvalho Chehab kfree(dev); 18550c0d06caSMauro Carvalho Chehab kfree(fh); 18560c0d06caSMauro Carvalho Chehab return 0; 18570c0d06caSMauro Carvalho Chehab } 18580c0d06caSMauro Carvalho Chehab 18590c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 18600c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_power, 0); 18610c0d06caSMauro Carvalho Chehab 18620c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 1863afb177e0SFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 18640c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 18650c0d06caSMauro Carvalho Chehab 18660c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 18670c0d06caSMauro Carvalho Chehab dev->alt = 0; 18680c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 18690c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 18700c0d06caSMauro Carvalho Chehab if (errCode < 0) { 18710c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 18720c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 18730c0d06caSMauro Carvalho Chehab } 18740c0d06caSMauro Carvalho Chehab } 187569a61642SHans Verkuil v4l2_fh_del(&fh->fh); 187669a61642SHans Verkuil v4l2_fh_exit(&fh->fh); 18770c0d06caSMauro Carvalho Chehab 18780c0d06caSMauro Carvalho Chehab videobuf_mmap_free(&fh->vb_vidq); 18790c0d06caSMauro Carvalho Chehab videobuf_mmap_free(&fh->vb_vbiq); 18800c0d06caSMauro Carvalho Chehab kfree(fh); 18810c0d06caSMauro Carvalho Chehab dev->users--; 18820c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 18830c0d06caSMauro Carvalho Chehab return 0; 18840c0d06caSMauro Carvalho Chehab } 18850c0d06caSMauro Carvalho Chehab 18860c0d06caSMauro Carvalho Chehab /* 18870c0d06caSMauro Carvalho Chehab * em28xx_v4l2_read() 18880c0d06caSMauro Carvalho Chehab * will allocate buffers when called for the first time 18890c0d06caSMauro Carvalho Chehab */ 18900c0d06caSMauro Carvalho Chehab static ssize_t 18910c0d06caSMauro Carvalho Chehab em28xx_v4l2_read(struct file *filp, char __user *buf, size_t count, 18920c0d06caSMauro Carvalho Chehab loff_t *pos) 18930c0d06caSMauro Carvalho Chehab { 18940c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 18950c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 18960c0d06caSMauro Carvalho Chehab int rc; 18970c0d06caSMauro Carvalho Chehab 18980c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 18990c0d06caSMauro Carvalho Chehab if (rc < 0) 19000c0d06caSMauro Carvalho Chehab return rc; 19010c0d06caSMauro Carvalho Chehab 19020c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 19030c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 19040c0d06caSMauro Carvalho Chehab /* FIXME: read() is not prepared to allow changing the video 19050c0d06caSMauro Carvalho Chehab resolution while streaming. Seems a bug at em28xx_set_fmt 19060c0d06caSMauro Carvalho Chehab */ 19070c0d06caSMauro Carvalho Chehab 19080c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 19090c0d06caSMauro Carvalho Chehab if (res_locked(dev, EM28XX_RESOURCE_VIDEO)) 19100c0d06caSMauro Carvalho Chehab rc = -EBUSY; 19110c0d06caSMauro Carvalho Chehab else 19120c0d06caSMauro Carvalho Chehab rc = videobuf_read_stream(&fh->vb_vidq, buf, count, pos, 0, 19130c0d06caSMauro Carvalho Chehab filp->f_flags & O_NONBLOCK); 19140c0d06caSMauro Carvalho Chehab } else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 19150c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VBI)) 19160c0d06caSMauro Carvalho Chehab rc = -EBUSY; 19170c0d06caSMauro Carvalho Chehab else 19180c0d06caSMauro Carvalho Chehab rc = videobuf_read_stream(&fh->vb_vbiq, buf, count, pos, 0, 19190c0d06caSMauro Carvalho Chehab filp->f_flags & O_NONBLOCK); 19200c0d06caSMauro Carvalho Chehab } 19210c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19220c0d06caSMauro Carvalho Chehab 19230c0d06caSMauro Carvalho Chehab return rc; 19240c0d06caSMauro Carvalho Chehab } 19250c0d06caSMauro Carvalho Chehab 19260c0d06caSMauro Carvalho Chehab /* 19270c0d06caSMauro Carvalho Chehab * em28xx_poll() 19280c0d06caSMauro Carvalho Chehab * will allocate buffers when called for the first time 19290c0d06caSMauro Carvalho Chehab */ 19300c0d06caSMauro Carvalho Chehab static unsigned int em28xx_poll(struct file *filp, poll_table *wait) 19310c0d06caSMauro Carvalho Chehab { 19320c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 193350fdf40fSHans Verkuil unsigned long req_events = poll_requested_events(wait); 19340c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 193550fdf40fSHans Verkuil unsigned int res = 0; 19360c0d06caSMauro Carvalho Chehab int rc; 19370c0d06caSMauro Carvalho Chehab 19380c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 19390c0d06caSMauro Carvalho Chehab if (rc < 0) 194050fdf40fSHans Verkuil return DEFAULT_POLLMASK; 19410c0d06caSMauro Carvalho Chehab 194250fdf40fSHans Verkuil if (v4l2_event_pending(&fh->fh)) 194350fdf40fSHans Verkuil res = POLLPRI; 194450fdf40fSHans Verkuil else if (req_events & POLLPRI) 194550fdf40fSHans Verkuil poll_wait(filp, &fh->fh.wait, wait); 194650fdf40fSHans Verkuil 194750fdf40fSHans Verkuil if (req_events & (POLLIN | POLLRDNORM)) { 19480c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { 19490c0d06caSMauro Carvalho Chehab if (!res_get(fh, EM28XX_RESOURCE_VIDEO)) 195050fdf40fSHans Verkuil return res | POLLERR; 19510c0d06caSMauro Carvalho Chehab return videobuf_poll_stream(filp, &fh->vb_vidq, wait); 19520c0d06caSMauro Carvalho Chehab } 195350fdf40fSHans Verkuil if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) { 195450fdf40fSHans Verkuil if (!res_get(fh, EM28XX_RESOURCE_VBI)) 195550fdf40fSHans Verkuil return res | POLLERR; 195650fdf40fSHans Verkuil return res | videobuf_poll_stream(filp, &fh->vb_vbiq, wait); 195750fdf40fSHans Verkuil } 195850fdf40fSHans Verkuil } 195950fdf40fSHans Verkuil return res; 19600c0d06caSMauro Carvalho Chehab } 19610c0d06caSMauro Carvalho Chehab 19620c0d06caSMauro Carvalho Chehab static unsigned int em28xx_v4l2_poll(struct file *filp, poll_table *wait) 19630c0d06caSMauro Carvalho Chehab { 19640c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 19650c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19660c0d06caSMauro Carvalho Chehab unsigned int res; 19670c0d06caSMauro Carvalho Chehab 19680c0d06caSMauro Carvalho Chehab mutex_lock(&dev->lock); 19690c0d06caSMauro Carvalho Chehab res = em28xx_poll(filp, wait); 19700c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19710c0d06caSMauro Carvalho Chehab return res; 19720c0d06caSMauro Carvalho Chehab } 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab /* 19750c0d06caSMauro Carvalho Chehab * em28xx_v4l2_mmap() 19760c0d06caSMauro Carvalho Chehab */ 19770c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_mmap(struct file *filp, struct vm_area_struct *vma) 19780c0d06caSMauro Carvalho Chehab { 19790c0d06caSMauro Carvalho Chehab struct em28xx_fh *fh = filp->private_data; 19800c0d06caSMauro Carvalho Chehab struct em28xx *dev = fh->dev; 19810c0d06caSMauro Carvalho Chehab int rc; 19820c0d06caSMauro Carvalho Chehab 19830c0d06caSMauro Carvalho Chehab rc = check_dev(dev); 19840c0d06caSMauro Carvalho Chehab if (rc < 0) 19850c0d06caSMauro Carvalho Chehab return rc; 19860c0d06caSMauro Carvalho Chehab 19870c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 19880c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 19890c0d06caSMauro Carvalho Chehab if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) 19900c0d06caSMauro Carvalho Chehab rc = videobuf_mmap_mapper(&fh->vb_vidq, vma); 19910c0d06caSMauro Carvalho Chehab else if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) 19920c0d06caSMauro Carvalho Chehab rc = videobuf_mmap_mapper(&fh->vb_vbiq, vma); 19930c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 19940c0d06caSMauro Carvalho Chehab 19950c0d06caSMauro Carvalho Chehab em28xx_videodbg("vma start=0x%08lx, size=%ld, ret=%d\n", 19960c0d06caSMauro Carvalho Chehab (unsigned long)vma->vm_start, 19970c0d06caSMauro Carvalho Chehab (unsigned long)vma->vm_end-(unsigned long)vma->vm_start, 19980c0d06caSMauro Carvalho Chehab rc); 19990c0d06caSMauro Carvalho Chehab 20000c0d06caSMauro Carvalho Chehab return rc; 20010c0d06caSMauro Carvalho Chehab } 20020c0d06caSMauro Carvalho Chehab 20030c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 20040c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20050c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20060c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 20070c0d06caSMauro Carvalho Chehab .read = em28xx_v4l2_read, 20080c0d06caSMauro Carvalho Chehab .poll = em28xx_v4l2_poll, 20090c0d06caSMauro Carvalho Chehab .mmap = em28xx_v4l2_mmap, 20100c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20110c0d06caSMauro Carvalho Chehab }; 20120c0d06caSMauro Carvalho Chehab 20130c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 20140c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 20150c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 20160c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 20170c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 20180c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 20190c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 20200c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vbi_cap = vidioc_s_fmt_vbi_cap, 20210c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 20220c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 20230c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 20240c0d06caSMauro Carvalho Chehab .vidioc_cropcap = vidioc_cropcap, 20250c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_sliced_vbi_cap = vidioc_g_fmt_sliced_vbi_cap, 20260c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_sliced_vbi_cap = vidioc_try_set_sliced_vbi_cap, 20270c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_sliced_vbi_cap = vidioc_try_set_sliced_vbi_cap, 20280c0d06caSMauro Carvalho Chehab 20290c0d06caSMauro Carvalho Chehab .vidioc_reqbufs = vidioc_reqbufs, 20300c0d06caSMauro Carvalho Chehab .vidioc_querybuf = vidioc_querybuf, 20310c0d06caSMauro Carvalho Chehab .vidioc_qbuf = vidioc_qbuf, 20320c0d06caSMauro Carvalho Chehab .vidioc_dqbuf = vidioc_dqbuf, 20330c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 20340c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 20350c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 20360c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 20370c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 20380c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 20390c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 20400c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 20410c0d06caSMauro Carvalho Chehab .vidioc_streamon = vidioc_streamon, 20420c0d06caSMauro Carvalho Chehab .vidioc_streamoff = vidioc_streamoff, 20430c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 20440c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 20450c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 20460c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 204750fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 204850fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 20490c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 20500c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 20510c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 20520c0d06caSMauro Carvalho Chehab .vidioc_g_chip_ident = vidioc_g_chip_ident, 20530c0d06caSMauro Carvalho Chehab #endif 20540c0d06caSMauro Carvalho Chehab }; 20550c0d06caSMauro Carvalho Chehab 20560c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 20570c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 20580c0d06caSMauro Carvalho Chehab .release = video_device_release, 20590c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 20600c0d06caSMauro Carvalho Chehab 20610c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 20620c0d06caSMauro Carvalho Chehab .current_norm = V4L2_STD_PAL, 20630c0d06caSMauro Carvalho Chehab }; 20640c0d06caSMauro Carvalho Chehab 20650c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 20660c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 20670c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 20680c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 20690c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 20700c0d06caSMauro Carvalho Chehab }; 20710c0d06caSMauro Carvalho Chehab 20720c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2073a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 20740c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 20750c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 20760c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 20770c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 207850fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 207950fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 20800c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 20810c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 20820c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 20830c0d06caSMauro Carvalho Chehab #endif 20840c0d06caSMauro Carvalho Chehab }; 20850c0d06caSMauro Carvalho Chehab 20860c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 20870c0d06caSMauro Carvalho Chehab .name = "em28xx-radio", 20880c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 20890c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 20900c0d06caSMauro Carvalho Chehab }; 20910c0d06caSMauro Carvalho Chehab 20920c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 20930c0d06caSMauro Carvalho Chehab 20940c0d06caSMauro Carvalho Chehab 20950c0d06caSMauro Carvalho Chehab 20960c0d06caSMauro Carvalho Chehab static struct video_device *em28xx_vdev_init(struct em28xx *dev, 20970c0d06caSMauro Carvalho Chehab const struct video_device *template, 20980c0d06caSMauro Carvalho Chehab const char *type_name) 20990c0d06caSMauro Carvalho Chehab { 21000c0d06caSMauro Carvalho Chehab struct video_device *vfd; 21010c0d06caSMauro Carvalho Chehab 21020c0d06caSMauro Carvalho Chehab vfd = video_device_alloc(); 21030c0d06caSMauro Carvalho Chehab if (NULL == vfd) 21040c0d06caSMauro Carvalho Chehab return NULL; 21050c0d06caSMauro Carvalho Chehab 21060c0d06caSMauro Carvalho Chehab *vfd = *template; 21070c0d06caSMauro Carvalho Chehab vfd->v4l2_dev = &dev->v4l2_dev; 21080c0d06caSMauro Carvalho Chehab vfd->release = video_device_release; 21090c0d06caSMauro Carvalho Chehab vfd->debug = video_debug; 21100c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 211169a61642SHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags); 21120c0d06caSMauro Carvalho Chehab 21130c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 21140c0d06caSMauro Carvalho Chehab dev->name, type_name); 21150c0d06caSMauro Carvalho Chehab 21160c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 21170c0d06caSMauro Carvalho Chehab return vfd; 21180c0d06caSMauro Carvalho Chehab } 21190c0d06caSMauro Carvalho Chehab 21200c0d06caSMauro Carvalho Chehab int em28xx_register_analog_devices(struct em28xx *dev) 21210c0d06caSMauro Carvalho Chehab { 21220c0d06caSMauro Carvalho Chehab u8 val; 21230c0d06caSMauro Carvalho Chehab int ret; 21240c0d06caSMauro Carvalho Chehab unsigned int maxw; 21250c0d06caSMauro Carvalho Chehab 21260c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s: v4l2 driver version %s\n", 21270c0d06caSMauro Carvalho Chehab dev->name, EM28XX_VERSION); 21280c0d06caSMauro Carvalho Chehab 21290c0d06caSMauro Carvalho Chehab /* set default norm */ 21300c0d06caSMauro Carvalho Chehab dev->norm = em28xx_video_template.current_norm; 21310c0d06caSMauro Carvalho Chehab v4l2_device_call_all(&dev->v4l2_dev, 0, core, s_std, dev->norm); 21320c0d06caSMauro Carvalho Chehab dev->interlaced = EM28XX_INTERLACED_DEFAULT; 21330c0d06caSMauro Carvalho Chehab 21340c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 21350c0d06caSMauro Carvalho Chehab dev->format = &format[0]; 21360c0d06caSMauro Carvalho Chehab 21370c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 21380c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 21390c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 21400c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 21410c0d06caSMauro Carvalho Chehab maxw /= 2; 21420c0d06caSMauro Carvalho Chehab 21430c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 21440c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 21450c0d06caSMauro Carvalho Chehab 21460c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 21470c0d06caSMauro Carvalho Chehab 21480c0d06caSMauro Carvalho Chehab /* Audio defaults */ 21490c0d06caSMauro Carvalho Chehab dev->mute = 1; 21500c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 21510c0d06caSMauro Carvalho Chehab 21520c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 21530c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 21540c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 21550c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 21560c0d06caSMauro Carvalho Chehab 21570c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 21580c0d06caSMauro Carvalho Chehab em28xx_colorlevels_set_default(dev); 21590c0d06caSMauro Carvalho Chehab em28xx_compression_disable(dev); 21600c0d06caSMauro Carvalho Chehab 21610c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 21620c0d06caSMauro Carvalho Chehab dev->vdev = em28xx_vdev_init(dev, &em28xx_video_template, "video"); 21630c0d06caSMauro Carvalho Chehab if (!dev->vdev) { 21640c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 21650c0d06caSMauro Carvalho Chehab return -ENODEV; 21660c0d06caSMauro Carvalho Chehab } 21670c0d06caSMauro Carvalho Chehab 21680c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 21690c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vdev, VFL_TYPE_GRABBER, 21700c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 21710c0d06caSMauro Carvalho Chehab if (ret) { 21720c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 21730c0d06caSMauro Carvalho Chehab ret); 21740c0d06caSMauro Carvalho Chehab return ret; 21750c0d06caSMauro Carvalho Chehab } 21760c0d06caSMauro Carvalho Chehab 21770c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 21780c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 21790c0d06caSMauro Carvalho Chehab dev->vbi_dev = em28xx_vdev_init(dev, &em28xx_video_template, 21800c0d06caSMauro Carvalho Chehab "vbi"); 21810c0d06caSMauro Carvalho Chehab 21820c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 21830c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->vbi_dev, VFL_TYPE_VBI, 21840c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 21850c0d06caSMauro Carvalho Chehab if (ret < 0) { 21860c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 21870c0d06caSMauro Carvalho Chehab return ret; 21880c0d06caSMauro Carvalho Chehab } 21890c0d06caSMauro Carvalho Chehab } 21900c0d06caSMauro Carvalho Chehab 21910c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 21920c0d06caSMauro Carvalho Chehab dev->radio_dev = em28xx_vdev_init(dev, &em28xx_radio_template, 21930c0d06caSMauro Carvalho Chehab "radio"); 21940c0d06caSMauro Carvalho Chehab if (!dev->radio_dev) { 21950c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot allocate video_device.\n"); 21960c0d06caSMauro Carvalho Chehab return -ENODEV; 21970c0d06caSMauro Carvalho Chehab } 21980c0d06caSMauro Carvalho Chehab ret = video_register_device(dev->radio_dev, VFL_TYPE_RADIO, 21990c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 22000c0d06caSMauro Carvalho Chehab if (ret < 0) { 22010c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 22020c0d06caSMauro Carvalho Chehab return ret; 22030c0d06caSMauro Carvalho Chehab } 22040c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 22050c0d06caSMauro Carvalho Chehab video_device_node_name(dev->radio_dev)); 22060c0d06caSMauro Carvalho Chehab } 22070c0d06caSMauro Carvalho Chehab 22080c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 22090c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vdev)); 22100c0d06caSMauro Carvalho Chehab 22110c0d06caSMauro Carvalho Chehab if (dev->vbi_dev) 22120c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 22130c0d06caSMauro Carvalho Chehab video_device_node_name(dev->vbi_dev)); 22140c0d06caSMauro Carvalho Chehab 22150c0d06caSMauro Carvalho Chehab return 0; 22160c0d06caSMauro Carvalho Chehab } 2217