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 298314d402SMauro Carvalho Chehab #include "em28xx.h" 308314d402SMauro Carvalho Chehab 310c0d06caSMauro Carvalho Chehab #include <linux/init.h> 320c0d06caSMauro Carvalho Chehab #include <linux/list.h> 330c0d06caSMauro Carvalho Chehab #include <linux/module.h> 340c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 350c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 360c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 370c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 380c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 390c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 400c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 410c0d06caSMauro Carvalho Chehab 4201c28193SMauro Carvalho Chehab #include "em28xx-v4l.h" 430c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 440c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4550fdf40fSHans Verkuil #include <media/v4l2-event.h> 46d647f0b7SMauro Carvalho Chehab #include <media/drv-intf/msp3400.h> 470c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 480c0d06caSMauro Carvalho Chehab 490c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 500c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 510c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 520c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 530c0d06caSMauro Carvalho Chehab 540560f337SMauro Carvalho Chehab static unsigned int isoc_debug; 550560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 560560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 570560f337SMauro Carvalho Chehab 580560f337SMauro Carvalho Chehab static unsigned int disable_vbi; 590560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644); 600560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support"); 610560f337SMauro Carvalho Chehab 620560f337SMauro Carvalho Chehab static int alt; 630560f337SMauro Carvalho Chehab module_param(alt, int, 0644); 640560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 650560f337SMauro Carvalho Chehab 660c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do { \ 670c0d06caSMauro Carvalho Chehab if (video_debug) \ 6829b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \ 69ce8591ffSMauro Carvalho Chehab "video: %s: " fmt, __func__, ## arg); \ 70ce8591ffSMauro Carvalho Chehab } while (0) 710c0d06caSMauro Carvalho Chehab 722a96f60eSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) do {\ 732a96f60eSMauro Carvalho Chehab if (isoc_debug) \ 7429b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \ 75ce8591ffSMauro Carvalho Chehab "isoc: %s: " fmt, __func__, ## arg); \ 76ce8591ffSMauro Carvalho Chehab } while (0) 770c0d06caSMauro Carvalho Chehab 780c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 79d8992b09SMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC " - v4l2 interface"); 800c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 810c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 820c0d06caSMauro Carvalho Chehab 83e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 84e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 85e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 86e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 87e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 88e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 89e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 90e507e0e5SFrank Schaefer 91d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 92d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 93d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 940c0d06caSMauro Carvalho Chehab 950c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 960c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 970c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 980c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 990c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 1000c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 1010c0d06caSMauro Carvalho Chehab 1020c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 1030c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1040c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1050c0d06caSMauro Carvalho Chehab 1060c0d06caSMauro Carvalho Chehab /* supported video standards */ 1070c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1080c0d06caSMauro Carvalho Chehab { 1090c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1100c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1110c0d06caSMauro Carvalho Chehab .depth = 16, 1120c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1130c0d06caSMauro Carvalho Chehab }, { 1140c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1150c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1160c0d06caSMauro Carvalho Chehab .depth = 16, 1170c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1180c0d06caSMauro Carvalho Chehab }, { 119495ab569SFrank Schaefer .name = "8 bpp Bayer RGRG..GBGB", 120495ab569SFrank Schaefer .fourcc = V4L2_PIX_FMT_SRGGB8, 121495ab569SFrank Schaefer .depth = 8, 122495ab569SFrank Schaefer .reg = EM28XX_OUTFMT_RGB_8_RGRG, 123495ab569SFrank Schaefer }, { 1240c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1250c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1260c0d06caSMauro Carvalho Chehab .depth = 8, 1270c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1280c0d06caSMauro Carvalho Chehab }, { 1290c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1300c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1310c0d06caSMauro Carvalho Chehab .depth = 8, 1320c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1330c0d06caSMauro Carvalho Chehab }, { 1340c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1350c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1360c0d06caSMauro Carvalho Chehab .depth = 8, 1370c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1380c0d06caSMauro Carvalho Chehab }, { 1390c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1400c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1410c0d06caSMauro Carvalho Chehab .depth = 12, 1420c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1430c0d06caSMauro Carvalho Chehab }, 1440c0d06caSMauro Carvalho Chehab }; 1450c0d06caSMauro Carvalho Chehab 14625c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */ 14725c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev) 14825c61e4cSFrank Schaefer { 149d7dc18daSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 150d7dc18daSFrank Schaefer 151aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 152d7dc18daSFrank Schaefer return v4l2->sensor_xres; 15325c61e4cSFrank Schaefer 15425c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 15525c61e4cSFrank Schaefer return 640; 15625c61e4cSFrank Schaefer 15725c61e4cSFrank Schaefer return 720; 15825c61e4cSFrank Schaefer } 15925c61e4cSFrank Schaefer 16025c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev) 16125c61e4cSFrank Schaefer { 16252faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16352faaf78SFrank Schaefer 164aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 165d7dc18daSFrank Schaefer return v4l2->sensor_yres; 16625c61e4cSFrank Schaefer 16725c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 16825c61e4cSFrank Schaefer return 480; 16925c61e4cSFrank Schaefer 17052faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480; 17125c61e4cSFrank Schaefer } 17225c61e4cSFrank Schaefer 17301c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1740560f337SMauro Carvalho Chehab { 1750560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1760560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1770560f337SMauro Carvalho Chehab return 0; 1780560f337SMauro Carvalho Chehab 179aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1800560f337SMauro Carvalho Chehab return 0; 1810560f337SMauro Carvalho Chehab 1820560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1830560f337SMauro Carvalho Chehab 1840560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1850560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1860560f337SMauro Carvalho Chehab return 1; 1870560f337SMauro Carvalho Chehab 1880560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1890560f337SMauro Carvalho Chehab return 0; 1900560f337SMauro Carvalho Chehab } 1910560f337SMauro Carvalho Chehab 1920560f337SMauro Carvalho Chehab /* 1930560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1940560f337SMauro Carvalho Chehab * configure i2c attached devices 1950560f337SMauro Carvalho Chehab */ 19601c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1970560f337SMauro Carvalho Chehab { 19895d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 199fdf1bc9fSMauro Carvalho Chehab 20095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 20195d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 2020560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 2030560f337SMauro Carvalho Chehab } 2040560f337SMauro Carvalho Chehab 20501c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2060560f337SMauro Carvalho Chehab { 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2090560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2100560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2110560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2130560f337SMauro Carvalho Chehab 2140560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2150560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2160560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2170560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2180560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2190560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2200560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2210560f337SMauro Carvalho Chehab } 2220560f337SMauro Carvalho Chehab 22301c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2240560f337SMauro Carvalho Chehab { 2250560f337SMauro Carvalho Chehab int ret; 2260560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 227753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2280560f337SMauro Carvalho Chehab 22906e20672SFrank Schaefer fmt = v4l2->format->reg; 2300560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2310560f337SMauro Carvalho Chehab fmt |= 0x20; 2320560f337SMauro Carvalho Chehab /* 2330560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2340560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2350560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2360560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2370560f337SMauro Carvalho Chehab * 2380560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2390560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2400560f337SMauro Carvalho Chehab */ 2410560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2420560f337SMauro Carvalho Chehab if (ret < 0) 2430560f337SMauro Carvalho Chehab return ret; 2440560f337SMauro Carvalho Chehab 2459297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2460560f337SMauro Carvalho Chehab if (ret < 0) 2470560f337SMauro Carvalho Chehab return ret; 2480560f337SMauro Carvalho Chehab 2499297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2500560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2510560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2520560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 253753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 254753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2560560f337SMauro Carvalho Chehab /* NTSC */ 2570560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25852faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2590560f337SMauro Carvalho Chehab /* PAL */ 2600560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2610560f337SMauro Carvalho Chehab } 2620560f337SMauro Carvalho Chehab } 2630560f337SMauro Carvalho Chehab 2640560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2650560f337SMauro Carvalho Chehab } 2660560f337SMauro Carvalho Chehab 2670560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2680560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2690560f337SMauro Carvalho Chehab { 2700560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2710560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2720560f337SMauro Carvalho Chehab 2730560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2740560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2750560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2760560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2770560f337SMauro Carvalho Chehab } 2780560f337SMauro Carvalho Chehab 2790560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2800560f337SMauro Carvalho Chehab u16 width, u16 height) 2810560f337SMauro Carvalho Chehab { 2820560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2830560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2840560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2850560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2860560f337SMauro Carvalho Chehab 2870560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2880560f337SMauro Carvalho Chehab hstart, vstart, 2890560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2900560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2910560f337SMauro Carvalho Chehab 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2930560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2940560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2950560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2960560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2970560f337SMauro Carvalho Chehab 2980560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2990560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 3000560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 3010560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 3020560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 3030560f337SMauro Carvalho Chehab } 3040560f337SMauro Carvalho Chehab } 3050560f337SMauro Carvalho Chehab 3060560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3070560f337SMauro Carvalho Chehab { 308cba8e9b3SFrank Schaefer u8 mode = 0x00; 3090560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3100560f337SMauro Carvalho Chehab 3110560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3120560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3130560f337SMauro Carvalho Chehab } else { 3140560f337SMauro Carvalho Chehab u8 buf[2]; 3150560f337SMauro Carvalho Chehab 3160560f337SMauro Carvalho Chehab buf[0] = h; 3170560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3180560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3190560f337SMauro Carvalho Chehab 3200560f337SMauro Carvalho Chehab buf[0] = v; 3210560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3220560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3230560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3240560f337SMauro Carvalho Chehab to work correctly */ 3250560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3260560f337SMauro Carvalho Chehab } 327cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3280560f337SMauro Carvalho Chehab } 3290560f337SMauro Carvalho Chehab 3300560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 33101c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3320560f337SMauro Carvalho Chehab { 333753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 334753aee77SFrank Schaefer int width = norm_maxw(dev); 335753aee77SFrank Schaefer int height = norm_maxh(dev); 3360560f337SMauro Carvalho Chehab 3370560f337SMauro Carvalho Chehab /* Properly setup VBI */ 338753aee77SFrank Schaefer v4l2->vbi_width = 720; 33952faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 340753aee77SFrank Schaefer v4l2->vbi_height = 12; 3410560f337SMauro Carvalho Chehab else 342753aee77SFrank Schaefer v4l2->vbi_height = 18; 3430560f337SMauro Carvalho Chehab 3440560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3450560f337SMauro Carvalho Chehab 3460560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3470560f337SMauro Carvalho Chehab 3480560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3490560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3500560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3510560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3520560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3530560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3540560f337SMauro Carvalho Chehab region */ 3550560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3560560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3570560f337SMauro Carvalho Chehab else 3580560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3590560f337SMauro Carvalho Chehab 360753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3610560f337SMauro Carvalho Chehab } 3620560f337SMauro Carvalho Chehab 3630560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36401c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3650560f337SMauro Carvalho Chehab { 366753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 367c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 3680560f337SMauro Carvalho Chehab int errCode; 3690560f337SMauro Carvalho Chehab int i; 370753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3710560f337SMauro Carvalho Chehab 3720560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3730560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3740560f337SMauro Carvalho Chehab dev->alt = 0; 3750560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3760560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3770560f337SMauro Carvalho Chehab dev->alt = alt; 3780560f337SMauro Carvalho Chehab goto set_alt; 3790560f337SMauro Carvalho Chehab } 3800560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3810560f337SMauro Carvalho Chehab goto set_alt; 3820560f337SMauro Carvalho Chehab 3830560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3840560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3850560f337SMauro Carvalho Chehab green screen will be received. 3860560f337SMauro Carvalho Chehab */ 387753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3880560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3890560f337SMauro Carvalho Chehab 3900560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3910560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3920560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3930560f337SMauro Carvalho Chehab dev->alt = i; 3940560f337SMauro Carvalho Chehab break; 3950560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3960560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3970560f337SMauro Carvalho Chehab */ 3980560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3990560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 4000560f337SMauro Carvalho Chehab dev->alt = i; 4010560f337SMauro Carvalho Chehab } 4020560f337SMauro Carvalho Chehab 4030560f337SMauro Carvalho Chehab set_alt: 4040560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4050560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4060560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4070560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4080560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4090560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4100560f337SMauro Carvalho Chehab } else { /* isoc */ 4110560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4120560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4130560f337SMauro Carvalho Chehab dev->max_pkt_size = 4140560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4150560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4160560f337SMauro Carvalho Chehab } 4170560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4180560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 419c6d48134SMauro Carvalho Chehab errCode = usb_set_interface(udev, dev->ifnum, dev->alt); 4200560f337SMauro Carvalho Chehab if (errCode < 0) { 42129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 422ce8591ffSMauro Carvalho Chehab "cannot change alternate number to %d (error=%i)\n", 4230560f337SMauro Carvalho Chehab dev->alt, errCode); 4240560f337SMauro Carvalho Chehab return errCode; 4250560f337SMauro Carvalho Chehab } 4260560f337SMauro Carvalho Chehab return 0; 4270560f337SMauro Carvalho Chehab } 4280560f337SMauro Carvalho Chehab 4290c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4300c0d06caSMauro Carvalho Chehab DMA and thread functions 4310c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4320c0d06caSMauro Carvalho Chehab 4330c0d06caSMauro Carvalho Chehab /* 434948a49aaSFrank Schaefer * Finish the current buffer 4350c0d06caSMauro Carvalho Chehab */ 436948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4370c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4380c0d06caSMauro Carvalho Chehab { 439d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 440d3829fadSDevin Heitmueller 4412d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++; 442662c97cfSFrank Schaefer if (dev->v4l2->progressive) 4432d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE; 444662c97cfSFrank Schaefer else 4452d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED; 446d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns(); 447d3829fadSDevin Heitmueller 4482d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 4490c0d06caSMauro Carvalho Chehab } 4500c0d06caSMauro Carvalho Chehab 4510c0d06caSMauro Carvalho Chehab /* 45236016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4530c0d06caSMauro Carvalho Chehab */ 4540c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4550c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 45636016a35SFrank Schaefer unsigned char *usb_buf, 4574078d625SFrank Schaefer unsigned long len) 4580c0d06caSMauro Carvalho Chehab { 45958159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4600c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4610c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 46258159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4630c0d06caSMauro Carvalho Chehab 464d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 465d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4660c0d06caSMauro Carvalho Chehab 46736016a35SFrank Schaefer startread = usb_buf; 4680c0d06caSMauro Carvalho Chehab remain = len; 4690c0d06caSMauro Carvalho Chehab 47058159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 47136016a35SFrank Schaefer fieldstart = buf->vb_buf; 472c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 47336016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4740c0d06caSMauro Carvalho Chehab 4758732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4768732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4770c0d06caSMauro Carvalho Chehab 47858159171SFrank Schaefer if (v4l2->progressive) 4790c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4800c0d06caSMauro Carvalho Chehab else 4810c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4820c0d06caSMauro Carvalho Chehab 4830c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4840c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4850c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4860c0d06caSMauro Carvalho Chehab 487d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4887983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4890c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 490d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 491d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 49236016a35SFrank Schaefer (char *)startwrite; 4930c0d06caSMauro Carvalho Chehab lencopy = remain; 4940c0d06caSMauro Carvalho Chehab } 4950c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4960c0d06caSMauro Carvalho Chehab return; 4970c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4980c0d06caSMauro Carvalho Chehab 4990c0d06caSMauro Carvalho Chehab remain -= lencopy; 5000c0d06caSMauro Carvalho Chehab 5010c0d06caSMauro Carvalho Chehab while (remain > 0) { 50258159171SFrank Schaefer if (v4l2->progressive) 503c02ec71bSFrank Schaefer startwrite += lencopy; 504c02ec71bSFrank Schaefer else 5050c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5060c0d06caSMauro Carvalho Chehab startread += lencopy; 5070c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5080c0d06caSMauro Carvalho Chehab lencopy = remain; 5090c0d06caSMauro Carvalho Chehab else 5100c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5110c0d06caSMauro Carvalho Chehab 51236016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 513d3829fadSDevin Heitmueller buf->length) { 5145ccb197dSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end(2)\n", 5150c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 516d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 517d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5180c0d06caSMauro Carvalho Chehab (char *)startwrite; 5190c0d06caSMauro Carvalho Chehab } 5200c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5210c0d06caSMauro Carvalho Chehab break; 5220c0d06caSMauro Carvalho Chehab 5230c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5240c0d06caSMauro Carvalho Chehab 5250c0d06caSMauro Carvalho Chehab remain -= lencopy; 5260c0d06caSMauro Carvalho Chehab } 5270c0d06caSMauro Carvalho Chehab 5288732533bSFrank Schaefer buf->pos += len; 5290c0d06caSMauro Carvalho Chehab } 5300c0d06caSMauro Carvalho Chehab 53136016a35SFrank Schaefer /* 53236016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 53336016a35SFrank Schaefer */ 5340c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5350c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53636016a35SFrank Schaefer unsigned char *usb_buf, 5374078d625SFrank Schaefer unsigned long len) 5380c0d06caSMauro Carvalho Chehab { 53936016a35SFrank Schaefer unsigned int offset; 5400c0d06caSMauro Carvalho Chehab 541d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 542d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5430c0d06caSMauro Carvalho Chehab 5448732533bSFrank Schaefer offset = buf->pos; 5450c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54636016a35SFrank Schaefer if (buf->top_field == 0) 547753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5480c0d06caSMauro Carvalho Chehab 54936016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5508732533bSFrank Schaefer buf->pos += len; 5510c0d06caSMauro Carvalho Chehab } 5520c0d06caSMauro Carvalho Chehab 5530c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5540c0d06caSMauro Carvalho Chehab int packet, int status) 5550c0d06caSMauro Carvalho Chehab { 5560c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5570c0d06caSMauro Carvalho Chehab 5580c0d06caSMauro Carvalho Chehab switch (status) { 5590c0d06caSMauro Carvalho Chehab case -ENOENT: 560b436e26eSColin Ian King errmsg = "unlinked synchronously"; 5610c0d06caSMauro Carvalho Chehab break; 5620c0d06caSMauro Carvalho Chehab case -ECONNRESET: 563b436e26eSColin Ian King errmsg = "unlinked asynchronously"; 5640c0d06caSMauro Carvalho Chehab break; 5650c0d06caSMauro Carvalho Chehab case -ENOSR: 5660c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5670c0d06caSMauro Carvalho Chehab break; 5680c0d06caSMauro Carvalho Chehab case -EPIPE: 5690c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5700c0d06caSMauro Carvalho Chehab break; 5710c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5720c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5730c0d06caSMauro Carvalho Chehab break; 5740c0d06caSMauro Carvalho Chehab case -EPROTO: 5750c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5760c0d06caSMauro Carvalho Chehab break; 5770c0d06caSMauro Carvalho Chehab case -EILSEQ: 5780c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5790c0d06caSMauro Carvalho Chehab break; 5800c0d06caSMauro Carvalho Chehab case -ETIME: 5810c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5820c0d06caSMauro Carvalho Chehab break; 5830c0d06caSMauro Carvalho Chehab } 5840c0d06caSMauro Carvalho Chehab if (packet < 0) { 5850c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5860c0d06caSMauro Carvalho Chehab } else { 5870c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5880c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5890c0d06caSMauro Carvalho Chehab } 5900c0d06caSMauro Carvalho Chehab } 5910c0d06caSMauro Carvalho Chehab 5920c0d06caSMauro Carvalho Chehab /* 59324a6d849SFrank Schaefer * get the next available buffer from dma queue 5940c0d06caSMauro Carvalho Chehab */ 59524a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59624a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5970c0d06caSMauro Carvalho Chehab { 59824a6d849SFrank Schaefer struct em28xx_buffer *buf; 5990c0d06caSMauro Carvalho Chehab 6000c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 6010c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 60224a6d849SFrank Schaefer return NULL; 6030c0d06caSMauro Carvalho Chehab } 6040c0d06caSMauro Carvalho Chehab 6050c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 606d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6070c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 608d3829fadSDevin Heitmueller list_del(&buf->list); 6098732533bSFrank Schaefer buf->pos = 0; 610d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6110c0d06caSMauro Carvalho Chehab 61224a6d849SFrank Schaefer return buf; 6130c0d06caSMauro Carvalho Chehab } 6140c0d06caSMauro Carvalho Chehab 615e04c00d9SFrank Schaefer /* 616e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 617e04c00d9SFrank Schaefer */ 618e04c00d9SFrank Schaefer static struct em28xx_buffer * 619e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 620e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 621e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 622e04c00d9SFrank Schaefer { 62358159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 62458159171SFrank Schaefer 625f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 626e04c00d9SFrank Schaefer if (buf != NULL) 627e04c00d9SFrank Schaefer finish_buffer(dev, buf); 628e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 629e04c00d9SFrank Schaefer } 630e04c00d9SFrank Schaefer if (buf != NULL) { 631f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 632e04c00d9SFrank Schaefer buf->pos = 0; 633e04c00d9SFrank Schaefer } 634e04c00d9SFrank Schaefer 635e04c00d9SFrank Schaefer return buf; 636e04c00d9SFrank Schaefer } 637e04c00d9SFrank Schaefer 638227b7c90SFrank Schaefer /* 639227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 640227b7c90SFrank Schaefer */ 641227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 642227b7c90SFrank Schaefer unsigned char *data_pkt, 643227b7c90SFrank Schaefer unsigned int data_len) 644227b7c90SFrank Schaefer { 645753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 646227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 647227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 648227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 649227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 650227b7c90SFrank Schaefer 651227b7c90SFrank Schaefer /* capture type 0 = vbi start 652227b7c90SFrank Schaefer capture type 1 = vbi in progress 653227b7c90SFrank Schaefer capture type 2 = video start 654227b7c90SFrank Schaefer capture type 3 = video in progress */ 655227b7c90SFrank Schaefer if (data_len >= 4) { 656227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 657227b7c90SFrank Schaefer * never split across packets */ 658227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 659227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 660227b7c90SFrank Schaefer /* Continuation */ 661227b7c90SFrank Schaefer data_pkt += 4; 662227b7c90SFrank Schaefer data_len -= 4; 663227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 664227b7c90SFrank Schaefer /* Field start (VBI mode) */ 665f0e38230SFrank Schaefer v4l2->capture_type = 0; 666f0e38230SFrank Schaefer v4l2->vbi_read = 0; 667227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 668f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 669227b7c90SFrank Schaefer data_pkt += 4; 670227b7c90SFrank Schaefer data_len -= 4; 671227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 672227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 673f0e38230SFrank Schaefer v4l2->capture_type = 2; 674227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 675f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 676227b7c90SFrank Schaefer data_pkt += 4; 677227b7c90SFrank Schaefer data_len -= 4; 678227b7c90SFrank Schaefer } 679227b7c90SFrank Schaefer } 680227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 681227b7c90SFrank Schaefer * have no continuation header */ 682227b7c90SFrank Schaefer 683f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 684227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 685227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 686f0e38230SFrank Schaefer v4l2->capture_type = 1; 687227b7c90SFrank Schaefer } 688227b7c90SFrank Schaefer 689f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 690753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 691f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 692f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 693227b7c90SFrank Schaefer 694227b7c90SFrank Schaefer /* Copy VBI data */ 695227b7c90SFrank Schaefer if (vbi_buf != NULL) 696227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 697f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 698227b7c90SFrank Schaefer 699227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 700227b7c90SFrank Schaefer /* Continue with copying video data */ 701f0e38230SFrank Schaefer v4l2->capture_type = 2; 702227b7c90SFrank Schaefer data_pkt += vbi_data_len; 703227b7c90SFrank Schaefer data_len -= vbi_data_len; 704227b7c90SFrank Schaefer } 705227b7c90SFrank Schaefer } 706227b7c90SFrank Schaefer 707f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 708227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 709227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 710f0e38230SFrank Schaefer v4l2->capture_type = 3; 711227b7c90SFrank Schaefer } 712227b7c90SFrank Schaefer 713f0e38230SFrank Schaefer if (v4l2->capture_type == 3 && buf != NULL && data_len > 0) 714227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 715227b7c90SFrank Schaefer } 716227b7c90SFrank Schaefer 717e507e0e5SFrank Schaefer /* 718e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 719e507e0e5SFrank Schaefer */ 720e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 721e507e0e5SFrank Schaefer unsigned char *data_pkt, 722e507e0e5SFrank Schaefer unsigned int data_len) 723e507e0e5SFrank Schaefer { 724e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 725e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 726f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7277e6c8c19SMauro Carvalho Chehab bool frame_end = false; 728e507e0e5SFrank Schaefer 729e507e0e5SFrank Schaefer /* Check for header */ 730e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 731e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 732e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 733e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 734e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 735f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 736e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 737e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 738e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 739e507e0e5SFrank Schaefer data_pkt += 2; 740e507e0e5SFrank Schaefer data_len -= 2; 741e507e0e5SFrank Schaefer } 742e507e0e5SFrank Schaefer 743e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 744e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 745e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 746e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 747e507e0e5SFrank Schaefer } 748e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 749e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 750e507e0e5SFrank Schaefer * first frame. 751e507e0e5SFrank Schaefer */ 752e507e0e5SFrank Schaefer } 753e507e0e5SFrank Schaefer 754e507e0e5SFrank Schaefer /* Copy data */ 755e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 756e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 757e507e0e5SFrank Schaefer 758e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 759e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 760e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 761e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 762e507e0e5SFrank Schaefer } 763e507e0e5SFrank Schaefer 764e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 765e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 766e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 767e507e0e5SFrank Schaefer * header like with the other em28xx devices. 768e507e0e5SFrank Schaefer */ 769e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 770e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 771e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 772e507e0e5SFrank Schaefer } 773e507e0e5SFrank Schaefer 774960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7750fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7760c0d06caSMauro Carvalho Chehab { 777227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 778227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 779227b7c90SFrank Schaefer unsigned int usb_data_len; 7800c0d06caSMauro Carvalho Chehab 7810c0d06caSMauro Carvalho Chehab if (!dev) 7820c0d06caSMauro Carvalho Chehab return 0; 7830c0d06caSMauro Carvalho Chehab 7842665c299SFrank Schaefer if (dev->disconnected) 7850c0d06caSMauro Carvalho Chehab return 0; 7860c0d06caSMauro Carvalho Chehab 7871653cb0cSFrank Schaefer if (urb->status < 0) 7880c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7890c0d06caSMauro Carvalho Chehab 7904601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7914601cc39SFrank Schaefer 7924601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7934601cc39SFrank Schaefer num_packets = 1; 7944601cc39SFrank Schaefer else /* isoc */ 7954601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7960c0d06caSMauro Carvalho Chehab 7974601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7984601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 799227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 8004601cc39SFrank Schaefer 801227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 8024601cc39SFrank Schaefer } else { /* isoc */ 8034601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 8044601cc39SFrank Schaefer print_err_status(dev, i, 8054601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8060c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8070c0d06caSMauro Carvalho Chehab continue; 8080c0d06caSMauro Carvalho Chehab } 8090c0d06caSMauro Carvalho Chehab 810227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 811227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8120c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8130c0d06caSMauro Carvalho Chehab continue; 8140c0d06caSMauro Carvalho Chehab } 8150c0d06caSMauro Carvalho Chehab 816227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8174601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8184601cc39SFrank Schaefer } 8194601cc39SFrank Schaefer 820227b7c90SFrank Schaefer if (usb_data_len == 0) { 8214601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8224601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8234601cc39SFrank Schaefer continue; 8244601cc39SFrank Schaefer } 8250c0d06caSMauro Carvalho Chehab 826e507e0e5SFrank Schaefer if (dev->is_em25xx) 827e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 828e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 829e507e0e5SFrank Schaefer else 830e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 831e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 832e507e0e5SFrank Schaefer 8330c0d06caSMauro Carvalho Chehab } 834227b7c90SFrank Schaefer return 1; 8350c0d06caSMauro Carvalho Chehab } 8360c0d06caSMauro Carvalho Chehab 837d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 838d3829fadSDevin Heitmueller { 839d3829fadSDevin Heitmueller switch (f_type) { 840d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 841d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 842d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 843d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 844d3829fadSDevin Heitmueller default: 845d3829fadSDevin Heitmueller BUG(); 846d3829fadSDevin Heitmueller } 847d3829fadSDevin Heitmueller } 848d3829fadSDevin Heitmueller 849d3829fadSDevin Heitmueller /* Usage lock check functions */ 850d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 851d3829fadSDevin Heitmueller { 852d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 853d3829fadSDevin Heitmueller 854d3829fadSDevin Heitmueller /* is it free? */ 855d3829fadSDevin Heitmueller if (dev->resources & res_type) { 856d3829fadSDevin Heitmueller /* no, someone else uses it */ 857d3829fadSDevin Heitmueller return -EBUSY; 858d3829fadSDevin Heitmueller } 859d3829fadSDevin Heitmueller 860d3829fadSDevin Heitmueller /* it's free, grab it */ 861d3829fadSDevin Heitmueller dev->resources |= res_type; 862d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 863d3829fadSDevin Heitmueller return 0; 864d3829fadSDevin Heitmueller } 865d3829fadSDevin Heitmueller 866d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 867d3829fadSDevin Heitmueller { 868d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 869d3829fadSDevin Heitmueller 870d3829fadSDevin Heitmueller dev->resources &= ~res_type; 871d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 872d3829fadSDevin Heitmueller } 873d3829fadSDevin Heitmueller 87437ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev) 87537ecc7b1SMauro Carvalho Chehab { 87637ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 87737ecc7b1SMauro Carvalho Chehab int i; 87837ecc7b1SMauro Carvalho Chehab 87937ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 88037ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 88137ecc7b1SMauro Carvalho Chehab return; 88237ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]); 88337ecc7b1SMauro Carvalho Chehab } 88437ecc7b1SMauro Carvalho Chehab #endif 88537ecc7b1SMauro Carvalho Chehab } 88637ecc7b1SMauro Carvalho Chehab 88737ecc7b1SMauro Carvalho Chehab /* 88837ecc7b1SMauro Carvalho Chehab * Media Controller helper functions 88937ecc7b1SMauro Carvalho Chehab */ 89037ecc7b1SMauro Carvalho Chehab 89137ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev) 89237ecc7b1SMauro Carvalho Chehab { 89337ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 89437ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev; 89537ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 89637ecc7b1SMauro Carvalho Chehab struct media_entity *source; 89737ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL; 89837ecc7b1SMauro Carvalho Chehab int ret, active_links = 0; 89937ecc7b1SMauro Carvalho Chehab 90037ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder) 90137ecc7b1SMauro Carvalho Chehab return 0; 90237ecc7b1SMauro Carvalho Chehab 90337ecc7b1SMauro Carvalho Chehab /* 90437ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder. 90537ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be 90637ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't 90737ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2, 90837ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs. 90937ecc7b1SMauro Carvalho Chehab */ 91037ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) { 91137ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) { 91237ecc7b1SMauro Carvalho Chehab found_link = link; 91337ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED) 91437ecc7b1SMauro Carvalho Chehab active_links++; 91537ecc7b1SMauro Carvalho Chehab break; 91637ecc7b1SMauro Carvalho Chehab } 91737ecc7b1SMauro Carvalho Chehab } 91837ecc7b1SMauro Carvalho Chehab 91937ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link) 92037ecc7b1SMauro Carvalho Chehab return 0; 92137ecc7b1SMauro Carvalho Chehab 92237ecc7b1SMauro Carvalho Chehab source = found_link->source->entity; 92337ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) { 92437ecc7b1SMauro Carvalho Chehab struct media_entity *sink; 92537ecc7b1SMauro Carvalho Chehab int flags = 0; 92637ecc7b1SMauro Carvalho Chehab 92737ecc7b1SMauro Carvalho Chehab sink = link->sink->entity; 92837ecc7b1SMauro Carvalho Chehab 92937ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder) 93037ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED; 93137ecc7b1SMauro Carvalho Chehab 93237ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags); 93337ecc7b1SMauro Carvalho Chehab if (ret) { 93429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 935ce8591ffSMauro Carvalho Chehab "Couldn't change link %s->%s to %s. Error %d\n", 93637ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93737ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled", 93837ecc7b1SMauro Carvalho Chehab ret); 93937ecc7b1SMauro Carvalho Chehab return ret; 94037ecc7b1SMauro Carvalho Chehab } else 94137ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n", 94237ecc7b1SMauro Carvalho Chehab source->name, sink->name, 94337ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled"); 94437ecc7b1SMauro Carvalho Chehab } 94537ecc7b1SMauro Carvalho Chehab #endif 94637ecc7b1SMauro Carvalho Chehab return 0; 94737ecc7b1SMauro Carvalho Chehab } 94837ecc7b1SMauro Carvalho Chehab 94937ecc7b1SMauro Carvalho Chehab static const char * const iname[] = { 95037ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite", 95137ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 95237ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 95337ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio", 95437ecc7b1SMauro Carvalho Chehab }; 95537ecc7b1SMauro Carvalho Chehab 95637ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev) 95737ecc7b1SMauro Carvalho Chehab { 95837ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER) 95937ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 96037ecc7b1SMauro Carvalho Chehab int ret, i; 96137ecc7b1SMauro Carvalho Chehab 96237ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */ 96337ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK; 96437ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad); 96537ecc7b1SMauro Carvalho Chehab if (ret < 0) 96629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 967ce8591ffSMauro Carvalho Chehab "failed to initialize video media entity!\n"); 96837ecc7b1SMauro Carvalho Chehab 96937ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) { 97037ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK; 97137ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1, 97237ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad); 97337ecc7b1SMauro Carvalho Chehab if (ret < 0) 97429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 975ce8591ffSMauro Carvalho Chehab "failed to initialize vbi media entity!\n"); 97637ecc7b1SMauro Carvalho Chehab } 97737ecc7b1SMauro Carvalho Chehab 97837ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */ 979aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 98037ecc7b1SMauro Carvalho Chehab return; 98137ecc7b1SMauro Carvalho Chehab 98237ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */ 98337ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 98437ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i]; 98537ecc7b1SMauro Carvalho Chehab 98637ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 98737ecc7b1SMauro Carvalho Chehab break; 98837ecc7b1SMauro Carvalho Chehab 98937ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type]; 99037ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR; 99137ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 99237ecc7b1SMauro Carvalho Chehab 99337ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) { 99437ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE: 99537ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 99637ecc7b1SMauro Carvalho Chehab break; 99737ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO: 99837ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO; 99937ecc7b1SMauro Carvalho Chehab break; 100037ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */ 1001e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 100237ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF; 100337ecc7b1SMauro Carvalho Chehab break; 100437ecc7b1SMauro Carvalho Chehab } 100537ecc7b1SMauro Carvalho Chehab 100637ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 100737ecc7b1SMauro Carvalho Chehab if (ret < 0) 100829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1009ce8591ffSMauro Carvalho Chehab "failed to initialize input pad[%d]!\n", i); 101037ecc7b1SMauro Carvalho Chehab 101137ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent); 101237ecc7b1SMauro Carvalho Chehab if (ret < 0) 101329b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1014ce8591ffSMauro Carvalho Chehab "failed to register input entity %d!\n", i); 101537ecc7b1SMauro Carvalho Chehab } 101637ecc7b1SMauro Carvalho Chehab #endif 101737ecc7b1SMauro Carvalho Chehab } 101837ecc7b1SMauro Carvalho Chehab 101937ecc7b1SMauro Carvalho Chehab 10200c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1021d3829fadSDevin Heitmueller Videobuf2 operations 10220c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 10230c0d06caSMauro Carvalho Chehab 1024df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq, 1025d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 102636c0f8b3SHans Verkuil unsigned int sizes[], struct device *alloc_devs[]) 10270c0d06caSMauro Carvalho Chehab { 1028d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1029753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1030df9ecb0cSHans Verkuil unsigned long size = 103106e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 10320c0d06caSMauro Carvalho Chehab 1033df9ecb0cSHans Verkuil if (*nplanes) 1034df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0; 1035d3829fadSDevin Heitmueller *nplanes = 1; 1036d3829fadSDevin Heitmueller sizes[0] = size; 103737ecc7b1SMauro Carvalho Chehab 103837ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev); 103937ecc7b1SMauro Carvalho Chehab 10400c0d06caSMauro Carvalho Chehab return 0; 10410c0d06caSMauro Carvalho Chehab } 10420c0d06caSMauro Carvalho Chehab 10430c0d06caSMauro Carvalho Chehab static int 1044d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 10450c0d06caSMauro Carvalho Chehab { 10462d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1047d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1048753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1049d3829fadSDevin Heitmueller unsigned long size; 10500c0d06caSMauro Carvalho Chehab 10512d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field); 10520c0d06caSMauro Carvalho Chehab 105306e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 1054d3829fadSDevin Heitmueller 1055d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 1056d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 1057d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 10580c0d06caSMauro Carvalho Chehab return -EINVAL; 1059d3829fadSDevin Heitmueller } 10602d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size); 10610c0d06caSMauro Carvalho Chehab 1062d3829fadSDevin Heitmueller return 0; 10630c0d06caSMauro Carvalho Chehab } 10640c0d06caSMauro Carvalho Chehab 1065d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 1066d3829fadSDevin Heitmueller { 1067d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1068f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1069d3829fadSDevin Heitmueller struct v4l2_frequency f; 10702d700715SJunghak Sung struct v4l2_fh *owner; 1071d3829fadSDevin Heitmueller int rc = 0; 10720c0d06caSMauro Carvalho Chehab 1073d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1074d3829fadSDevin Heitmueller 1075d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 1076d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 1077d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1078d3829fadSDevin Heitmueller if (rc) 1079d3829fadSDevin Heitmueller return rc; 1080d3829fadSDevin Heitmueller 10818139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1082d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1083d3829fadSDevin Heitmueller 1084d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1085d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1086d3829fadSDevin Heitmueller 1087d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 1088d3829fadSDevin Heitmueller some i2c device 1089d3829fadSDevin Heitmueller */ 1090d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1091d3829fadSDevin Heitmueller 1092f0e38230SFrank Schaefer v4l2->capture_type = -1; 1093c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1094c647a91aSFrank Schaefer dev->analog_xfer_bulk, 10950c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 10960c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1097c647a91aSFrank Schaefer dev->packet_multiplier, 10980fa4a402SFrank Schaefer em28xx_urb_data_copy); 10990c0d06caSMauro Carvalho Chehab if (rc < 0) 1100032f1ddfSFrank Schaefer return rc; 1101d3829fadSDevin Heitmueller 1102d3829fadSDevin Heitmueller /* 1103d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1104d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1105d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1106d3829fadSDevin Heitmueller */ 1107d3829fadSDevin Heitmueller 1108d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1109d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11103854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11112d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11122d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1113d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1114d3829fadSDevin Heitmueller else 1115d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1116f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 111795d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 111813d52fe4SMauro Carvalho Chehab 111913d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 112013d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11210c0d06caSMauro Carvalho Chehab } 11220c0d06caSMauro Carvalho Chehab 11238139a4d5SFrank Schaefer v4l2->streaming_users++; 1124032f1ddfSFrank Schaefer 11250c0d06caSMauro Carvalho Chehab return rc; 11260c0d06caSMauro Carvalho Chehab } 11270c0d06caSMauro Carvalho Chehab 1128e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11290c0d06caSMauro Carvalho Chehab { 1130d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11318139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11320c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1133d3829fadSDevin Heitmueller unsigned long flags = 0; 11340c0d06caSMauro Carvalho Chehab 1135d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11360c0d06caSMauro Carvalho Chehab 1137d3829fadSDevin Heitmueller res_free(dev, vq->type); 1138d3829fadSDevin Heitmueller 11398139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 114013d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 114113d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 114213d52fe4SMauro Carvalho Chehab 1143d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1144d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11450c0d06caSMauro Carvalho Chehab } 11460c0d06caSMauro Carvalho Chehab 1147d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1148627530c3SFrank Schaefer if (dev->usb_ctl.vid_buf != NULL) { 11492d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11502d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1151627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1152627530c3SFrank Schaefer } 1153d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1154d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1155fdf1bc9fSMauro Carvalho Chehab 1156d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1157d3829fadSDevin Heitmueller list_del(&buf->list); 11582d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1159d3829fadSDevin Heitmueller } 1160d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1161d3829fadSDevin Heitmueller } 1162d3829fadSDevin Heitmueller 1163e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11640c0d06caSMauro Carvalho Chehab { 1165d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11668139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1167d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1168d3829fadSDevin Heitmueller unsigned long flags = 0; 11690c0d06caSMauro Carvalho Chehab 1170d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11710c0d06caSMauro Carvalho Chehab 1172d3829fadSDevin Heitmueller res_free(dev, vq->type); 1173d3829fadSDevin Heitmueller 11748139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 117513d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 117613d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 117713d52fe4SMauro Carvalho Chehab 1178d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1179d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11800c0d06caSMauro Carvalho Chehab } 11810c0d06caSMauro Carvalho Chehab 1182d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1183627530c3SFrank Schaefer if (dev->usb_ctl.vbi_buf != NULL) { 11842d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 11852d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1186627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1187627530c3SFrank Schaefer } 1188d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1189d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1190fdf1bc9fSMauro Carvalho Chehab 1191d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1192d3829fadSDevin Heitmueller list_del(&buf->list); 11932d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1194d3829fadSDevin Heitmueller } 1195d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1196d3829fadSDevin Heitmueller } 1197d3829fadSDevin Heitmueller 1198d3829fadSDevin Heitmueller static void 1199d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1200d3829fadSDevin Heitmueller { 12012d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1202d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 12032d700715SJunghak Sung struct em28xx_buffer *buf = 12042d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1205d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1206d3829fadSDevin Heitmueller unsigned long flags = 0; 1207d3829fadSDevin Heitmueller 1208d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1209d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1210d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1211d3829fadSDevin Heitmueller 1212d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1213d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1214d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1215d3829fadSDevin Heitmueller } 1216d3829fadSDevin Heitmueller 12171bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = { 1218d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12190c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12200c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1221d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1222d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1223d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1224d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12250c0d06caSMauro Carvalho Chehab }; 12260c0d06caSMauro Carvalho Chehab 122701c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1228d3829fadSDevin Heitmueller { 1229d3829fadSDevin Heitmueller int rc; 1230d3829fadSDevin Heitmueller struct vb2_queue *q; 123127a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1232d3829fadSDevin Heitmueller 1233d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 123427a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1235d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1236ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1237ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1238d3829fadSDevin Heitmueller q->drv_priv = dev; 1239d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1240d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1241d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1242d3829fadSDevin Heitmueller 1243d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1244d3829fadSDevin Heitmueller if (rc < 0) 1245d3829fadSDevin Heitmueller return rc; 1246d3829fadSDevin Heitmueller 1247d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 124827a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1249d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1250d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1251ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1252d3829fadSDevin Heitmueller q->drv_priv = dev; 1253d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1254d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1255d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1256d3829fadSDevin Heitmueller 1257d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1258d3829fadSDevin Heitmueller if (rc < 0) 1259d3829fadSDevin Heitmueller return rc; 1260d3829fadSDevin Heitmueller 1261d3829fadSDevin Heitmueller return 0; 1262d3829fadSDevin Heitmueller } 1263d3829fadSDevin Heitmueller 12640c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 12650c0d06caSMauro Carvalho Chehab 12660c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12670c0d06caSMauro Carvalho Chehab { 126895d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1269fdf1bc9fSMauro Carvalho Chehab 12700c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12710c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 12720c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 12730c0d06caSMauro Carvalho Chehab 12740c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 12750c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 12760c0d06caSMauro Carvalho Chehab 127795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 12780c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 12790c0d06caSMauro Carvalho Chehab 1280aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 12810c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 128295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 12830c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 12840c0d06caSMauro Carvalho Chehab } 12850c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 128695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1287fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1288fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 12890c0d06caSMauro Carvalho Chehab } 12900c0d06caSMauro Carvalho Chehab 12910c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 129295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 12930c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 12940c0d06caSMauro Carvalho Chehab } 12950c0d06caSMauro Carvalho Chehab 12960c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 12970c0d06caSMauro Carvalho Chehab } 12980c0d06caSMauro Carvalho Chehab 129901c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 13000c0d06caSMauro Carvalho Chehab { 1301081b945eSHans Verkuil struct em28xx *dev = priv; 13020c0d06caSMauro Carvalho Chehab 13030c0d06caSMauro Carvalho Chehab /* 1304081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1305081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1306081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1307081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 13080c0d06caSMauro Carvalho Chehab */ 13090c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13100c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1311081b945eSHans Verkuil dev->mute = ctrl->val; 1312081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13130c0d06caSMauro Carvalho Chehab break; 13140c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1315081b945eSHans Verkuil dev->volume = ctrl->val; 1316081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1317081b945eSHans Verkuil break; 1318081b945eSHans Verkuil } 1319081b945eSHans Verkuil } 1320081b945eSHans Verkuil 1321081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1322081b945eSHans Verkuil { 1323abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1324abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1325abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13268f8b113aSFrank Schaefer int ret = -EINVAL; 1327081b945eSHans Verkuil 1328081b945eSHans Verkuil switch (ctrl->id) { 1329081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1330081b945eSHans Verkuil dev->mute = ctrl->val; 13318f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1332081b945eSHans Verkuil break; 1333081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1334081b945eSHans Verkuil dev->volume = ctrl->val; 13358f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13368f8b113aSFrank Schaefer break; 13378f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13388f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13398f8b113aSFrank Schaefer break; 13408f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13418f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13428f8b113aSFrank Schaefer break; 13438f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13448f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13458f8b113aSFrank Schaefer break; 13468f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13478f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13488f8b113aSFrank Schaefer break; 13498f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13508f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13518f8b113aSFrank Schaefer break; 13528f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13538f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13540c0d06caSMauro Carvalho Chehab break; 13550c0d06caSMauro Carvalho Chehab } 13560c0d06caSMauro Carvalho Chehab 13578f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13580c0d06caSMauro Carvalho Chehab } 13590c0d06caSMauro Carvalho Chehab 13608068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1361081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1362081b945eSHans Verkuil }; 1363081b945eSHans Verkuil 13646b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13650c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13660c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13670c0d06caSMauro Carvalho Chehab { 13680c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13690c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13700c0d06caSMauro Carvalho Chehab 13710c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 137281685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 137381685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 13740c0d06caSMauro Carvalho Chehab 13750c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 137681685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 137781685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 13780c0d06caSMauro Carvalho Chehab } 13790c0d06caSMauro Carvalho Chehab 1380b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1381b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1382b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1383b8374138SFrank Schaefer { 1384b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1385b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1386b8374138SFrank Schaefer 1387b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1388b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 13890962a763SMauro Carvalho Chehab 13900962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 13910962a763SMauro Carvalho Chehab if (*width < 1) 13920962a763SMauro Carvalho Chehab *width = 1; 13930962a763SMauro Carvalho Chehab if (*height < 1) 13940962a763SMauro Carvalho Chehab *height = 1; 1395b8374138SFrank Schaefer } 1396b8374138SFrank Schaefer 13970c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 13980c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 13990c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 14000c0d06caSMauro Carvalho Chehab 14010c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 14020c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14030c0d06caSMauro Carvalho Chehab { 1404917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1405753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14060c0d06caSMauro Carvalho Chehab 1407753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1408753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 140906e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 141006e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1411753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14120c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14130c0d06caSMauro Carvalho Chehab 14140c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 141558159171SFrank Schaefer if (v4l2->progressive) 14160c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14170c0d06caSMauro Carvalho Chehab else 141858159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14190c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14200c0d06caSMauro Carvalho Chehab return 0; 14210c0d06caSMauro Carvalho Chehab } 14220c0d06caSMauro Carvalho Chehab 14230c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14240c0d06caSMauro Carvalho Chehab { 14250c0d06caSMauro Carvalho Chehab unsigned int i; 14260c0d06caSMauro Carvalho Chehab 14270c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14280c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14290c0d06caSMauro Carvalho Chehab return &format[i]; 14300c0d06caSMauro Carvalho Chehab 14310c0d06caSMauro Carvalho Chehab return NULL; 14320c0d06caSMauro Carvalho Chehab } 14330c0d06caSMauro Carvalho Chehab 14340c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14350c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14360c0d06caSMauro Carvalho Chehab { 1437917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 143858159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14390c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14400c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14410c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14420c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14430c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14440c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14450c0d06caSMauro Carvalho Chehab 14460c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14470c0d06caSMauro Carvalho Chehab if (!fmt) { 14480c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14490c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 14500c0d06caSMauro Carvalho Chehab return -EINVAL; 14510c0d06caSMauro Carvalho Chehab } 14520c0d06caSMauro Carvalho Chehab 14530c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14540c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14550c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14560c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1457d3829fadSDevin Heitmueller /* 1458d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1459d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1460d3829fadSDevin Heitmueller * to 50% 1461d3829fadSDevin Heitmueller */ 14620c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14630c0d06caSMauro Carvalho Chehab width /= 2; 14640c0d06caSMauro Carvalho Chehab } else { 14650c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 14660c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 14670c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14680c0d06caSMauro Carvalho Chehab 1, 0); 14690c0d06caSMauro Carvalho Chehab } 14700962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 14710962a763SMauro Carvalho Chehab if (width < 1) 14720962a763SMauro Carvalho Chehab width = 1; 14730962a763SMauro Carvalho Chehab if (height < 1) 14740962a763SMauro Carvalho Chehab height = 1; 14750c0d06caSMauro Carvalho Chehab 14766b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 147746f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 14780c0d06caSMauro Carvalho Chehab 14790c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 14800c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 14810c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1482e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 14830c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 14840c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 148558159171SFrank Schaefer if (v4l2->progressive) 14860c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14870c0d06caSMauro Carvalho Chehab else 148858159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14890c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 149051dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 14910c0d06caSMauro Carvalho Chehab 14920c0d06caSMauro Carvalho Chehab return 0; 14930c0d06caSMauro Carvalho Chehab } 14940c0d06caSMauro Carvalho Chehab 14950c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 14960c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 14970c0d06caSMauro Carvalho Chehab { 14980c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1499753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15000c0d06caSMauro Carvalho Chehab 15010c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 15020c0d06caSMauro Carvalho Chehab if (!fmt) 15030c0d06caSMauro Carvalho Chehab return -EINVAL; 15040c0d06caSMauro Carvalho Chehab 150506e20672SFrank Schaefer v4l2->format = fmt; 1506753aee77SFrank Schaefer v4l2->width = width; 1507753aee77SFrank Schaefer v4l2->height = height; 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab /* set new image size */ 1510753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1511753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15120c0d06caSMauro Carvalho Chehab 15130c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15140c0d06caSMauro Carvalho Chehab 15150c0d06caSMauro Carvalho Chehab return 0; 15160c0d06caSMauro Carvalho Chehab } 15170c0d06caSMauro Carvalho Chehab 15180c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15190c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15200c0d06caSMauro Carvalho Chehab { 1521d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15228139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15230c0d06caSMauro Carvalho Chehab 1524c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1525d3829fadSDevin Heitmueller return -EBUSY; 15260c0d06caSMauro Carvalho Chehab 15270c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15300c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15310c0d06caSMauro Carvalho Chehab } 15320c0d06caSMauro Carvalho Chehab 15330c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15340c0d06caSMauro Carvalho Chehab { 1535917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15360c0d06caSMauro Carvalho Chehab 153752faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15380c0d06caSMauro Carvalho Chehab 15390c0d06caSMauro Carvalho Chehab return 0; 15400c0d06caSMauro Carvalho Chehab } 15410c0d06caSMauro Carvalho Chehab 15420c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15430c0d06caSMauro Carvalho Chehab { 1544917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15450c0d06caSMauro Carvalho Chehab 154695d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15470c0d06caSMauro Carvalho Chehab 15480c0d06caSMauro Carvalho Chehab return 0; 15490c0d06caSMauro Carvalho Chehab } 15500c0d06caSMauro Carvalho Chehab 1551314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15520c0d06caSMauro Carvalho Chehab { 1553917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1554753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15550c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15560c0d06caSMauro Carvalho Chehab 155752faaf78SFrank Schaefer if (norm == v4l2->norm) 1558d8c95c08SHans Verkuil return 0; 15590c0d06caSMauro Carvalho Chehab 15608139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1561d8c95c08SHans Verkuil return -EBUSY; 1562d8c95c08SHans Verkuil 156352faaf78SFrank Schaefer v4l2->norm = norm; 15640c0d06caSMauro Carvalho Chehab 15650c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1566d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1567314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15680c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15690c0d06caSMauro Carvalho Chehab 15700c0d06caSMauro Carvalho Chehab /* set new image size */ 1571753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1572753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1573753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1574753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15750c0d06caSMauro Carvalho Chehab 15760c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15778774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 15780c0d06caSMauro Carvalho Chehab 15790c0d06caSMauro Carvalho Chehab return 0; 15800c0d06caSMauro Carvalho Chehab } 15810c0d06caSMauro Carvalho Chehab 15820c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 15830c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 15840c0d06caSMauro Carvalho Chehab { 15854471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 0 }; 1586917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 158752faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15880c0d06caSMauro Carvalho Chehab int rc = 0; 15890c0d06caSMauro Carvalho Chehab 15904471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 15914471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 15924471109eSHans Verkuil return -EINVAL; 15934471109eSHans Verkuil 159486ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 15954471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 1596aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 159752faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 15984471109eSHans Verkuil video, g_frame_interval, &ival); 15994471109eSHans Verkuil if (!rc) 16004471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16014471109eSHans Verkuil } else { 160252faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 16030c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 16044471109eSHans Verkuil } 16050c0d06caSMauro Carvalho Chehab 16060c0d06caSMauro Carvalho Chehab return rc; 16070c0d06caSMauro Carvalho Chehab } 16080c0d06caSMauro Carvalho Chehab 16090c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 16100c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16110c0d06caSMauro Carvalho Chehab { 1612917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16134471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 16144471109eSHans Verkuil 0, 16154471109eSHans Verkuil p->parm.capture.timeperframe 16164471109eSHans Verkuil }; 16174471109eSHans Verkuil int rc = 0; 16180c0d06caSMauro Carvalho Chehab 1619aa62980bSMauro Carvalho Chehab if (!dev->is_webcam) 16204471109eSHans Verkuil return -ENOTTY; 16214471109eSHans Verkuil 16224471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16234471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16244471109eSHans Verkuil return -EINVAL; 16254471109eSHans Verkuil 16264471109eSHans Verkuil memset(&p->parm, 0, sizeof(p->parm)); 162786ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16284471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 16294471109eSHans Verkuil rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0, 16304471109eSHans Verkuil video, s_frame_interval, &ival); 16314471109eSHans Verkuil if (!rc) 16324471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16334471109eSHans Verkuil return rc; 16340c0d06caSMauro Carvalho Chehab } 16350c0d06caSMauro Carvalho Chehab 16360c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16370c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16380c0d06caSMauro Carvalho Chehab { 1639917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16400c0d06caSMauro Carvalho Chehab unsigned int n; 16410c0d06caSMauro Carvalho Chehab 16420c0d06caSMauro Carvalho Chehab n = i->index; 16430c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16440c0d06caSMauro Carvalho Chehab return -EINVAL; 16450c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 16460c0d06caSMauro Carvalho Chehab return -EINVAL; 16470c0d06caSMauro Carvalho Chehab 16480c0d06caSMauro Carvalho Chehab i->index = n; 16490c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16500c0d06caSMauro Carvalho Chehab 16510c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 16520c0d06caSMauro Carvalho Chehab 1653d83a96a5SMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type)) 16540c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16550c0d06caSMauro Carvalho Chehab 1656d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1657d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1658aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1659d8c95c08SHans Verkuil i->capabilities = 0; 16600c0d06caSMauro Carvalho Chehab 16610c0d06caSMauro Carvalho Chehab return 0; 16620c0d06caSMauro Carvalho Chehab } 16630c0d06caSMauro Carvalho Chehab 16640c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16650c0d06caSMauro Carvalho Chehab { 1666917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16670c0d06caSMauro Carvalho Chehab 16680c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 16690c0d06caSMauro Carvalho Chehab 16700c0d06caSMauro Carvalho Chehab return 0; 16710c0d06caSMauro Carvalho Chehab } 16720c0d06caSMauro Carvalho Chehab 16730c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 16740c0d06caSMauro Carvalho Chehab { 1675917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16760c0d06caSMauro Carvalho Chehab 16770c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 16780c0d06caSMauro Carvalho Chehab return -EINVAL; 16790c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 16800c0d06caSMauro Carvalho Chehab return -EINVAL; 16810c0d06caSMauro Carvalho Chehab 16820c0d06caSMauro Carvalho Chehab video_mux(dev, i); 16830c0d06caSMauro Carvalho Chehab return 0; 16840c0d06caSMauro Carvalho Chehab } 16850c0d06caSMauro Carvalho Chehab 16860c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 16870c0d06caSMauro Carvalho Chehab { 1688917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16890c0d06caSMauro Carvalho Chehab 16900c0d06caSMauro Carvalho Chehab switch (a->index) { 16910c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 16920c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 16930c0d06caSMauro Carvalho Chehab break; 16940c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 16950c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 16960c0d06caSMauro Carvalho Chehab break; 16970c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 16980c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 16990c0d06caSMauro Carvalho Chehab break; 17000c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 17010c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 17020c0d06caSMauro Carvalho Chehab break; 17030c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 17040c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 17050c0d06caSMauro Carvalho Chehab break; 17060c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 17070c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 17080c0d06caSMauro Carvalho Chehab break; 17090c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 17100c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 17110c0d06caSMauro Carvalho Chehab break; 17120c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 17130c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 17140c0d06caSMauro Carvalho Chehab break; 17150c0d06caSMauro Carvalho Chehab default: 17160c0d06caSMauro Carvalho Chehab return -EINVAL; 17170c0d06caSMauro Carvalho Chehab } 17180c0d06caSMauro Carvalho Chehab 17190c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 17200c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 17210c0d06caSMauro Carvalho Chehab 17220c0d06caSMauro Carvalho Chehab return 0; 17230c0d06caSMauro Carvalho Chehab } 17240c0d06caSMauro Carvalho Chehab 17250e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 17260c0d06caSMauro Carvalho Chehab { 1727917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17280c0d06caSMauro Carvalho Chehab 17290c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 17300c0d06caSMauro Carvalho Chehab return -EINVAL; 17310c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 17320c0d06caSMauro Carvalho Chehab return -EINVAL; 17330c0d06caSMauro Carvalho Chehab 17340c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 17350c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 17360c0d06caSMauro Carvalho Chehab 17370c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 17380c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 17390c0d06caSMauro Carvalho Chehab 17400c0d06caSMauro Carvalho Chehab return 0; 17410c0d06caSMauro Carvalho Chehab } 17420c0d06caSMauro Carvalho Chehab 17430c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 17440c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17450c0d06caSMauro Carvalho Chehab { 1746917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17470c0d06caSMauro Carvalho Chehab 17480c0d06caSMauro Carvalho Chehab if (0 != t->index) 17490c0d06caSMauro Carvalho Chehab return -EINVAL; 17500c0d06caSMauro Carvalho Chehab 17510c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 17520c0d06caSMauro Carvalho Chehab 175395d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 17540c0d06caSMauro Carvalho Chehab return 0; 17550c0d06caSMauro Carvalho Chehab } 17560c0d06caSMauro Carvalho Chehab 17570c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 17582f73c7c5SHans Verkuil const struct v4l2_tuner *t) 17590c0d06caSMauro Carvalho Chehab { 1760917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17610c0d06caSMauro Carvalho Chehab 17620c0d06caSMauro Carvalho Chehab if (0 != t->index) 17630c0d06caSMauro Carvalho Chehab return -EINVAL; 17640c0d06caSMauro Carvalho Chehab 176595d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 17660c0d06caSMauro Carvalho Chehab return 0; 17670c0d06caSMauro Carvalho Chehab } 17680c0d06caSMauro Carvalho Chehab 17690c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 17700c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 17710c0d06caSMauro Carvalho Chehab { 1772917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17733854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17740c0d06caSMauro Carvalho Chehab 177520deebfeSHans Verkuil if (0 != f->tuner) 177620deebfeSHans Verkuil return -EINVAL; 177720deebfeSHans Verkuil 17783854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 17790c0d06caSMauro Carvalho Chehab return 0; 17800c0d06caSMauro Carvalho Chehab } 17810c0d06caSMauro Carvalho Chehab 17820c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1783b530a447SHans Verkuil const struct v4l2_frequency *f) 17840c0d06caSMauro Carvalho Chehab { 1785b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1786917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 178795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17880c0d06caSMauro Carvalho Chehab 17890c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 17900c0d06caSMauro Carvalho Chehab return -EINVAL; 17910c0d06caSMauro Carvalho Chehab 179295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 179395d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 17943854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 17950c0d06caSMauro Carvalho Chehab 17960c0d06caSMauro Carvalho Chehab return 0; 17970c0d06caSMauro Carvalho Chehab } 17980c0d06caSMauro Carvalho Chehab 1799cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 180096b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 180196b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 18023b2d17b4SHans Verkuil { 1803917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18043b2d17b4SHans Verkuil 18053b2d17b4SHans Verkuil if (chip->match.addr > 1) 18063b2d17b4SHans Verkuil return -EINVAL; 18073b2d17b4SHans Verkuil if (chip->match.addr == 1) 18083b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 18093b2d17b4SHans Verkuil else 181095d2608bSFrank Schaefer strlcpy(chip->name, 181195d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 18123b2d17b4SHans Verkuil return 0; 18133b2d17b4SHans Verkuil } 18143b2d17b4SHans Verkuil 181535deba32SFrank Schaefer static int em28xx_reg_len(int reg) 181635deba32SFrank Schaefer { 181735deba32SFrank Schaefer switch (reg) { 181835deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 181935deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 182035deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 182135deba32SFrank Schaefer return 2; 182235deba32SFrank Schaefer default: 182335deba32SFrank Schaefer return 1; 182435deba32SFrank Schaefer } 182535deba32SFrank Schaefer } 18260c0d06caSMauro Carvalho Chehab 18270c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 18280c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 18290c0d06caSMauro Carvalho Chehab { 1830917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18310c0d06caSMauro Carvalho Chehab int ret; 18320c0d06caSMauro Carvalho Chehab 18333b2d17b4SHans Verkuil if (reg->match.addr > 1) 18343b2d17b4SHans Verkuil return -EINVAL; 1835abca2056SHans Verkuil if (reg->match.addr) { 18360c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 18370c0d06caSMauro Carvalho Chehab if (ret < 0) 18380c0d06caSMauro Carvalho Chehab return ret; 18390c0d06caSMauro Carvalho Chehab 18400c0d06caSMauro Carvalho Chehab reg->val = ret; 18410c0d06caSMauro Carvalho Chehab reg->size = 1; 18420c0d06caSMauro Carvalho Chehab return 0; 18430c0d06caSMauro Carvalho Chehab } 18440c0d06caSMauro Carvalho Chehab 18450c0d06caSMauro Carvalho Chehab /* Match host */ 18460c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 18470c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 18480c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 18490c0d06caSMauro Carvalho Chehab 18500c0d06caSMauro Carvalho Chehab if (ret < 0) 18510c0d06caSMauro Carvalho Chehab return ret; 18520c0d06caSMauro Carvalho Chehab 18530c0d06caSMauro Carvalho Chehab reg->val = ret; 18540c0d06caSMauro Carvalho Chehab } else { 18550c0d06caSMauro Carvalho Chehab __le16 val = 0; 1856fdf1bc9fSMauro Carvalho Chehab 185701c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 18580c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 18590c0d06caSMauro Carvalho Chehab if (ret < 0) 18600c0d06caSMauro Carvalho Chehab return ret; 18610c0d06caSMauro Carvalho Chehab 18620c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 18630c0d06caSMauro Carvalho Chehab } 18640c0d06caSMauro Carvalho Chehab 18650c0d06caSMauro Carvalho Chehab return 0; 18660c0d06caSMauro Carvalho Chehab } 18670c0d06caSMauro Carvalho Chehab 18680c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1869977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 18700c0d06caSMauro Carvalho Chehab { 1871917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18720c0d06caSMauro Carvalho Chehab __le16 buf; 18730c0d06caSMauro Carvalho Chehab 18743b2d17b4SHans Verkuil if (reg->match.addr > 1) 18753b2d17b4SHans Verkuil return -EINVAL; 1876abca2056SHans Verkuil if (reg->match.addr) 18770c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 18780c0d06caSMauro Carvalho Chehab 18790c0d06caSMauro Carvalho Chehab /* Match host */ 18800c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 18810c0d06caSMauro Carvalho Chehab 18820c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 18830c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 18840c0d06caSMauro Carvalho Chehab } 18850c0d06caSMauro Carvalho Chehab #endif 18860c0d06caSMauro Carvalho Chehab 18870c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 18880c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 18890c0d06caSMauro Carvalho Chehab { 1890a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1891917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1892ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1893c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 18940c0d06caSMauro Carvalho Chehab 18950c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 18960c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1897c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 18980c0d06caSMauro Carvalho Chehab 1899a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1900a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1901a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1902a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1903a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1904a9d79fe5SHans Verkuil else 19051d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 19060c0d06caSMauro Carvalho Chehab 1907920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 1908a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 19090c0d06caSMauro Carvalho Chehab 19100c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1911a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 19120c0d06caSMauro Carvalho Chehab 1913a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1914a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1915d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 19161d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1917d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 1918a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 19190c0d06caSMauro Carvalho Chehab return 0; 19200c0d06caSMauro Carvalho Chehab } 19210c0d06caSMauro Carvalho Chehab 19220c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 19230c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 19240c0d06caSMauro Carvalho Chehab { 19250c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 19260c0d06caSMauro Carvalho Chehab return -EINVAL; 19270c0d06caSMauro Carvalho Chehab 19280c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 19290c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 19300c0d06caSMauro Carvalho Chehab 19310c0d06caSMauro Carvalho Chehab return 0; 19320c0d06caSMauro Carvalho Chehab } 19330c0d06caSMauro Carvalho Chehab 19340c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 19350c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 19360c0d06caSMauro Carvalho Chehab { 1937917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19380c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 19390c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 19400c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 19410c0d06caSMauro Carvalho Chehab 19420c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 19430c0d06caSMauro Carvalho Chehab if (!fmt) { 19440c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 19450c0d06caSMauro Carvalho Chehab fsize->pixel_format); 19460c0d06caSMauro Carvalho Chehab return -EINVAL; 19470c0d06caSMauro Carvalho Chehab } 19480c0d06caSMauro Carvalho Chehab 19490c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 19500c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 19510c0d06caSMauro Carvalho Chehab return -EINVAL; 19520c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 19530c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 19540c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 19550c0d06caSMauro Carvalho Chehab return 0; 19560c0d06caSMauro Carvalho Chehab } 19570c0d06caSMauro Carvalho Chehab 19580c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 19590c0d06caSMauro Carvalho Chehab return -EINVAL; 19600c0d06caSMauro Carvalho Chehab 19610c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 19620c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 19636c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 19646c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 19656c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 19660c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 19676c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 19686c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 19690c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 19700c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 19710c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 19720c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 19730c0d06caSMauro Carvalho Chehab return 0; 19740c0d06caSMauro Carvalho Chehab } 19750c0d06caSMauro Carvalho Chehab 19760c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 19770c0d06caSMauro Carvalho Chehab 19780c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 19790c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 19800c0d06caSMauro Carvalho Chehab { 1981917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1982753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 19830c0d06caSMauro Carvalho Chehab 1984753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 19850c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 19860c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 19870c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 19880c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1989753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1990753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 19912a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 19920c0d06caSMauro Carvalho Chehab 19930c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 199452faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 19950c0d06caSMauro Carvalho Chehab /* NTSC */ 19960c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 19970c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 199852faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 19990c0d06caSMauro Carvalho Chehab /* PAL */ 20000c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 20010c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 20020c0d06caSMauro Carvalho Chehab } 20030c0d06caSMauro Carvalho Chehab 20040c0d06caSMauro Carvalho Chehab return 0; 20050c0d06caSMauro Carvalho Chehab } 20060c0d06caSMauro Carvalho Chehab 20070c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 20080c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 20090c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 20100c0d06caSMauro Carvalho Chehab 20110c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 20120c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 20130c0d06caSMauro Carvalho Chehab { 2014917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20150c0d06caSMauro Carvalho Chehab 20160c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 20170c0d06caSMauro Carvalho Chehab return -EINVAL; 20180c0d06caSMauro Carvalho Chehab 20190c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 20200c0d06caSMauro Carvalho Chehab 202195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 20220c0d06caSMauro Carvalho Chehab 20230c0d06caSMauro Carvalho Chehab return 0; 20240c0d06caSMauro Carvalho Chehab } 20250c0d06caSMauro Carvalho Chehab 20260c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 20272f73c7c5SHans Verkuil const struct v4l2_tuner *t) 20280c0d06caSMauro Carvalho Chehab { 2029917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20300c0d06caSMauro Carvalho Chehab 20310c0d06caSMauro Carvalho Chehab if (0 != t->index) 20320c0d06caSMauro Carvalho Chehab return -EINVAL; 20330c0d06caSMauro Carvalho Chehab 203495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 20350c0d06caSMauro Carvalho Chehab 20360c0d06caSMauro Carvalho Chehab return 0; 20370c0d06caSMauro Carvalho Chehab } 20380c0d06caSMauro Carvalho Chehab 20390c0d06caSMauro Carvalho Chehab /* 204095d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 204195d2608bSFrank Schaefer * 204295d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 204395d2608bSFrank Schaefer * 204495d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 204595d2608bSFrank Schaefer */ 2046f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 204795d2608bSFrank Schaefer { 204895d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 204995d2608bSFrank Schaefer 2050abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 205195d2608bSFrank Schaefer kfree(v4l2); 205295d2608bSFrank Schaefer } 205395d2608bSFrank Schaefer 205495d2608bSFrank Schaefer /* 20550c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 20560c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 20570c0d06caSMauro Carvalho Chehab */ 20580c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 20590c0d06caSMauro Carvalho Chehab { 20600c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 20610c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 206295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20630c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 20643c0f90e1SFrank Schaefer int ret; 20650c0d06caSMauro Carvalho Chehab 20660c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 20670c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 20680c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 20690c0d06caSMauro Carvalho Chehab break; 20700c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 20710c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 20720c0d06caSMauro Carvalho Chehab break; 20734e170240SFrank Schaefer case VFL_TYPE_RADIO: 20744e170240SFrank Schaefer break; 20754e170240SFrank Schaefer default: 20764e170240SFrank Schaefer return -EINVAL; 20770c0d06caSMauro Carvalho Chehab } 20780c0d06caSMauro Carvalho Chehab 20798e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 20808e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 20818e2c8717SFrank Schaefer v4l2->users); 20820c0d06caSMauro Carvalho Chehab 20830c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 20840c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 20853c0f90e1SFrank Schaefer 20863c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 20873c0f90e1SFrank Schaefer if (ret) { 208829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2089ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 20903c0f90e1SFrank Schaefer __func__, ret); 20910c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20923c0f90e1SFrank Schaefer return ret; 20930c0d06caSMauro Carvalho Chehab } 20940c0d06caSMauro Carvalho Chehab 20958e2c8717SFrank Schaefer if (v4l2->users == 0) { 20960c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 20974e170240SFrank Schaefer 20984e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 20990c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 21000c0d06caSMauro Carvalho Chehab 21014e170240SFrank Schaefer /* 21024e170240SFrank Schaefer * Needed, since GPIO might have disabled power 21034e170240SFrank Schaefer * of some i2c devices 21040c0d06caSMauro Carvalho Chehab */ 21050c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 21060c0d06caSMauro Carvalho Chehab } 2107d3829fadSDevin Heitmueller 2108d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 21090c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 211095d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 21110c0d06caSMauro Carvalho Chehab } 21120c0d06caSMauro Carvalho Chehab 211347677e51SMauro Carvalho Chehab kref_get(&dev->ref); 211495d2608bSFrank Schaefer kref_get(&v4l2->ref); 21158e2c8717SFrank Schaefer v4l2->users++; 21160c0d06caSMauro Carvalho Chehab 21170c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21180c0d06caSMauro Carvalho Chehab 2119d3829fadSDevin Heitmueller return 0; 21200c0d06caSMauro Carvalho Chehab } 21210c0d06caSMauro Carvalho Chehab 21220c0d06caSMauro Carvalho Chehab /* 212301c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 21240c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 21250c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 21260c0d06caSMauro Carvalho Chehab */ 212701c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 21280c0d06caSMauro Carvalho Chehab { 212995d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 213095d2608bSFrank Schaefer 2131822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2132822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2133822b8deaSMauro Carvalho Chehab return 0; 2134822b8deaSMauro Carvalho Chehab } 2135822b8deaSMauro Carvalho Chehab 213601c28193SMauro Carvalho Chehab if (!dev->has_video) { 213701c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 213801c28193SMauro Carvalho Chehab return 0; 213901c28193SMauro Carvalho Chehab } 21400c0d06caSMauro Carvalho Chehab 214195d2608bSFrank Schaefer if (v4l2 == NULL) 214295d2608bSFrank Schaefer return 0; 214395d2608bSFrank Schaefer 214429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2145aa929ad7SMauro Carvalho Chehab 2146ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2147ebbfbc20SMauro Carvalho Chehab 214895d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 21495ad10de6SFrank Schaefer 215023e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 215123e8642cSFrank Schaefer 215237ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 215337ecc7b1SMauro Carvalho Chehab 2154d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 215529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2156d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2157d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 21580c0d06caSMauro Carvalho Chehab } 2159d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 216029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2161d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2162d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 21630c0d06caSMauro Carvalho Chehab } 2164d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 216529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2166d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2167d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 21680c0d06caSMauro Carvalho Chehab } 216901c28193SMauro Carvalho Chehab 2170abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 217195d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2172103f18a2SFrank Schaefer 217395d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 217495d2608bSFrank Schaefer 2175ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 217695d2608bSFrank Schaefer 217747677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 21785ad10de6SFrank Schaefer 217901c28193SMauro Carvalho Chehab return 0; 21800c0d06caSMauro Carvalho Chehab } 21810c0d06caSMauro Carvalho Chehab 2182a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2183a61f6811SShuah Khan { 2184a61f6811SShuah Khan if (dev->is_audio_only) 2185a61f6811SShuah Khan return 0; 2186a61f6811SShuah Khan 2187a61f6811SShuah Khan if (!dev->has_video) 2188a61f6811SShuah Khan return 0; 2189a61f6811SShuah Khan 219029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2191a61f6811SShuah Khan em28xx_stop_urbs(dev); 2192a61f6811SShuah Khan return 0; 2193a61f6811SShuah Khan } 2194a61f6811SShuah Khan 2195a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2196a61f6811SShuah Khan { 2197a61f6811SShuah Khan if (dev->is_audio_only) 2198a61f6811SShuah Khan return 0; 2199a61f6811SShuah Khan 2200a61f6811SShuah Khan if (!dev->has_video) 2201a61f6811SShuah Khan return 0; 2202a61f6811SShuah Khan 220329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2204a61f6811SShuah Khan /* what do we do here */ 2205a61f6811SShuah Khan return 0; 2206a61f6811SShuah Khan } 2207a61f6811SShuah Khan 22080c0d06caSMauro Carvalho Chehab /* 22090c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 22100c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 22110c0d06caSMauro Carvalho Chehab * calls and ioctls 22120c0d06caSMauro Carvalho Chehab */ 22130c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 22140c0d06caSMauro Carvalho Chehab { 2215917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 221695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2217c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 22180c0d06caSMauro Carvalho Chehab int errCode; 22190c0d06caSMauro Carvalho Chehab 22208e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 22218e2c8717SFrank Schaefer 22228e2c8717SFrank Schaefer vb2_fop_release(filp); 222398c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 22240c0d06caSMauro Carvalho Chehab 22258e2c8717SFrank Schaefer if (v4l2->users == 1) { 222647677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 222747677e51SMauro Carvalho Chehab if (dev->disconnected) 222801c28193SMauro Carvalho Chehab goto exit; 22290c0d06caSMauro Carvalho Chehab 22300c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 223195d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 22320c0d06caSMauro Carvalho Chehab 22330c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 22340c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 22350c0d06caSMauro Carvalho Chehab 22360c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 22370c0d06caSMauro Carvalho Chehab dev->alt = 0; 22380c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2239c6d48134SMauro Carvalho Chehab errCode = usb_set_interface(udev, 0, 0); 22400c0d06caSMauro Carvalho Chehab if (errCode < 0) { 224129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2242ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 22438314d402SMauro Carvalho Chehab errCode); 22440c0d06caSMauro Carvalho Chehab } 22450c0d06caSMauro Carvalho Chehab } 22460c0d06caSMauro Carvalho Chehab 224701c28193SMauro Carvalho Chehab exit: 22488e2c8717SFrank Schaefer v4l2->users--; 224995d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 22500c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 225147677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 225247677e51SMauro Carvalho Chehab 22530c0d06caSMauro Carvalho Chehab return 0; 22540c0d06caSMauro Carvalho Chehab } 22550c0d06caSMauro Carvalho Chehab 22560c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 22570c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22580c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22590c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2260d3829fadSDevin Heitmueller .read = vb2_fop_read, 2261d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2262d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 22630c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22640c0d06caSMauro Carvalho Chehab }; 22650c0d06caSMauro Carvalho Chehab 22660c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 22670c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 22680c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 22690c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 22700c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 22710c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 22720c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22732a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2274aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22750c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 22760c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 22770c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 22780c0d06caSMauro Carvalho Chehab 2279d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2280d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2281d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2282d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2283d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2284d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2285d3829fadSDevin Heitmueller 22860c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 22870c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 22880c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 22890c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 22900c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 22910c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 22920c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 22930c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2294d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2295d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 22960c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 22970c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 22980c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22990c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 230050fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 230150fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23020c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 230396b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 23040c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23050c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23060c0d06caSMauro Carvalho Chehab #endif 23070c0d06caSMauro Carvalho Chehab }; 23080c0d06caSMauro Carvalho Chehab 23090c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 23100c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 23110c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2312d4352f36SHans Verkuil .release = video_device_release_empty, 23130c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 23140c0d06caSMauro Carvalho Chehab }; 23150c0d06caSMauro Carvalho Chehab 23160c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 23170c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23180c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23190c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 23200c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23210c0d06caSMauro Carvalho Chehab }; 23220c0d06caSMauro Carvalho Chehab 23230c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2324a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 23250c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 23260c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 23270c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23280c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 232950fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 233050fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23310c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2332430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 23330c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23340c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23350c0d06caSMauro Carvalho Chehab #endif 23360c0d06caSMauro Carvalho Chehab }; 23370c0d06caSMauro Carvalho Chehab 23380c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 23390c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 23400c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2341d4352f36SHans Verkuil .release = video_device_release_empty, 23420c0d06caSMauro Carvalho Chehab }; 23430c0d06caSMauro Carvalho Chehab 2344b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2345b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2346b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2347b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2348b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2349b64f8e9aSMauro Carvalho Chehab 2350b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2351b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2352b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2353b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2354b64f8e9aSMauro Carvalho Chehab }; 2355b64f8e9aSMauro Carvalho Chehab 2356b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2357b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2358b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2359b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2360b64f8e9aSMauro Carvalho Chehab }; 2361b64f8e9aSMauro Carvalho Chehab 23620c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 23630c0d06caSMauro Carvalho Chehab 2364d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2365d4352f36SHans Verkuil struct video_device *vfd, 23660c0d06caSMauro Carvalho Chehab const struct video_device *template, 23670c0d06caSMauro Carvalho Chehab const char *type_name) 23680c0d06caSMauro Carvalho Chehab { 23690c0d06caSMauro Carvalho Chehab *vfd = *template; 237095d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 23710c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2372aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 2373d8c95c08SHans Verkuil vfd->tvnorms = 0; 23740c0d06caSMauro Carvalho Chehab 23750c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 237629b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 23770c0d06caSMauro Carvalho Chehab 23780c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 23790c0d06caSMauro Carvalho Chehab } 23800c0d06caSMauro Carvalho Chehab 23813319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 23820560f337SMauro Carvalho Chehab { 23833854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 23843854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 23850560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 23860560f337SMauro Carvalho Chehab struct v4l2_frequency f; 23870560f337SMauro Carvalho Chehab 23880560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 23890560f337SMauro Carvalho Chehab 23900560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 23910560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 23920560f337SMauro Carvalho Chehab 23930560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 23940560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 23950560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 23960560f337SMauro Carvalho Chehab 239795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 239895d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 23990560f337SMauro Carvalho Chehab } 24000560f337SMauro Carvalho Chehab 24010560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 24020560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 24033319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 24040560f337SMauro Carvalho Chehab 240595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 240695d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24070560f337SMauro Carvalho Chehab } 24080560f337SMauro Carvalho Chehab 24096867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 24100560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 24110560f337SMauro Carvalho Chehab 24120560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 24136867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 24140560f337SMauro Carvalho Chehab 241595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 241695d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 24170560f337SMauro Carvalho Chehab } 24180560f337SMauro Carvalho Chehab 24190560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 24200560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 24210560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 24220560f337SMauro Carvalho Chehab 24230560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 24240560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 24250560f337SMauro Carvalho Chehab 24260560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 24270560f337SMauro Carvalho Chehab 24280560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 24290560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 24300560f337SMauro Carvalho Chehab 243195d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 24320560f337SMauro Carvalho Chehab } 24330560f337SMauro Carvalho Chehab 24340560f337SMauro Carvalho Chehab /* configure tuner */ 24350560f337SMauro Carvalho Chehab f.tuner = 0; 24360560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 24370560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 24383854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 243995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 24400560f337SMauro Carvalho Chehab } 24410560f337SMauro Carvalho Chehab 244201c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 24430c0d06caSMauro Carvalho Chehab { 24440c0d06caSMauro Carvalho Chehab u8 val; 24450c0d06caSMauro Carvalho Chehab int ret; 24460c0d06caSMauro Carvalho Chehab unsigned int maxw; 2447abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 244895d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2449b64f8e9aSMauro Carvalho Chehab 2450822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2451822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2452822b8deaSMauro Carvalho Chehab return 0; 2453822b8deaSMauro Carvalho Chehab } 2454822b8deaSMauro Carvalho Chehab 245501c28193SMauro Carvalho Chehab if (!dev->has_video) { 2456b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2457b64f8e9aSMauro Carvalho Chehab return 0; 2458b64f8e9aSMauro Carvalho Chehab } 24590c0d06caSMauro Carvalho Chehab 246029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 24610c0d06caSMauro Carvalho Chehab 246201c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 246301c28193SMauro Carvalho Chehab 246495d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 24658314d402SMauro Carvalho Chehab if (!v4l2) { 246695d2608bSFrank Schaefer mutex_unlock(&dev->lock); 246795d2608bSFrank Schaefer return -ENOMEM; 246895d2608bSFrank Schaefer } 246995d2608bSFrank Schaefer kref_init(&v4l2->ref); 2470abc1308fSFrank Schaefer v4l2->dev = dev; 247195d2608bSFrank Schaefer dev->v4l2 = v4l2; 247295d2608bSFrank Schaefer 247337ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 247437ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 247537ecc7b1SMauro Carvalho Chehab #endif 247629b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2477b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 247829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2479ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2480b64f8e9aSMauro Carvalho Chehab goto err; 2481b64f8e9aSMauro Carvalho Chehab } 2482b64f8e9aSMauro Carvalho Chehab 2483abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2484b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 248595d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2486b64f8e9aSMauro Carvalho Chehab 2487aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 24887e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 248958159171SFrank Schaefer 2490b64f8e9aSMauro Carvalho Chehab /* 2491b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2492b64f8e9aSMauro Carvalho Chehab */ 2493a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY; 24949297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2495b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2496b64f8e9aSMauro Carvalho Chehab 2497b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2498b64f8e9aSMauro Carvalho Chehab 2499aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) 250095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 250195d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2502b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2503b64f8e9aSMauro Carvalho Chehab 2504b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 250595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 250695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2507b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2508b64f8e9aSMauro Carvalho Chehab 2509b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 251095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 251195d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2512b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2513b64f8e9aSMauro Carvalho Chehab 2514b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 251595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 251695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2517b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2518b64f8e9aSMauro Carvalho Chehab 2519b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2520b64f8e9aSMauro Carvalho Chehab 2521b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 25223319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 25236867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2524b64f8e9aSMauro Carvalho Chehab 2525b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 252695d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 252795d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2528fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2529fdf1bc9fSMauro Carvalho Chehab NULL); 2530b64f8e9aSMauro Carvalho Chehab 2531b64f8e9aSMauro Carvalho Chehab if (has_demod) 253295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2533fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2534fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2535fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 25363319e6f8SFrank Schaefer if (tuner_addr == 0) { 2537b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2538b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2539b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2540b64f8e9aSMauro Carvalho Chehab 254195d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2542fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2543fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2544fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2545b64f8e9aSMauro Carvalho Chehab 2546b64f8e9aSMauro Carvalho Chehab if (sd) 25473319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2548b64f8e9aSMauro Carvalho Chehab } else { 254995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 255095d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 25513319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2552b64f8e9aSMauro Carvalho Chehab } 2553b64f8e9aSMauro Carvalho Chehab 25543319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 25553319e6f8SFrank Schaefer } 25563319e6f8SFrank Schaefer 2557d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2558b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2559b64f8e9aSMauro Carvalho Chehab 2560b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2561b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2562b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 256329b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2564ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2565b64f8e9aSMauro Carvalho Chehab __func__, ret); 2566b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2567b64f8e9aSMauro Carvalho Chehab } 2568b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2569b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2570b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2571b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2572b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2573b64f8e9aSMauro Carvalho Chehab } else { 2574b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2575b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2576b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2577b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2578b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2579b64f8e9aSMauro Carvalho Chehab } 2580b64f8e9aSMauro Carvalho Chehab 2581b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2582b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2583b64f8e9aSMauro Carvalho Chehab 2584b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2585b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2586b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2587b64f8e9aSMauro Carvalho Chehab 2588aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 2589b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2590b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2591b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 259229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2593ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2594b64f8e9aSMauro Carvalho Chehab __func__, ret); 2595b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2596b64f8e9aSMauro Carvalho Chehab } 2597b64f8e9aSMauro Carvalho Chehab msleep(3); 2598b64f8e9aSMauro Carvalho Chehab 2599b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2600b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 260129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2602ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2603b64f8e9aSMauro Carvalho Chehab __func__, ret); 2604b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2605b64f8e9aSMauro Carvalho Chehab } 2606b64f8e9aSMauro Carvalho Chehab msleep(3); 2607b64f8e9aSMauro Carvalho Chehab } 2608b64f8e9aSMauro Carvalho Chehab 26090c0d06caSMauro Carvalho Chehab /* set default norm */ 261052faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 26118774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 261258159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 26130c0d06caSMauro Carvalho Chehab 26140c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 261506e20672SFrank Schaefer v4l2->format = &format[0]; 26160c0d06caSMauro Carvalho Chehab 26170c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 26180c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 26190c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 26200c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 26210c0d06caSMauro Carvalho Chehab maxw /= 2; 26220c0d06caSMauro Carvalho Chehab 26230c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 26240c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 26250c0d06caSMauro Carvalho Chehab 26260c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 26270c0d06caSMauro Carvalho Chehab 26280c0d06caSMauro Carvalho Chehab /* Audio defaults */ 26290c0d06caSMauro Carvalho Chehab dev->mute = 1; 26300c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 26310c0d06caSMauro Carvalho Chehab 26320c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 26330c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 26340c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 26350c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 26360c0d06caSMauro Carvalho Chehab 26370c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 26380c0d06caSMauro Carvalho Chehab 26398f8b113aSFrank Schaefer /* Add image controls */ 26408f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 26418f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2642ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2643ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26448f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 26458f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2646ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2647ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26488f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 26498f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2650ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2651ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26528f8b113aSFrank Schaefer V4L2_CID_SATURATION, 26538f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2654ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2655ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26568f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 26578f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2658ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2659ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26608f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 26618f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2662ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2663ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26648f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 26658f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 26668f8b113aSFrank Schaefer 26678f8b113aSFrank Schaefer /* Reset image controls */ 26688f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2669ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2670ad298055SFrank Schaefer ret = hdl->error; 2671b64f8e9aSMauro Carvalho Chehab if (ret) 2672b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26738f8b113aSFrank Schaefer 26740c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2675d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 267627a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 267727a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2678d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2679d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 26800c0d06caSMauro Carvalho Chehab 26816e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 2682aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 2683d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2684d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2685d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 26863bc85cceSFrank Schaefer } else { 2687d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 26886e46dabaSFrank Schaefer } 268966df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2690d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2691d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2692d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2693d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 269466df67b7SFrank Schaefer } 2695920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2696d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2697d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2698c2dcef83SFrank Schaefer } 26996e46dabaSFrank Schaefer 27000c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2701d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 27020c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 27030c0d06caSMauro Carvalho Chehab if (ret) { 270429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2705ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2706b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27070c0d06caSMauro Carvalho Chehab } 27080c0d06caSMauro Carvalho Chehab 27090c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 27100c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2711d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 27120c0d06caSMauro Carvalho Chehab "vbi"); 27130c0d06caSMauro Carvalho Chehab 2714d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2715d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2716d3829fadSDevin Heitmueller 271766df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2718d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 271966df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2720d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2721d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2722d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2723d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 272466df67b7SFrank Schaefer } 2725920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2726d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2727d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2728c2dcef83SFrank Schaefer } 272966df67b7SFrank Schaefer 27300c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2731d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 27320c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 27330c0d06caSMauro Carvalho Chehab if (ret < 0) { 273429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2735ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2736b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27370c0d06caSMauro Carvalho Chehab } 27380c0d06caSMauro Carvalho Chehab } 27390c0d06caSMauro Carvalho Chehab 27400c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2741d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 27420c0d06caSMauro Carvalho Chehab "radio"); 2743d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 27440c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 27450c0d06caSMauro Carvalho Chehab if (ret < 0) { 274629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2747ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2748b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27490c0d06caSMauro Carvalho Chehab } 275029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2751ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2752d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 27530c0d06caSMauro Carvalho Chehab } 27540c0d06caSMauro Carvalho Chehab 275537ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 275637ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 275737ecc7b1SMauro Carvalho Chehab 27580d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2759de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 276037ecc7b1SMauro Carvalho Chehab if (ret) { 276129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2762ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 276337ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 276437ecc7b1SMauro Carvalho Chehab goto unregister_dev; 276537ecc7b1SMauro Carvalho Chehab } 27660d37ba62SArnd Bergmann #endif 276737ecc7b1SMauro Carvalho Chehab 276829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2769ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2770d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 27710c0d06caSMauro Carvalho Chehab 2772d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 277329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2774ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2775d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 27760c0d06caSMauro Carvalho Chehab 2777b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 277895d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2779b64f8e9aSMauro Carvalho Chehab 2780b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2781b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2782b64f8e9aSMauro Carvalho Chehab 278329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2784ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 27859634614fSMauro Carvalho Chehab 278647677e51SMauro Carvalho Chehab kref_get(&dev->ref); 278747677e51SMauro Carvalho Chehab 278801c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 27890c0d06caSMauro Carvalho Chehab return 0; 2790b64f8e9aSMauro Carvalho Chehab 2791b64f8e9aSMauro Carvalho Chehab unregister_dev: 279256a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 279329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2794ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 279556a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 279656a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 279756a7f515SMauro Carvalho Chehab } 279856a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 279929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2800ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 280156a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 280256a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 280356a7f515SMauro Carvalho Chehab } 280456a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 280529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2806ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 280756a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 280856a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 280956a7f515SMauro Carvalho Chehab } 281056a7f515SMauro Carvalho Chehab 2811abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 281295d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2813b64f8e9aSMauro Carvalho Chehab err: 281495d2608bSFrank Schaefer dev->v4l2 = NULL; 281595d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 281601c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2817b64f8e9aSMauro Carvalho Chehab return ret; 28180c0d06caSMauro Carvalho Chehab } 281901c28193SMauro Carvalho Chehab 282001c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 282101c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 282201c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 282301c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 282401c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2825a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2826a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 282701c28193SMauro Carvalho Chehab }; 282801c28193SMauro Carvalho Chehab 282901c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 283001c28193SMauro Carvalho Chehab { 283101c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 283201c28193SMauro Carvalho Chehab } 283301c28193SMauro Carvalho Chehab 283401c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 283501c28193SMauro Carvalho Chehab { 283601c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 283701c28193SMauro Carvalho Chehab } 283801c28193SMauro Carvalho Chehab 283901c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 284001c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2841