1f22e9e71SMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0+ 2f22e9e71SMauro Carvalho Chehab // 3f22e9e71SMauro Carvalho Chehab // em28xx-video.c - driver for Empia EM2800/EM2820/2840 USB 4f22e9e71SMauro Carvalho Chehab // video capture devices 5f22e9e71SMauro Carvalho Chehab // 6f22e9e71SMauro Carvalho Chehab // Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it> 7f22e9e71SMauro Carvalho Chehab // Markus Rechberger <mrechberger@gmail.com> 8f22e9e71SMauro Carvalho Chehab // Mauro Carvalho Chehab <mchehab@infradead.org> 9f22e9e71SMauro Carvalho Chehab // Sascha Sommer <saschasommer@freenet.de> 10f22e9e71SMauro Carvalho Chehab // Copyright (C) 2012 Frank Schäfer <fschaefer.oss@googlemail.com> 11f22e9e71SMauro Carvalho Chehab // 12f22e9e71SMauro Carvalho Chehab // Some parts based on SN9C10x PC Camera Controllers GPL driver made 13f22e9e71SMauro Carvalho Chehab // by Luca Risolia <luca.risolia@studio.unibo.it> 14f22e9e71SMauro Carvalho Chehab // 15f22e9e71SMauro Carvalho Chehab // This program is free software; you can redistribute it and/or modify 16f22e9e71SMauro Carvalho Chehab // it under the terms of the GNU General Public License as published by 17f22e9e71SMauro Carvalho Chehab // the Free Software Foundation; either version 2 of the License, or 18f22e9e71SMauro Carvalho Chehab // (at your option) any later version. 19f22e9e71SMauro Carvalho Chehab // 20f22e9e71SMauro Carvalho Chehab // This program is distributed in the hope that it will be useful, 21f22e9e71SMauro Carvalho Chehab // but WITHOUT ANY WARRANTY; without even the implied warranty of 22f22e9e71SMauro Carvalho Chehab // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 23f22e9e71SMauro Carvalho Chehab // GNU General Public License for more details. 240c0d06caSMauro Carvalho Chehab 258314d402SMauro Carvalho Chehab #include "em28xx.h" 268314d402SMauro Carvalho Chehab 270c0d06caSMauro Carvalho Chehab #include <linux/init.h> 280c0d06caSMauro Carvalho Chehab #include <linux/list.h> 290c0d06caSMauro Carvalho Chehab #include <linux/module.h> 300c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 310c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 320c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 330c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 340c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 350c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 360c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 370c0d06caSMauro Carvalho Chehab 3801c28193SMauro Carvalho Chehab #include "em28xx-v4l.h" 390c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 400c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4150fdf40fSHans Verkuil #include <media/v4l2-event.h> 42d647f0b7SMauro Carvalho Chehab #include <media/drv-intf/msp3400.h> 430c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 440c0d06caSMauro Carvalho Chehab 450c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 460c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 470c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 480c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 490c0d06caSMauro Carvalho Chehab 500560f337SMauro Carvalho Chehab static unsigned int isoc_debug; 510560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 520560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 530560f337SMauro Carvalho Chehab 540560f337SMauro Carvalho Chehab static unsigned int disable_vbi; 550560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644); 560560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support"); 570560f337SMauro Carvalho Chehab 580560f337SMauro Carvalho Chehab static int alt; 590560f337SMauro Carvalho Chehab module_param(alt, int, 0644); 600560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 610560f337SMauro Carvalho Chehab 620c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do { \ 630c0d06caSMauro Carvalho Chehab if (video_debug) \ 6429b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \ 65ce8591ffSMauro Carvalho Chehab "video: %s: " fmt, __func__, ## arg); \ 66ce8591ffSMauro Carvalho Chehab } while (0) 670c0d06caSMauro Carvalho Chehab 682a96f60eSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) do {\ 692a96f60eSMauro Carvalho Chehab if (isoc_debug) \ 7029b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \ 71ce8591ffSMauro Carvalho Chehab "isoc: %s: " fmt, __func__, ## arg); \ 72ce8591ffSMauro Carvalho Chehab } while (0) 730c0d06caSMauro Carvalho Chehab 740c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 75d8992b09SMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC " - v4l2 interface"); 76f22e9e71SMauro Carvalho Chehab MODULE_LICENSE("GPL v2"); 770c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 780c0d06caSMauro Carvalho Chehab 79e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 80e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 81e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 82e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 83e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 84e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 85e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 86e507e0e5SFrank Schaefer 87d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 88d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 89d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 900c0d06caSMauro Carvalho Chehab 910c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 920c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 930c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 940c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 950c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 960c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 970c0d06caSMauro Carvalho Chehab 980c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 990c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1000c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1010c0d06caSMauro Carvalho Chehab 1020c0d06caSMauro Carvalho Chehab /* supported video standards */ 1030c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1040c0d06caSMauro Carvalho Chehab { 1050c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1060c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1070c0d06caSMauro Carvalho Chehab .depth = 16, 1080c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1090c0d06caSMauro Carvalho Chehab }, { 1100c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1110c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1120c0d06caSMauro Carvalho Chehab .depth = 16, 1130c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1140c0d06caSMauro Carvalho Chehab }, { 115495ab569SFrank Schaefer .name = "8 bpp Bayer RGRG..GBGB", 116495ab569SFrank Schaefer .fourcc = V4L2_PIX_FMT_SRGGB8, 117495ab569SFrank Schaefer .depth = 8, 118495ab569SFrank Schaefer .reg = EM28XX_OUTFMT_RGB_8_RGRG, 119495ab569SFrank Schaefer }, { 1200c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1210c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1220c0d06caSMauro Carvalho Chehab .depth = 8, 1230c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1240c0d06caSMauro Carvalho Chehab }, { 1250c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1260c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1270c0d06caSMauro Carvalho Chehab .depth = 8, 1280c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1290c0d06caSMauro Carvalho Chehab }, { 1300c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1310c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1320c0d06caSMauro Carvalho Chehab .depth = 8, 1330c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1340c0d06caSMauro Carvalho Chehab }, { 1350c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1360c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1370c0d06caSMauro Carvalho Chehab .depth = 12, 1380c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1390c0d06caSMauro Carvalho Chehab }, 1400c0d06caSMauro Carvalho Chehab }; 1410c0d06caSMauro Carvalho Chehab 14225c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */ 14325c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev) 14425c61e4cSFrank Schaefer { 145d7dc18daSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 146d7dc18daSFrank Schaefer 147aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 148d7dc18daSFrank Schaefer return v4l2->sensor_xres; 14925c61e4cSFrank Schaefer 15025c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 15125c61e4cSFrank Schaefer return 640; 15225c61e4cSFrank Schaefer 15325c61e4cSFrank Schaefer return 720; 15425c61e4cSFrank Schaefer } 15525c61e4cSFrank Schaefer 15625c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev) 15725c61e4cSFrank Schaefer { 15852faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15952faaf78SFrank Schaefer 160aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 161d7dc18daSFrank Schaefer return v4l2->sensor_yres; 16225c61e4cSFrank Schaefer 16325c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 16425c61e4cSFrank Schaefer return 480; 16525c61e4cSFrank Schaefer 16652faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480; 16725c61e4cSFrank Schaefer } 16825c61e4cSFrank Schaefer 16901c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1700560f337SMauro Carvalho Chehab { 1710560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1720560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1730560f337SMauro Carvalho Chehab return 0; 1740560f337SMauro Carvalho Chehab 175aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1760560f337SMauro Carvalho Chehab return 0; 1770560f337SMauro Carvalho Chehab 1780560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1790560f337SMauro Carvalho Chehab 1800560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1810560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1820560f337SMauro Carvalho Chehab return 1; 1830560f337SMauro Carvalho Chehab 1840560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1850560f337SMauro Carvalho Chehab return 0; 1860560f337SMauro Carvalho Chehab } 1870560f337SMauro Carvalho Chehab 1880560f337SMauro Carvalho Chehab /* 1890560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1900560f337SMauro Carvalho Chehab * configure i2c attached devices 1910560f337SMauro Carvalho Chehab */ 19201c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1930560f337SMauro Carvalho Chehab { 19495d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 195fdf1bc9fSMauro Carvalho Chehab 19695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 19795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 1980560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 1990560f337SMauro Carvalho Chehab } 2000560f337SMauro Carvalho Chehab 20101c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2020560f337SMauro Carvalho Chehab { 2030560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2040560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2090560f337SMauro Carvalho Chehab 2100560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2110560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2130560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2140560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2150560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2160560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2170560f337SMauro Carvalho Chehab } 2180560f337SMauro Carvalho Chehab 21901c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2200560f337SMauro Carvalho Chehab { 2210560f337SMauro Carvalho Chehab int ret; 2220560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 223753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2240560f337SMauro Carvalho Chehab 22506e20672SFrank Schaefer fmt = v4l2->format->reg; 2260560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2270560f337SMauro Carvalho Chehab fmt |= 0x20; 2280560f337SMauro Carvalho Chehab /* 2290560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2300560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2310560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2320560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2330560f337SMauro Carvalho Chehab * 2340560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2350560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2360560f337SMauro Carvalho Chehab */ 2370560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2380560f337SMauro Carvalho Chehab if (ret < 0) 2390560f337SMauro Carvalho Chehab return ret; 2400560f337SMauro Carvalho Chehab 2419297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2420560f337SMauro Carvalho Chehab if (ret < 0) 2430560f337SMauro Carvalho Chehab return ret; 2440560f337SMauro Carvalho Chehab 2459297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2460560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2470560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2480560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 249753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 250753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2520560f337SMauro Carvalho Chehab /* NTSC */ 2530560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25452faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2550560f337SMauro Carvalho Chehab /* PAL */ 2560560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2570560f337SMauro Carvalho Chehab } 2580560f337SMauro Carvalho Chehab } 2590560f337SMauro Carvalho Chehab 2600560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2610560f337SMauro Carvalho Chehab } 2620560f337SMauro Carvalho Chehab 2630560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2640560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2650560f337SMauro Carvalho Chehab { 2660560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2670560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2680560f337SMauro Carvalho Chehab 2690560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2700560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2710560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2720560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2730560f337SMauro Carvalho Chehab } 2740560f337SMauro Carvalho Chehab 2750560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2760560f337SMauro Carvalho Chehab u16 width, u16 height) 2770560f337SMauro Carvalho Chehab { 2780560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2790560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2800560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2810560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2820560f337SMauro Carvalho Chehab 2830560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2840560f337SMauro Carvalho Chehab hstart, vstart, 2850560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2860560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2870560f337SMauro Carvalho Chehab 2880560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2930560f337SMauro Carvalho Chehab 2940560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2950560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2960560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2970560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2990560f337SMauro Carvalho Chehab } 3000560f337SMauro Carvalho Chehab } 3010560f337SMauro Carvalho Chehab 3020560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3030560f337SMauro Carvalho Chehab { 304cba8e9b3SFrank Schaefer u8 mode = 0x00; 3050560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3060560f337SMauro Carvalho Chehab 3070560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3080560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3090560f337SMauro Carvalho Chehab } else { 3100560f337SMauro Carvalho Chehab u8 buf[2]; 3110560f337SMauro Carvalho Chehab 3120560f337SMauro Carvalho Chehab buf[0] = h; 3130560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3140560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3150560f337SMauro Carvalho Chehab 3160560f337SMauro Carvalho Chehab buf[0] = v; 3170560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3180560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3190560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3200560f337SMauro Carvalho Chehab to work correctly */ 3210560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3220560f337SMauro Carvalho Chehab } 323cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3240560f337SMauro Carvalho Chehab } 3250560f337SMauro Carvalho Chehab 3260560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32701c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3280560f337SMauro Carvalho Chehab { 329753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 330753aee77SFrank Schaefer int width = norm_maxw(dev); 331753aee77SFrank Schaefer int height = norm_maxh(dev); 3320560f337SMauro Carvalho Chehab 3330560f337SMauro Carvalho Chehab /* Properly setup VBI */ 334753aee77SFrank Schaefer v4l2->vbi_width = 720; 33552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 336753aee77SFrank Schaefer v4l2->vbi_height = 12; 3370560f337SMauro Carvalho Chehab else 338753aee77SFrank Schaefer v4l2->vbi_height = 18; 3390560f337SMauro Carvalho Chehab 3400560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3410560f337SMauro Carvalho Chehab 3420560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3430560f337SMauro Carvalho Chehab 3440560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3450560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3460560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3470560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3480560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3490560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3500560f337SMauro Carvalho Chehab region */ 3510560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3520560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3530560f337SMauro Carvalho Chehab else 3540560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3550560f337SMauro Carvalho Chehab 356753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3570560f337SMauro Carvalho Chehab } 3580560f337SMauro Carvalho Chehab 3590560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36001c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3610560f337SMauro Carvalho Chehab { 362753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 363c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 3640560f337SMauro Carvalho Chehab int errCode; 3650560f337SMauro Carvalho Chehab int i; 366753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3670560f337SMauro Carvalho Chehab 3680560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3690560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3700560f337SMauro Carvalho Chehab dev->alt = 0; 3710560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3720560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3730560f337SMauro Carvalho Chehab dev->alt = alt; 3740560f337SMauro Carvalho Chehab goto set_alt; 3750560f337SMauro Carvalho Chehab } 3760560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3770560f337SMauro Carvalho Chehab goto set_alt; 3780560f337SMauro Carvalho Chehab 3790560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3800560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3810560f337SMauro Carvalho Chehab green screen will be received. 3820560f337SMauro Carvalho Chehab */ 383753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3840560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3850560f337SMauro Carvalho Chehab 3860560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3870560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3880560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3890560f337SMauro Carvalho Chehab dev->alt = i; 3900560f337SMauro Carvalho Chehab break; 3910560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3920560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3930560f337SMauro Carvalho Chehab */ 3940560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3950560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3960560f337SMauro Carvalho Chehab dev->alt = i; 3970560f337SMauro Carvalho Chehab } 3980560f337SMauro Carvalho Chehab 3990560f337SMauro Carvalho Chehab set_alt: 4000560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4010560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4020560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4030560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4040560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4050560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4060560f337SMauro Carvalho Chehab } else { /* isoc */ 4070560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4080560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4090560f337SMauro Carvalho Chehab dev->max_pkt_size = 4100560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4110560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4120560f337SMauro Carvalho Chehab } 4130560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4140560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 415c6d48134SMauro Carvalho Chehab errCode = usb_set_interface(udev, dev->ifnum, dev->alt); 4160560f337SMauro Carvalho Chehab if (errCode < 0) { 41729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 418ce8591ffSMauro Carvalho Chehab "cannot change alternate number to %d (error=%i)\n", 4190560f337SMauro Carvalho Chehab dev->alt, errCode); 4200560f337SMauro Carvalho Chehab return errCode; 4210560f337SMauro Carvalho Chehab } 4220560f337SMauro Carvalho Chehab return 0; 4230560f337SMauro Carvalho Chehab } 4240560f337SMauro Carvalho Chehab 4250c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4260c0d06caSMauro Carvalho Chehab DMA and thread functions 4270c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4280c0d06caSMauro Carvalho Chehab 4290c0d06caSMauro Carvalho Chehab /* 430948a49aaSFrank Schaefer * Finish the current buffer 4310c0d06caSMauro Carvalho Chehab */ 432948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4330c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4340c0d06caSMauro Carvalho Chehab { 435d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 436d3829fadSDevin Heitmueller 4372d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++; 438662c97cfSFrank Schaefer if (dev->v4l2->progressive) 4392d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE; 440662c97cfSFrank Schaefer else 4412d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED; 442d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns(); 443d3829fadSDevin Heitmueller 4442d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 4450c0d06caSMauro Carvalho Chehab } 4460c0d06caSMauro Carvalho Chehab 4470c0d06caSMauro Carvalho Chehab /* 44836016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4490c0d06caSMauro Carvalho Chehab */ 4500c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4510c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 45236016a35SFrank Schaefer unsigned char *usb_buf, 4534078d625SFrank Schaefer unsigned long len) 4540c0d06caSMauro Carvalho Chehab { 45558159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4560c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4570c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 45858159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4590c0d06caSMauro Carvalho Chehab 460d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 461d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4620c0d06caSMauro Carvalho Chehab 46336016a35SFrank Schaefer startread = usb_buf; 4640c0d06caSMauro Carvalho Chehab remain = len; 4650c0d06caSMauro Carvalho Chehab 46658159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 46736016a35SFrank Schaefer fieldstart = buf->vb_buf; 468c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46936016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4700c0d06caSMauro Carvalho Chehab 4718732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4728732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4730c0d06caSMauro Carvalho Chehab 47458159171SFrank Schaefer if (v4l2->progressive) 4750c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4760c0d06caSMauro Carvalho Chehab else 4770c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4780c0d06caSMauro Carvalho Chehab 4790c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4800c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4810c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4820c0d06caSMauro Carvalho Chehab 483d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4847983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4850c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 486d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 487d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48836016a35SFrank Schaefer (char *)startwrite; 4890c0d06caSMauro Carvalho Chehab lencopy = remain; 4900c0d06caSMauro Carvalho Chehab } 4910c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4920c0d06caSMauro Carvalho Chehab return; 4930c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4940c0d06caSMauro Carvalho Chehab 4950c0d06caSMauro Carvalho Chehab remain -= lencopy; 4960c0d06caSMauro Carvalho Chehab 4970c0d06caSMauro Carvalho Chehab while (remain > 0) { 49858159171SFrank Schaefer if (v4l2->progressive) 499c02ec71bSFrank Schaefer startwrite += lencopy; 500c02ec71bSFrank Schaefer else 5010c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5020c0d06caSMauro Carvalho Chehab startread += lencopy; 5030c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5040c0d06caSMauro Carvalho Chehab lencopy = remain; 5050c0d06caSMauro Carvalho Chehab else 5060c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5070c0d06caSMauro Carvalho Chehab 50836016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 509d3829fadSDevin Heitmueller buf->length) { 5105ccb197dSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end(2)\n", 5110c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 512d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 513d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5140c0d06caSMauro Carvalho Chehab (char *)startwrite; 5150c0d06caSMauro Carvalho Chehab } 5160c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5170c0d06caSMauro Carvalho Chehab break; 5180c0d06caSMauro Carvalho Chehab 5190c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5200c0d06caSMauro Carvalho Chehab 5210c0d06caSMauro Carvalho Chehab remain -= lencopy; 5220c0d06caSMauro Carvalho Chehab } 5230c0d06caSMauro Carvalho Chehab 5248732533bSFrank Schaefer buf->pos += len; 5250c0d06caSMauro Carvalho Chehab } 5260c0d06caSMauro Carvalho Chehab 52736016a35SFrank Schaefer /* 52836016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52936016a35SFrank Schaefer */ 5300c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5310c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53236016a35SFrank Schaefer unsigned char *usb_buf, 5334078d625SFrank Schaefer unsigned long len) 5340c0d06caSMauro Carvalho Chehab { 53536016a35SFrank Schaefer unsigned int offset; 5360c0d06caSMauro Carvalho Chehab 537d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 538d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5390c0d06caSMauro Carvalho Chehab 5408732533bSFrank Schaefer offset = buf->pos; 5410c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54236016a35SFrank Schaefer if (buf->top_field == 0) 543753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5440c0d06caSMauro Carvalho Chehab 54536016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5468732533bSFrank Schaefer buf->pos += len; 5470c0d06caSMauro Carvalho Chehab } 5480c0d06caSMauro Carvalho Chehab 5490c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5500c0d06caSMauro Carvalho Chehab int packet, int status) 5510c0d06caSMauro Carvalho Chehab { 5520c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5530c0d06caSMauro Carvalho Chehab 5540c0d06caSMauro Carvalho Chehab switch (status) { 5550c0d06caSMauro Carvalho Chehab case -ENOENT: 556b436e26eSColin Ian King errmsg = "unlinked synchronously"; 5570c0d06caSMauro Carvalho Chehab break; 5580c0d06caSMauro Carvalho Chehab case -ECONNRESET: 559b436e26eSColin Ian King errmsg = "unlinked asynchronously"; 5600c0d06caSMauro Carvalho Chehab break; 5610c0d06caSMauro Carvalho Chehab case -ENOSR: 5620c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5630c0d06caSMauro Carvalho Chehab break; 5640c0d06caSMauro Carvalho Chehab case -EPIPE: 5650c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5660c0d06caSMauro Carvalho Chehab break; 5670c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5680c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5690c0d06caSMauro Carvalho Chehab break; 5700c0d06caSMauro Carvalho Chehab case -EPROTO: 5710c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5720c0d06caSMauro Carvalho Chehab break; 5730c0d06caSMauro Carvalho Chehab case -EILSEQ: 5740c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5750c0d06caSMauro Carvalho Chehab break; 5760c0d06caSMauro Carvalho Chehab case -ETIME: 5770c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5780c0d06caSMauro Carvalho Chehab break; 5790c0d06caSMauro Carvalho Chehab } 5800c0d06caSMauro Carvalho Chehab if (packet < 0) { 5810c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5820c0d06caSMauro Carvalho Chehab } else { 5830c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5840c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5850c0d06caSMauro Carvalho Chehab } 5860c0d06caSMauro Carvalho Chehab } 5870c0d06caSMauro Carvalho Chehab 5880c0d06caSMauro Carvalho Chehab /* 58924a6d849SFrank Schaefer * get the next available buffer from dma queue 5900c0d06caSMauro Carvalho Chehab */ 59124a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59224a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5930c0d06caSMauro Carvalho Chehab { 59424a6d849SFrank Schaefer struct em28xx_buffer *buf; 5950c0d06caSMauro Carvalho Chehab 5960c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5970c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59824a6d849SFrank Schaefer return NULL; 5990c0d06caSMauro Carvalho Chehab } 6000c0d06caSMauro Carvalho Chehab 6010c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 602d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6030c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 604d3829fadSDevin Heitmueller list_del(&buf->list); 6058732533bSFrank Schaefer buf->pos = 0; 606d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6070c0d06caSMauro Carvalho Chehab 60824a6d849SFrank Schaefer return buf; 6090c0d06caSMauro Carvalho Chehab } 6100c0d06caSMauro Carvalho Chehab 611e04c00d9SFrank Schaefer /* 612e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 613e04c00d9SFrank Schaefer */ 614e04c00d9SFrank Schaefer static struct em28xx_buffer * 615e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 616e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 617e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 618e04c00d9SFrank Schaefer { 61958159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 62058159171SFrank Schaefer 621f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 622e04c00d9SFrank Schaefer if (buf != NULL) 623e04c00d9SFrank Schaefer finish_buffer(dev, buf); 624e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 625e04c00d9SFrank Schaefer } 626e04c00d9SFrank Schaefer if (buf != NULL) { 627f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 628e04c00d9SFrank Schaefer buf->pos = 0; 629e04c00d9SFrank Schaefer } 630e04c00d9SFrank Schaefer 631e04c00d9SFrank Schaefer return buf; 632e04c00d9SFrank Schaefer } 633e04c00d9SFrank Schaefer 634227b7c90SFrank Schaefer /* 635227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 636227b7c90SFrank Schaefer */ 637227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 638227b7c90SFrank Schaefer unsigned char *data_pkt, 639227b7c90SFrank Schaefer unsigned int data_len) 640227b7c90SFrank Schaefer { 641753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 642227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 643227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 644227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 645227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 646227b7c90SFrank Schaefer 647227b7c90SFrank Schaefer /* capture type 0 = vbi start 648227b7c90SFrank Schaefer capture type 1 = vbi in progress 649227b7c90SFrank Schaefer capture type 2 = video start 650227b7c90SFrank Schaefer capture type 3 = video in progress */ 651227b7c90SFrank Schaefer if (data_len >= 4) { 652227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 653227b7c90SFrank Schaefer * never split across packets */ 654227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 655227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 656227b7c90SFrank Schaefer /* Continuation */ 657227b7c90SFrank Schaefer data_pkt += 4; 658227b7c90SFrank Schaefer data_len -= 4; 659227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 660227b7c90SFrank Schaefer /* Field start (VBI mode) */ 661f0e38230SFrank Schaefer v4l2->capture_type = 0; 662f0e38230SFrank Schaefer v4l2->vbi_read = 0; 663227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 664f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 665227b7c90SFrank Schaefer data_pkt += 4; 666227b7c90SFrank Schaefer data_len -= 4; 667227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 668227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 669f0e38230SFrank Schaefer v4l2->capture_type = 2; 670227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 671f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 672227b7c90SFrank Schaefer data_pkt += 4; 673227b7c90SFrank Schaefer data_len -= 4; 674227b7c90SFrank Schaefer } 675227b7c90SFrank Schaefer } 676227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 677227b7c90SFrank Schaefer * have no continuation header */ 678227b7c90SFrank Schaefer 679f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 680227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 681227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 682f0e38230SFrank Schaefer v4l2->capture_type = 1; 683227b7c90SFrank Schaefer } 684227b7c90SFrank Schaefer 685f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 686753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 687f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 688f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 689227b7c90SFrank Schaefer 690227b7c90SFrank Schaefer /* Copy VBI data */ 691227b7c90SFrank Schaefer if (vbi_buf != NULL) 692227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 693f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 694227b7c90SFrank Schaefer 695227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 696227b7c90SFrank Schaefer /* Continue with copying video data */ 697f0e38230SFrank Schaefer v4l2->capture_type = 2; 698227b7c90SFrank Schaefer data_pkt += vbi_data_len; 699227b7c90SFrank Schaefer data_len -= vbi_data_len; 700227b7c90SFrank Schaefer } 701227b7c90SFrank Schaefer } 702227b7c90SFrank Schaefer 703f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 704227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 705227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 706f0e38230SFrank Schaefer v4l2->capture_type = 3; 707227b7c90SFrank Schaefer } 708227b7c90SFrank Schaefer 709f0e38230SFrank Schaefer if (v4l2->capture_type == 3 && buf != NULL && data_len > 0) 710227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 711227b7c90SFrank Schaefer } 712227b7c90SFrank Schaefer 713e507e0e5SFrank Schaefer /* 714e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 715e507e0e5SFrank Schaefer */ 716e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 717e507e0e5SFrank Schaefer unsigned char *data_pkt, 718e507e0e5SFrank Schaefer unsigned int data_len) 719e507e0e5SFrank Schaefer { 720e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 721e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 722f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7237e6c8c19SMauro Carvalho Chehab bool frame_end = false; 724e507e0e5SFrank Schaefer 725e507e0e5SFrank Schaefer /* Check for header */ 726e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 727e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 728e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 729e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 730e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 731f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 732e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 733e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 734e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 735e507e0e5SFrank Schaefer data_pkt += 2; 736e507e0e5SFrank Schaefer data_len -= 2; 737e507e0e5SFrank Schaefer } 738e507e0e5SFrank Schaefer 739e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 740e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 741e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 742e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 743e507e0e5SFrank Schaefer } 744e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 745e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 746e507e0e5SFrank Schaefer * first frame. 747e507e0e5SFrank Schaefer */ 748e507e0e5SFrank Schaefer } 749e507e0e5SFrank Schaefer 750e507e0e5SFrank Schaefer /* Copy data */ 751e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 752e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 753e507e0e5SFrank Schaefer 754e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 755e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 756e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 757e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 758e507e0e5SFrank Schaefer } 759e507e0e5SFrank Schaefer 760e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 761e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 762e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 763e507e0e5SFrank Schaefer * header like with the other em28xx devices. 764e507e0e5SFrank Schaefer */ 765e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 766e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 767e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 768e507e0e5SFrank Schaefer } 769e507e0e5SFrank Schaefer 770960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7710fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7720c0d06caSMauro Carvalho Chehab { 773227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 774227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 775227b7c90SFrank Schaefer unsigned int usb_data_len; 7760c0d06caSMauro Carvalho Chehab 7770c0d06caSMauro Carvalho Chehab if (!dev) 7780c0d06caSMauro Carvalho Chehab return 0; 7790c0d06caSMauro Carvalho Chehab 7802665c299SFrank Schaefer if (dev->disconnected) 7810c0d06caSMauro Carvalho Chehab return 0; 7820c0d06caSMauro Carvalho Chehab 7831653cb0cSFrank Schaefer if (urb->status < 0) 7840c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7850c0d06caSMauro Carvalho Chehab 7864601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7874601cc39SFrank Schaefer 7884601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7894601cc39SFrank Schaefer num_packets = 1; 7904601cc39SFrank Schaefer else /* isoc */ 7914601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7920c0d06caSMauro Carvalho Chehab 7934601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7944601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 795227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7964601cc39SFrank Schaefer 797227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7984601cc39SFrank Schaefer } else { /* isoc */ 7994601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 8004601cc39SFrank Schaefer print_err_status(dev, i, 8014601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8020c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8030c0d06caSMauro Carvalho Chehab continue; 8040c0d06caSMauro Carvalho Chehab } 8050c0d06caSMauro Carvalho Chehab 806227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 807227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8080c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8090c0d06caSMauro Carvalho Chehab continue; 8100c0d06caSMauro Carvalho Chehab } 8110c0d06caSMauro Carvalho Chehab 812227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8134601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8144601cc39SFrank Schaefer } 8154601cc39SFrank Schaefer 816227b7c90SFrank Schaefer if (usb_data_len == 0) { 8174601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8184601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8194601cc39SFrank Schaefer continue; 8204601cc39SFrank Schaefer } 8210c0d06caSMauro Carvalho Chehab 822e507e0e5SFrank Schaefer if (dev->is_em25xx) 823e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 824e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 825e507e0e5SFrank Schaefer else 826e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 827e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 828e507e0e5SFrank Schaefer 8290c0d06caSMauro Carvalho Chehab } 830227b7c90SFrank Schaefer return 1; 8310c0d06caSMauro Carvalho Chehab } 8320c0d06caSMauro Carvalho Chehab 833d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 834d3829fadSDevin Heitmueller { 835d3829fadSDevin Heitmueller switch (f_type) { 836d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 837d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 838d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 839d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 840d3829fadSDevin Heitmueller default: 841d3829fadSDevin Heitmueller BUG(); 842d3829fadSDevin Heitmueller } 843d3829fadSDevin Heitmueller } 844d3829fadSDevin Heitmueller 845d3829fadSDevin Heitmueller /* Usage lock check functions */ 846d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 847d3829fadSDevin Heitmueller { 848d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 849d3829fadSDevin Heitmueller 850d3829fadSDevin Heitmueller /* is it free? */ 851d3829fadSDevin Heitmueller if (dev->resources & res_type) { 852d3829fadSDevin Heitmueller /* no, someone else uses it */ 853d3829fadSDevin Heitmueller return -EBUSY; 854d3829fadSDevin Heitmueller } 855d3829fadSDevin Heitmueller 856d3829fadSDevin Heitmueller /* it's free, grab it */ 857d3829fadSDevin Heitmueller dev->resources |= res_type; 858d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 859d3829fadSDevin Heitmueller return 0; 860d3829fadSDevin Heitmueller } 861d3829fadSDevin Heitmueller 862d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 863d3829fadSDevin Heitmueller { 864d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 865d3829fadSDevin Heitmueller 866d3829fadSDevin Heitmueller dev->resources &= ~res_type; 867d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 868d3829fadSDevin Heitmueller } 869d3829fadSDevin Heitmueller 87037ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev) 87137ecc7b1SMauro Carvalho Chehab { 87237ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 87337ecc7b1SMauro Carvalho Chehab int i; 87437ecc7b1SMauro Carvalho Chehab 87537ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 87637ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 87737ecc7b1SMauro Carvalho Chehab return; 87837ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]); 87937ecc7b1SMauro Carvalho Chehab } 88037ecc7b1SMauro Carvalho Chehab #endif 88137ecc7b1SMauro Carvalho Chehab } 88237ecc7b1SMauro Carvalho Chehab 88337ecc7b1SMauro Carvalho Chehab /* 88437ecc7b1SMauro Carvalho Chehab * Media Controller helper functions 88537ecc7b1SMauro Carvalho Chehab */ 88637ecc7b1SMauro Carvalho Chehab 88737ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev) 88837ecc7b1SMauro Carvalho Chehab { 88937ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 89037ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev; 89137ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 89237ecc7b1SMauro Carvalho Chehab struct media_entity *source; 89337ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL; 89437ecc7b1SMauro Carvalho Chehab int ret, active_links = 0; 89537ecc7b1SMauro Carvalho Chehab 89637ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder) 89737ecc7b1SMauro Carvalho Chehab return 0; 89837ecc7b1SMauro Carvalho Chehab 89937ecc7b1SMauro Carvalho Chehab /* 90037ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder. 90137ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be 90237ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't 90337ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2, 90437ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs. 90537ecc7b1SMauro Carvalho Chehab */ 90637ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) { 90737ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) { 90837ecc7b1SMauro Carvalho Chehab found_link = link; 90937ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED) 91037ecc7b1SMauro Carvalho Chehab active_links++; 91137ecc7b1SMauro Carvalho Chehab break; 91237ecc7b1SMauro Carvalho Chehab } 91337ecc7b1SMauro Carvalho Chehab } 91437ecc7b1SMauro Carvalho Chehab 91537ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link) 91637ecc7b1SMauro Carvalho Chehab return 0; 91737ecc7b1SMauro Carvalho Chehab 91837ecc7b1SMauro Carvalho Chehab source = found_link->source->entity; 91937ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) { 92037ecc7b1SMauro Carvalho Chehab struct media_entity *sink; 92137ecc7b1SMauro Carvalho Chehab int flags = 0; 92237ecc7b1SMauro Carvalho Chehab 92337ecc7b1SMauro Carvalho Chehab sink = link->sink->entity; 92437ecc7b1SMauro Carvalho Chehab 92537ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder) 92637ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED; 92737ecc7b1SMauro Carvalho Chehab 92837ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags); 92937ecc7b1SMauro Carvalho Chehab if (ret) { 93029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 931ce8591ffSMauro Carvalho Chehab "Couldn't change link %s->%s to %s. Error %d\n", 93237ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93337ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled", 93437ecc7b1SMauro Carvalho Chehab ret); 93537ecc7b1SMauro Carvalho Chehab return ret; 93637ecc7b1SMauro Carvalho Chehab } else 93737ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n", 93837ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93937ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled"); 94037ecc7b1SMauro Carvalho Chehab } 94137ecc7b1SMauro Carvalho Chehab #endif 94237ecc7b1SMauro Carvalho Chehab return 0; 94337ecc7b1SMauro Carvalho Chehab } 94437ecc7b1SMauro Carvalho Chehab 94537ecc7b1SMauro Carvalho Chehab static const char * const iname[] = { 94637ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite", 94737ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 94837ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 94937ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio", 95037ecc7b1SMauro Carvalho Chehab }; 95137ecc7b1SMauro Carvalho Chehab 95237ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev) 95337ecc7b1SMauro Carvalho Chehab { 95437ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER) 95537ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 95637ecc7b1SMauro Carvalho Chehab int ret, i; 95737ecc7b1SMauro Carvalho Chehab 95837ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */ 95937ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK; 96037ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad); 96137ecc7b1SMauro Carvalho Chehab if (ret < 0) 96229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 963ce8591ffSMauro Carvalho Chehab "failed to initialize video media entity!\n"); 96437ecc7b1SMauro Carvalho Chehab 96537ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) { 96637ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK; 96737ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1, 96837ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad); 96937ecc7b1SMauro Carvalho Chehab if (ret < 0) 97029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 971ce8591ffSMauro Carvalho Chehab "failed to initialize vbi media entity!\n"); 97237ecc7b1SMauro Carvalho Chehab } 97337ecc7b1SMauro Carvalho Chehab 97437ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */ 975aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 97637ecc7b1SMauro Carvalho Chehab return; 97737ecc7b1SMauro Carvalho Chehab 97837ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */ 97937ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 98037ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i]; 98137ecc7b1SMauro Carvalho Chehab 98237ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 98337ecc7b1SMauro Carvalho Chehab break; 98437ecc7b1SMauro Carvalho Chehab 98537ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type]; 98637ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR; 98737ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 98837ecc7b1SMauro Carvalho Chehab 98937ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) { 99037ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE: 99137ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 99237ecc7b1SMauro Carvalho Chehab break; 99337ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO: 99437ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO; 99537ecc7b1SMauro Carvalho Chehab break; 99637ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */ 997e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 99837ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF; 99937ecc7b1SMauro Carvalho Chehab break; 100037ecc7b1SMauro Carvalho Chehab } 100137ecc7b1SMauro Carvalho Chehab 100237ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 100337ecc7b1SMauro Carvalho Chehab if (ret < 0) 100429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1005ce8591ffSMauro Carvalho Chehab "failed to initialize input pad[%d]!\n", i); 100637ecc7b1SMauro Carvalho Chehab 100737ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent); 100837ecc7b1SMauro Carvalho Chehab if (ret < 0) 100929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1010ce8591ffSMauro Carvalho Chehab "failed to register input entity %d!\n", i); 101137ecc7b1SMauro Carvalho Chehab } 101237ecc7b1SMauro Carvalho Chehab #endif 101337ecc7b1SMauro Carvalho Chehab } 101437ecc7b1SMauro Carvalho Chehab 101537ecc7b1SMauro Carvalho Chehab 10160c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1017d3829fadSDevin Heitmueller Videobuf2 operations 10180c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 10190c0d06caSMauro Carvalho Chehab 1020df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq, 1021d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 102236c0f8b3SHans Verkuil unsigned int sizes[], struct device *alloc_devs[]) 10230c0d06caSMauro Carvalho Chehab { 1024d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1025753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1026df9ecb0cSHans Verkuil unsigned long size = 102706e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 10280c0d06caSMauro Carvalho Chehab 1029df9ecb0cSHans Verkuil if (*nplanes) 1030df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0; 1031d3829fadSDevin Heitmueller *nplanes = 1; 1032d3829fadSDevin Heitmueller sizes[0] = size; 103337ecc7b1SMauro Carvalho Chehab 103437ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev); 103537ecc7b1SMauro Carvalho Chehab 10360c0d06caSMauro Carvalho Chehab return 0; 10370c0d06caSMauro Carvalho Chehab } 10380c0d06caSMauro Carvalho Chehab 10390c0d06caSMauro Carvalho Chehab static int 1040d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 10410c0d06caSMauro Carvalho Chehab { 10422d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1043d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1044753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1045d3829fadSDevin Heitmueller unsigned long size; 10460c0d06caSMauro Carvalho Chehab 10472d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field); 10480c0d06caSMauro Carvalho Chehab 104906e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 1050d3829fadSDevin Heitmueller 1051d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 1052d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 1053d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 10540c0d06caSMauro Carvalho Chehab return -EINVAL; 1055d3829fadSDevin Heitmueller } 10562d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size); 10570c0d06caSMauro Carvalho Chehab 1058d3829fadSDevin Heitmueller return 0; 10590c0d06caSMauro Carvalho Chehab } 10600c0d06caSMauro Carvalho Chehab 1061d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 1062d3829fadSDevin Heitmueller { 1063d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1064f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1065d3829fadSDevin Heitmueller struct v4l2_frequency f; 10662d700715SJunghak Sung struct v4l2_fh *owner; 1067d3829fadSDevin Heitmueller int rc = 0; 10680c0d06caSMauro Carvalho Chehab 1069d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1070d3829fadSDevin Heitmueller 1071d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 1072d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 1073d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1074d3829fadSDevin Heitmueller if (rc) 1075d3829fadSDevin Heitmueller return rc; 1076d3829fadSDevin Heitmueller 10778139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1078d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1079d3829fadSDevin Heitmueller 1080d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1081d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1082d3829fadSDevin Heitmueller 1083d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 1084d3829fadSDevin Heitmueller some i2c device 1085d3829fadSDevin Heitmueller */ 1086d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1087d3829fadSDevin Heitmueller 1088f0e38230SFrank Schaefer v4l2->capture_type = -1; 1089c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1090c647a91aSFrank Schaefer dev->analog_xfer_bulk, 10910c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 10920c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1093c647a91aSFrank Schaefer dev->packet_multiplier, 10940fa4a402SFrank Schaefer em28xx_urb_data_copy); 10950c0d06caSMauro Carvalho Chehab if (rc < 0) 1096032f1ddfSFrank Schaefer return rc; 1097d3829fadSDevin Heitmueller 1098d3829fadSDevin Heitmueller /* 1099d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1100d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1101d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1102d3829fadSDevin Heitmueller */ 1103d3829fadSDevin Heitmueller 1104d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1105d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11063854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11072d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11082d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1109d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1110d3829fadSDevin Heitmueller else 1111d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1112f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 111395d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 111413d52fe4SMauro Carvalho Chehab 111513d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 111613d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11170c0d06caSMauro Carvalho Chehab } 11180c0d06caSMauro Carvalho Chehab 11198139a4d5SFrank Schaefer v4l2->streaming_users++; 1120032f1ddfSFrank Schaefer 11210c0d06caSMauro Carvalho Chehab return rc; 11220c0d06caSMauro Carvalho Chehab } 11230c0d06caSMauro Carvalho Chehab 1124e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11250c0d06caSMauro Carvalho Chehab { 1126d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11278139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11280c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1129d3829fadSDevin Heitmueller unsigned long flags = 0; 11300c0d06caSMauro Carvalho Chehab 1131d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11320c0d06caSMauro Carvalho Chehab 1133d3829fadSDevin Heitmueller res_free(dev, vq->type); 1134d3829fadSDevin Heitmueller 11358139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 113613d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 113713d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 113813d52fe4SMauro Carvalho Chehab 1139d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1140d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11410c0d06caSMauro Carvalho Chehab } 11420c0d06caSMauro Carvalho Chehab 1143d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1144627530c3SFrank Schaefer if (dev->usb_ctl.vid_buf != NULL) { 11452d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11462d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1147627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1148627530c3SFrank Schaefer } 1149d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1150d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1151fdf1bc9fSMauro Carvalho Chehab 1152d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1153d3829fadSDevin Heitmueller list_del(&buf->list); 11542d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1155d3829fadSDevin Heitmueller } 1156d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1157d3829fadSDevin Heitmueller } 1158d3829fadSDevin Heitmueller 1159e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11600c0d06caSMauro Carvalho Chehab { 1161d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11628139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1163d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1164d3829fadSDevin Heitmueller unsigned long flags = 0; 11650c0d06caSMauro Carvalho Chehab 1166d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11670c0d06caSMauro Carvalho Chehab 1168d3829fadSDevin Heitmueller res_free(dev, vq->type); 1169d3829fadSDevin Heitmueller 11708139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 117113d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 117213d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 117313d52fe4SMauro Carvalho Chehab 1174d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1175d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11760c0d06caSMauro Carvalho Chehab } 11770c0d06caSMauro Carvalho Chehab 1178d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1179627530c3SFrank Schaefer if (dev->usb_ctl.vbi_buf != NULL) { 11802d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 11812d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1182627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1183627530c3SFrank Schaefer } 1184d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1185d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1186fdf1bc9fSMauro Carvalho Chehab 1187d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1188d3829fadSDevin Heitmueller list_del(&buf->list); 11892d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1190d3829fadSDevin Heitmueller } 1191d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1192d3829fadSDevin Heitmueller } 1193d3829fadSDevin Heitmueller 1194d3829fadSDevin Heitmueller static void 1195d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1196d3829fadSDevin Heitmueller { 11972d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1198d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 11992d700715SJunghak Sung struct em28xx_buffer *buf = 12002d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1201d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1202d3829fadSDevin Heitmueller unsigned long flags = 0; 1203d3829fadSDevin Heitmueller 1204d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1205d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1206d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1207d3829fadSDevin Heitmueller 1208d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1209d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1210d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1211d3829fadSDevin Heitmueller } 1212d3829fadSDevin Heitmueller 12131bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = { 1214d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12150c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12160c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1217d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1218d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1219d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1220d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12210c0d06caSMauro Carvalho Chehab }; 12220c0d06caSMauro Carvalho Chehab 122301c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1224d3829fadSDevin Heitmueller { 1225d3829fadSDevin Heitmueller int rc; 1226d3829fadSDevin Heitmueller struct vb2_queue *q; 122727a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1228d3829fadSDevin Heitmueller 1229d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 123027a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1231d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1232ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1233ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1234d3829fadSDevin Heitmueller q->drv_priv = dev; 1235d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1236d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1237d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1238d3829fadSDevin Heitmueller 1239d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1240d3829fadSDevin Heitmueller if (rc < 0) 1241d3829fadSDevin Heitmueller return rc; 1242d3829fadSDevin Heitmueller 1243d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 124427a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1245d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1246d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1247ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1248d3829fadSDevin Heitmueller q->drv_priv = dev; 1249d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1250d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1251d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1252d3829fadSDevin Heitmueller 1253d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1254d3829fadSDevin Heitmueller if (rc < 0) 1255d3829fadSDevin Heitmueller return rc; 1256d3829fadSDevin Heitmueller 1257d3829fadSDevin Heitmueller return 0; 1258d3829fadSDevin Heitmueller } 1259d3829fadSDevin Heitmueller 12600c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 12610c0d06caSMauro Carvalho Chehab 12620c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12630c0d06caSMauro Carvalho Chehab { 126495d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1265fdf1bc9fSMauro Carvalho Chehab 12660c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12670c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 12680c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 12690c0d06caSMauro Carvalho Chehab 12700c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 12710c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 12720c0d06caSMauro Carvalho Chehab 127395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 12740c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 12750c0d06caSMauro Carvalho Chehab 1276aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 12770c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 127895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 12790c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 12800c0d06caSMauro Carvalho Chehab } 12810c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 128295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1283fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1284fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 12850c0d06caSMauro Carvalho Chehab } 12860c0d06caSMauro Carvalho Chehab 12870c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 128895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 12890c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 12900c0d06caSMauro Carvalho Chehab } 12910c0d06caSMauro Carvalho Chehab 12920c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 12930c0d06caSMauro Carvalho Chehab } 12940c0d06caSMauro Carvalho Chehab 129501c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 12960c0d06caSMauro Carvalho Chehab { 1297081b945eSHans Verkuil struct em28xx *dev = priv; 12980c0d06caSMauro Carvalho Chehab 12990c0d06caSMauro Carvalho Chehab /* 1300081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1301081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1302081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1303081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 13040c0d06caSMauro Carvalho Chehab */ 13050c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13060c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1307081b945eSHans Verkuil dev->mute = ctrl->val; 1308081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13090c0d06caSMauro Carvalho Chehab break; 13100c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1311081b945eSHans Verkuil dev->volume = ctrl->val; 1312081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1313081b945eSHans Verkuil break; 1314081b945eSHans Verkuil } 1315081b945eSHans Verkuil } 1316081b945eSHans Verkuil 1317081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1318081b945eSHans Verkuil { 1319abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1320abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1321abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13228f8b113aSFrank Schaefer int ret = -EINVAL; 1323081b945eSHans Verkuil 1324081b945eSHans Verkuil switch (ctrl->id) { 1325081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1326081b945eSHans Verkuil dev->mute = ctrl->val; 13278f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1328081b945eSHans Verkuil break; 1329081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1330081b945eSHans Verkuil dev->volume = ctrl->val; 13318f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13328f8b113aSFrank Schaefer break; 13338f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13348f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13358f8b113aSFrank Schaefer break; 13368f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13378f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13388f8b113aSFrank Schaefer break; 13398f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13408f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13418f8b113aSFrank Schaefer break; 13428f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13438f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13448f8b113aSFrank Schaefer break; 13458f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13468f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13478f8b113aSFrank Schaefer break; 13488f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13498f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13500c0d06caSMauro Carvalho Chehab break; 13510c0d06caSMauro Carvalho Chehab } 13520c0d06caSMauro Carvalho Chehab 13538f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13540c0d06caSMauro Carvalho Chehab } 13550c0d06caSMauro Carvalho Chehab 13568068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1357081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1358081b945eSHans Verkuil }; 1359081b945eSHans Verkuil 13606b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13610c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13620c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13630c0d06caSMauro Carvalho Chehab { 13640c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13650c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13660c0d06caSMauro Carvalho Chehab 13670c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 136881685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 136981685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 13700c0d06caSMauro Carvalho Chehab 13710c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 137281685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 137381685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 13740c0d06caSMauro Carvalho Chehab } 13750c0d06caSMauro Carvalho Chehab 1376b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1377b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1378b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1379b8374138SFrank Schaefer { 1380b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1381b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1382b8374138SFrank Schaefer 1383b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1384b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 13850962a763SMauro Carvalho Chehab 13860962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 13870962a763SMauro Carvalho Chehab if (*width < 1) 13880962a763SMauro Carvalho Chehab *width = 1; 13890962a763SMauro Carvalho Chehab if (*height < 1) 13900962a763SMauro Carvalho Chehab *height = 1; 1391b8374138SFrank Schaefer } 1392b8374138SFrank Schaefer 13930c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 13940c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 13950c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 13960c0d06caSMauro Carvalho Chehab 13970c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 13980c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13990c0d06caSMauro Carvalho Chehab { 1400917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1401753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14020c0d06caSMauro Carvalho Chehab 1403753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1404753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 140506e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 140606e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1407753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14080c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14090c0d06caSMauro Carvalho Chehab 14100c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 141158159171SFrank Schaefer if (v4l2->progressive) 14120c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14130c0d06caSMauro Carvalho Chehab else 141458159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14150c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14160c0d06caSMauro Carvalho Chehab return 0; 14170c0d06caSMauro Carvalho Chehab } 14180c0d06caSMauro Carvalho Chehab 14190c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14200c0d06caSMauro Carvalho Chehab { 14210c0d06caSMauro Carvalho Chehab unsigned int i; 14220c0d06caSMauro Carvalho Chehab 14230c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14240c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14250c0d06caSMauro Carvalho Chehab return &format[i]; 14260c0d06caSMauro Carvalho Chehab 14270c0d06caSMauro Carvalho Chehab return NULL; 14280c0d06caSMauro Carvalho Chehab } 14290c0d06caSMauro Carvalho Chehab 14300c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14310c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14320c0d06caSMauro Carvalho Chehab { 1433917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 143458159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14350c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14360c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14370c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14380c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14390c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14400c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14410c0d06caSMauro Carvalho Chehab 14420c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14430c0d06caSMauro Carvalho Chehab if (!fmt) { 14440c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14450c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 14460c0d06caSMauro Carvalho Chehab return -EINVAL; 14470c0d06caSMauro Carvalho Chehab } 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14500c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14510c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14520c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1453d3829fadSDevin Heitmueller /* 1454d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1455d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1456d3829fadSDevin Heitmueller * to 50% 1457d3829fadSDevin Heitmueller */ 14580c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14590c0d06caSMauro Carvalho Chehab width /= 2; 14600c0d06caSMauro Carvalho Chehab } else { 14610c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 14620c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 14630c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14640c0d06caSMauro Carvalho Chehab 1, 0); 14650c0d06caSMauro Carvalho Chehab } 14660962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 14670962a763SMauro Carvalho Chehab if (width < 1) 14680962a763SMauro Carvalho Chehab width = 1; 14690962a763SMauro Carvalho Chehab if (height < 1) 14700962a763SMauro Carvalho Chehab height = 1; 14710c0d06caSMauro Carvalho Chehab 14726b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 147346f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 14740c0d06caSMauro Carvalho Chehab 14750c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 14760c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 14770c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1478e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 14790c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 14800c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 148158159171SFrank Schaefer if (v4l2->progressive) 14820c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14830c0d06caSMauro Carvalho Chehab else 148458159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14850c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 148651dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 14870c0d06caSMauro Carvalho Chehab 14880c0d06caSMauro Carvalho Chehab return 0; 14890c0d06caSMauro Carvalho Chehab } 14900c0d06caSMauro Carvalho Chehab 14910c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 14920c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 14930c0d06caSMauro Carvalho Chehab { 14940c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1495753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14960c0d06caSMauro Carvalho Chehab 14970c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 14980c0d06caSMauro Carvalho Chehab if (!fmt) 14990c0d06caSMauro Carvalho Chehab return -EINVAL; 15000c0d06caSMauro Carvalho Chehab 150106e20672SFrank Schaefer v4l2->format = fmt; 1502753aee77SFrank Schaefer v4l2->width = width; 1503753aee77SFrank Schaefer v4l2->height = height; 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab /* set new image size */ 1506753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1507753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15100c0d06caSMauro Carvalho Chehab 15110c0d06caSMauro Carvalho Chehab return 0; 15120c0d06caSMauro Carvalho Chehab } 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15150c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15160c0d06caSMauro Carvalho Chehab { 1517d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15188139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15190c0d06caSMauro Carvalho Chehab 1520c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1521d3829fadSDevin Heitmueller return -EBUSY; 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15240c0d06caSMauro Carvalho Chehab 15250c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15260c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15270c0d06caSMauro Carvalho Chehab } 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15300c0d06caSMauro Carvalho Chehab { 1531917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15320c0d06caSMauro Carvalho Chehab 153352faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab return 0; 15360c0d06caSMauro Carvalho Chehab } 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15390c0d06caSMauro Carvalho Chehab { 1540917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15410c0d06caSMauro Carvalho Chehab 154295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15430c0d06caSMauro Carvalho Chehab 15440c0d06caSMauro Carvalho Chehab return 0; 15450c0d06caSMauro Carvalho Chehab } 15460c0d06caSMauro Carvalho Chehab 1547314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15480c0d06caSMauro Carvalho Chehab { 1549917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1550753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15510c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15520c0d06caSMauro Carvalho Chehab 155352faaf78SFrank Schaefer if (norm == v4l2->norm) 1554d8c95c08SHans Verkuil return 0; 15550c0d06caSMauro Carvalho Chehab 15568139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1557d8c95c08SHans Verkuil return -EBUSY; 1558d8c95c08SHans Verkuil 155952faaf78SFrank Schaefer v4l2->norm = norm; 15600c0d06caSMauro Carvalho Chehab 15610c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1562d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1563314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15640c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15650c0d06caSMauro Carvalho Chehab 15660c0d06caSMauro Carvalho Chehab /* set new image size */ 1567753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1568753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1569753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1570753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15710c0d06caSMauro Carvalho Chehab 15720c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15738774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 15740c0d06caSMauro Carvalho Chehab 15750c0d06caSMauro Carvalho Chehab return 0; 15760c0d06caSMauro Carvalho Chehab } 15770c0d06caSMauro Carvalho Chehab 15780c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 15790c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 15800c0d06caSMauro Carvalho Chehab { 15814471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 0 }; 1582917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 158352faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15840c0d06caSMauro Carvalho Chehab int rc = 0; 15850c0d06caSMauro Carvalho Chehab 15864471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 15874471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 15884471109eSHans Verkuil return -EINVAL; 15894471109eSHans Verkuil 159086ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 15914471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 1592aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 159352faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 15944471109eSHans Verkuil video, g_frame_interval, &ival); 15954471109eSHans Verkuil if (!rc) 15964471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 15974471109eSHans Verkuil } else { 159852faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 15990c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 16004471109eSHans Verkuil } 16010c0d06caSMauro Carvalho Chehab 16020c0d06caSMauro Carvalho Chehab return rc; 16030c0d06caSMauro Carvalho Chehab } 16040c0d06caSMauro Carvalho Chehab 16050c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 16060c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16070c0d06caSMauro Carvalho Chehab { 1608917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16094471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 16104471109eSHans Verkuil 0, 16114471109eSHans Verkuil p->parm.capture.timeperframe 16124471109eSHans Verkuil }; 16134471109eSHans Verkuil int rc = 0; 16140c0d06caSMauro Carvalho Chehab 1615aa62980bSMauro Carvalho Chehab if (!dev->is_webcam) 16164471109eSHans Verkuil return -ENOTTY; 16174471109eSHans Verkuil 16184471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16194471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16204471109eSHans Verkuil return -EINVAL; 16214471109eSHans Verkuil 16224471109eSHans Verkuil memset(&p->parm, 0, sizeof(p->parm)); 162386ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16244471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 16254471109eSHans Verkuil rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0, 16264471109eSHans Verkuil video, s_frame_interval, &ival); 16274471109eSHans Verkuil if (!rc) 16284471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16294471109eSHans Verkuil return rc; 16300c0d06caSMauro Carvalho Chehab } 16310c0d06caSMauro Carvalho Chehab 16320c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16330c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16340c0d06caSMauro Carvalho Chehab { 1635917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16360c0d06caSMauro Carvalho Chehab unsigned int n; 16370c0d06caSMauro Carvalho Chehab 16380c0d06caSMauro Carvalho Chehab n = i->index; 16390c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16400c0d06caSMauro Carvalho Chehab return -EINVAL; 16410c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 16420c0d06caSMauro Carvalho Chehab return -EINVAL; 16430c0d06caSMauro Carvalho Chehab 16440c0d06caSMauro Carvalho Chehab i->index = n; 16450c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16460c0d06caSMauro Carvalho Chehab 16470c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 16480c0d06caSMauro Carvalho Chehab 1649d83a96a5SMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type)) 16500c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16510c0d06caSMauro Carvalho Chehab 1652d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1653d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1654aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1655d8c95c08SHans Verkuil i->capabilities = 0; 16560c0d06caSMauro Carvalho Chehab 16570c0d06caSMauro Carvalho Chehab return 0; 16580c0d06caSMauro Carvalho Chehab } 16590c0d06caSMauro Carvalho Chehab 16600c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16610c0d06caSMauro Carvalho Chehab { 1662917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16630c0d06caSMauro Carvalho Chehab 16640c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 16650c0d06caSMauro Carvalho Chehab 16660c0d06caSMauro Carvalho Chehab return 0; 16670c0d06caSMauro Carvalho Chehab } 16680c0d06caSMauro Carvalho Chehab 16690c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 16700c0d06caSMauro Carvalho Chehab { 1671917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16720c0d06caSMauro Carvalho Chehab 16730c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 16740c0d06caSMauro Carvalho Chehab return -EINVAL; 16750c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 16760c0d06caSMauro Carvalho Chehab return -EINVAL; 16770c0d06caSMauro Carvalho Chehab 16780c0d06caSMauro Carvalho Chehab video_mux(dev, i); 16790c0d06caSMauro Carvalho Chehab return 0; 16800c0d06caSMauro Carvalho Chehab } 16810c0d06caSMauro Carvalho Chehab 16820c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 16830c0d06caSMauro Carvalho Chehab { 1684917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16850c0d06caSMauro Carvalho Chehab 16860c0d06caSMauro Carvalho Chehab switch (a->index) { 16870c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 16880c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 16890c0d06caSMauro Carvalho Chehab break; 16900c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 16910c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 16920c0d06caSMauro Carvalho Chehab break; 16930c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 16940c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 16950c0d06caSMauro Carvalho Chehab break; 16960c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 16970c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 16980c0d06caSMauro Carvalho Chehab break; 16990c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 17000c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 17010c0d06caSMauro Carvalho Chehab break; 17020c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 17030c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 17040c0d06caSMauro Carvalho Chehab break; 17050c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 17060c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 17070c0d06caSMauro Carvalho Chehab break; 17080c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 17090c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 17100c0d06caSMauro Carvalho Chehab break; 17110c0d06caSMauro Carvalho Chehab default: 17120c0d06caSMauro Carvalho Chehab return -EINVAL; 17130c0d06caSMauro Carvalho Chehab } 17140c0d06caSMauro Carvalho Chehab 17150c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 17160c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 17170c0d06caSMauro Carvalho Chehab 17180c0d06caSMauro Carvalho Chehab return 0; 17190c0d06caSMauro Carvalho Chehab } 17200c0d06caSMauro Carvalho Chehab 17210e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 17220c0d06caSMauro Carvalho Chehab { 1723917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17240c0d06caSMauro Carvalho Chehab 17250c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 17260c0d06caSMauro Carvalho Chehab return -EINVAL; 17270c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 17280c0d06caSMauro Carvalho Chehab return -EINVAL; 17290c0d06caSMauro Carvalho Chehab 17300c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 17310c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 17320c0d06caSMauro Carvalho Chehab 17330c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 17340c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 17350c0d06caSMauro Carvalho Chehab 17360c0d06caSMauro Carvalho Chehab return 0; 17370c0d06caSMauro Carvalho Chehab } 17380c0d06caSMauro Carvalho Chehab 17390c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 17400c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17410c0d06caSMauro Carvalho Chehab { 1742917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17430c0d06caSMauro Carvalho Chehab 17440c0d06caSMauro Carvalho Chehab if (0 != t->index) 17450c0d06caSMauro Carvalho Chehab return -EINVAL; 17460c0d06caSMauro Carvalho Chehab 17470c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 17480c0d06caSMauro Carvalho Chehab 174995d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 17500c0d06caSMauro Carvalho Chehab return 0; 17510c0d06caSMauro Carvalho Chehab } 17520c0d06caSMauro Carvalho Chehab 17530c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 17542f73c7c5SHans Verkuil const struct v4l2_tuner *t) 17550c0d06caSMauro Carvalho Chehab { 1756917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17570c0d06caSMauro Carvalho Chehab 17580c0d06caSMauro Carvalho Chehab if (0 != t->index) 17590c0d06caSMauro Carvalho Chehab return -EINVAL; 17600c0d06caSMauro Carvalho Chehab 176195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 17620c0d06caSMauro Carvalho Chehab return 0; 17630c0d06caSMauro Carvalho Chehab } 17640c0d06caSMauro Carvalho Chehab 17650c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 17660c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 17670c0d06caSMauro Carvalho Chehab { 1768917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17693854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17700c0d06caSMauro Carvalho Chehab 177120deebfeSHans Verkuil if (0 != f->tuner) 177220deebfeSHans Verkuil return -EINVAL; 177320deebfeSHans Verkuil 17743854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 17750c0d06caSMauro Carvalho Chehab return 0; 17760c0d06caSMauro Carvalho Chehab } 17770c0d06caSMauro Carvalho Chehab 17780c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1779b530a447SHans Verkuil const struct v4l2_frequency *f) 17800c0d06caSMauro Carvalho Chehab { 1781b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1782917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 178395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17840c0d06caSMauro Carvalho Chehab 17850c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 17860c0d06caSMauro Carvalho Chehab return -EINVAL; 17870c0d06caSMauro Carvalho Chehab 178895d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 178995d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 17903854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 17910c0d06caSMauro Carvalho Chehab 17920c0d06caSMauro Carvalho Chehab return 0; 17930c0d06caSMauro Carvalho Chehab } 17940c0d06caSMauro Carvalho Chehab 1795cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 179696b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 179796b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 17983b2d17b4SHans Verkuil { 1799917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18003b2d17b4SHans Verkuil 18013b2d17b4SHans Verkuil if (chip->match.addr > 1) 18023b2d17b4SHans Verkuil return -EINVAL; 18033b2d17b4SHans Verkuil if (chip->match.addr == 1) 18043b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 18053b2d17b4SHans Verkuil else 180695d2608bSFrank Schaefer strlcpy(chip->name, 180795d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 18083b2d17b4SHans Verkuil return 0; 18093b2d17b4SHans Verkuil } 18103b2d17b4SHans Verkuil 181135deba32SFrank Schaefer static int em28xx_reg_len(int reg) 181235deba32SFrank Schaefer { 181335deba32SFrank Schaefer switch (reg) { 181435deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 181535deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 181635deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 181735deba32SFrank Schaefer return 2; 181835deba32SFrank Schaefer default: 181935deba32SFrank Schaefer return 1; 182035deba32SFrank Schaefer } 182135deba32SFrank Schaefer } 18220c0d06caSMauro Carvalho Chehab 18230c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 18240c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 18250c0d06caSMauro Carvalho Chehab { 1826917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18270c0d06caSMauro Carvalho Chehab int ret; 18280c0d06caSMauro Carvalho Chehab 18293b2d17b4SHans Verkuil if (reg->match.addr > 1) 18303b2d17b4SHans Verkuil return -EINVAL; 1831abca2056SHans Verkuil if (reg->match.addr) { 18320c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 18330c0d06caSMauro Carvalho Chehab if (ret < 0) 18340c0d06caSMauro Carvalho Chehab return ret; 18350c0d06caSMauro Carvalho Chehab 18360c0d06caSMauro Carvalho Chehab reg->val = ret; 18370c0d06caSMauro Carvalho Chehab reg->size = 1; 18380c0d06caSMauro Carvalho Chehab return 0; 18390c0d06caSMauro Carvalho Chehab } 18400c0d06caSMauro Carvalho Chehab 18410c0d06caSMauro Carvalho Chehab /* Match host */ 18420c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 18430c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 18440c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 18450c0d06caSMauro Carvalho Chehab 18460c0d06caSMauro Carvalho Chehab if (ret < 0) 18470c0d06caSMauro Carvalho Chehab return ret; 18480c0d06caSMauro Carvalho Chehab 18490c0d06caSMauro Carvalho Chehab reg->val = ret; 18500c0d06caSMauro Carvalho Chehab } else { 18510c0d06caSMauro Carvalho Chehab __le16 val = 0; 1852fdf1bc9fSMauro Carvalho Chehab 185301c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 18540c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 18550c0d06caSMauro Carvalho Chehab if (ret < 0) 18560c0d06caSMauro Carvalho Chehab return ret; 18570c0d06caSMauro Carvalho Chehab 18580c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 18590c0d06caSMauro Carvalho Chehab } 18600c0d06caSMauro Carvalho Chehab 18610c0d06caSMauro Carvalho Chehab return 0; 18620c0d06caSMauro Carvalho Chehab } 18630c0d06caSMauro Carvalho Chehab 18640c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1865977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 18660c0d06caSMauro Carvalho Chehab { 1867917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18680c0d06caSMauro Carvalho Chehab __le16 buf; 18690c0d06caSMauro Carvalho Chehab 18703b2d17b4SHans Verkuil if (reg->match.addr > 1) 18713b2d17b4SHans Verkuil return -EINVAL; 1872abca2056SHans Verkuil if (reg->match.addr) 18730c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 18740c0d06caSMauro Carvalho Chehab 18750c0d06caSMauro Carvalho Chehab /* Match host */ 18760c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 18770c0d06caSMauro Carvalho Chehab 18780c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 18790c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 18800c0d06caSMauro Carvalho Chehab } 18810c0d06caSMauro Carvalho Chehab #endif 18820c0d06caSMauro Carvalho Chehab 18830c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 18840c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 18850c0d06caSMauro Carvalho Chehab { 1886a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1887917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1888ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1889c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 18900c0d06caSMauro Carvalho Chehab 18910c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 18920c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1893c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 18940c0d06caSMauro Carvalho Chehab 1895a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1896a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1897a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1898a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1899a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1900a9d79fe5SHans Verkuil else 19011d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 19020c0d06caSMauro Carvalho Chehab 1903920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 1904a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 19050c0d06caSMauro Carvalho Chehab 19060c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1907a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 19080c0d06caSMauro Carvalho Chehab 1909a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1910a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1911d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 19121d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1913d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 1914a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 19150c0d06caSMauro Carvalho Chehab return 0; 19160c0d06caSMauro Carvalho Chehab } 19170c0d06caSMauro Carvalho Chehab 19180c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 19190c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 19200c0d06caSMauro Carvalho Chehab { 19210c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 19220c0d06caSMauro Carvalho Chehab return -EINVAL; 19230c0d06caSMauro Carvalho Chehab 19240c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 19250c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 19260c0d06caSMauro Carvalho Chehab 19270c0d06caSMauro Carvalho Chehab return 0; 19280c0d06caSMauro Carvalho Chehab } 19290c0d06caSMauro Carvalho Chehab 19300c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 19310c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 19320c0d06caSMauro Carvalho Chehab { 1933917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19340c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 19350c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 19360c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 19370c0d06caSMauro Carvalho Chehab 19380c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 19390c0d06caSMauro Carvalho Chehab if (!fmt) { 19400c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 19410c0d06caSMauro Carvalho Chehab fsize->pixel_format); 19420c0d06caSMauro Carvalho Chehab return -EINVAL; 19430c0d06caSMauro Carvalho Chehab } 19440c0d06caSMauro Carvalho Chehab 19450c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 19460c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 19470c0d06caSMauro Carvalho Chehab return -EINVAL; 19480c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 19490c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 19500c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 19510c0d06caSMauro Carvalho Chehab return 0; 19520c0d06caSMauro Carvalho Chehab } 19530c0d06caSMauro Carvalho Chehab 19540c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 19550c0d06caSMauro Carvalho Chehab return -EINVAL; 19560c0d06caSMauro Carvalho Chehab 19570c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 19580c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 19596c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 19606c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 19616c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 19620c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 19636c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 19646c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 19650c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 19660c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 19670c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 19680c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 19690c0d06caSMauro Carvalho Chehab return 0; 19700c0d06caSMauro Carvalho Chehab } 19710c0d06caSMauro Carvalho Chehab 19720c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 19750c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 19760c0d06caSMauro Carvalho Chehab { 1977917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1978753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 19790c0d06caSMauro Carvalho Chehab 1980753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 19810c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 19820c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 19830c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 19840c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1985753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1986753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 19872a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 19880c0d06caSMauro Carvalho Chehab 19890c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 199052faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 19910c0d06caSMauro Carvalho Chehab /* NTSC */ 19920c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 19930c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 199452faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 19950c0d06caSMauro Carvalho Chehab /* PAL */ 19960c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 19970c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 19980c0d06caSMauro Carvalho Chehab } 19990c0d06caSMauro Carvalho Chehab 20000c0d06caSMauro Carvalho Chehab return 0; 20010c0d06caSMauro Carvalho Chehab } 20020c0d06caSMauro Carvalho Chehab 20030c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 20040c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 20050c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 20060c0d06caSMauro Carvalho Chehab 20070c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 20080c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 20090c0d06caSMauro Carvalho Chehab { 2010917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20110c0d06caSMauro Carvalho Chehab 20120c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 20130c0d06caSMauro Carvalho Chehab return -EINVAL; 20140c0d06caSMauro Carvalho Chehab 20150c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 20160c0d06caSMauro Carvalho Chehab 201795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 20180c0d06caSMauro Carvalho Chehab 20190c0d06caSMauro Carvalho Chehab return 0; 20200c0d06caSMauro Carvalho Chehab } 20210c0d06caSMauro Carvalho Chehab 20220c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 20232f73c7c5SHans Verkuil const struct v4l2_tuner *t) 20240c0d06caSMauro Carvalho Chehab { 2025917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20260c0d06caSMauro Carvalho Chehab 20270c0d06caSMauro Carvalho Chehab if (0 != t->index) 20280c0d06caSMauro Carvalho Chehab return -EINVAL; 20290c0d06caSMauro Carvalho Chehab 203095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 20310c0d06caSMauro Carvalho Chehab 20320c0d06caSMauro Carvalho Chehab return 0; 20330c0d06caSMauro Carvalho Chehab } 20340c0d06caSMauro Carvalho Chehab 20350c0d06caSMauro Carvalho Chehab /* 203695d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 203795d2608bSFrank Schaefer * 203895d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 203995d2608bSFrank Schaefer * 204095d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 204195d2608bSFrank Schaefer */ 2042f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 204395d2608bSFrank Schaefer { 204495d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 204595d2608bSFrank Schaefer 2046abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 204795d2608bSFrank Schaefer kfree(v4l2); 204895d2608bSFrank Schaefer } 204995d2608bSFrank Schaefer 205095d2608bSFrank Schaefer /* 20510c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 20520c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 20530c0d06caSMauro Carvalho Chehab */ 20540c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 20550c0d06caSMauro Carvalho Chehab { 20560c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 20570c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 205895d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20590c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 20603c0f90e1SFrank Schaefer int ret; 20610c0d06caSMauro Carvalho Chehab 20620c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 20630c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 20640c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 20650c0d06caSMauro Carvalho Chehab break; 20660c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 20670c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 20680c0d06caSMauro Carvalho Chehab break; 20694e170240SFrank Schaefer case VFL_TYPE_RADIO: 20704e170240SFrank Schaefer break; 20714e170240SFrank Schaefer default: 20724e170240SFrank Schaefer return -EINVAL; 20730c0d06caSMauro Carvalho Chehab } 20740c0d06caSMauro Carvalho Chehab 20758e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 20768e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 20778e2c8717SFrank Schaefer v4l2->users); 20780c0d06caSMauro Carvalho Chehab 20790c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 20800c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 20813c0f90e1SFrank Schaefer 20823c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 20833c0f90e1SFrank Schaefer if (ret) { 208429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2085ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 20863c0f90e1SFrank Schaefer __func__, ret); 20870c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20883c0f90e1SFrank Schaefer return ret; 20890c0d06caSMauro Carvalho Chehab } 20900c0d06caSMauro Carvalho Chehab 20918e2c8717SFrank Schaefer if (v4l2->users == 0) { 20920c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 20934e170240SFrank Schaefer 20944e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 20950c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 20960c0d06caSMauro Carvalho Chehab 20974e170240SFrank Schaefer /* 20984e170240SFrank Schaefer * Needed, since GPIO might have disabled power 20994e170240SFrank Schaefer * of some i2c devices 21000c0d06caSMauro Carvalho Chehab */ 21010c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 21020c0d06caSMauro Carvalho Chehab } 2103d3829fadSDevin Heitmueller 2104d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 21050c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 210695d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 21070c0d06caSMauro Carvalho Chehab } 21080c0d06caSMauro Carvalho Chehab 210947677e51SMauro Carvalho Chehab kref_get(&dev->ref); 211095d2608bSFrank Schaefer kref_get(&v4l2->ref); 21118e2c8717SFrank Schaefer v4l2->users++; 21120c0d06caSMauro Carvalho Chehab 21130c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21140c0d06caSMauro Carvalho Chehab 2115d3829fadSDevin Heitmueller return 0; 21160c0d06caSMauro Carvalho Chehab } 21170c0d06caSMauro Carvalho Chehab 21180c0d06caSMauro Carvalho Chehab /* 211901c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 21200c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 21210c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 21220c0d06caSMauro Carvalho Chehab */ 212301c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 21240c0d06caSMauro Carvalho Chehab { 212595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 212695d2608bSFrank Schaefer 2127822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2128822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2129822b8deaSMauro Carvalho Chehab return 0; 2130822b8deaSMauro Carvalho Chehab } 2131822b8deaSMauro Carvalho Chehab 213201c28193SMauro Carvalho Chehab if (!dev->has_video) { 213301c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 213401c28193SMauro Carvalho Chehab return 0; 213501c28193SMauro Carvalho Chehab } 21360c0d06caSMauro Carvalho Chehab 213795d2608bSFrank Schaefer if (v4l2 == NULL) 213895d2608bSFrank Schaefer return 0; 213995d2608bSFrank Schaefer 214029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2141aa929ad7SMauro Carvalho Chehab 2142ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2143ebbfbc20SMauro Carvalho Chehab 214495d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 21455ad10de6SFrank Schaefer 214623e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 214723e8642cSFrank Schaefer 214837ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 214937ecc7b1SMauro Carvalho Chehab 2150d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 215129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2152d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2153d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 21540c0d06caSMauro Carvalho Chehab } 2155d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 215629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2157d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2158d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 21590c0d06caSMauro Carvalho Chehab } 2160d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 216129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2162d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2163d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 21640c0d06caSMauro Carvalho Chehab } 216501c28193SMauro Carvalho Chehab 2166abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 216795d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2168103f18a2SFrank Schaefer 216995d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 217095d2608bSFrank Schaefer 2171ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 217295d2608bSFrank Schaefer 217347677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 21745ad10de6SFrank Schaefer 217501c28193SMauro Carvalho Chehab return 0; 21760c0d06caSMauro Carvalho Chehab } 21770c0d06caSMauro Carvalho Chehab 2178a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2179a61f6811SShuah Khan { 2180a61f6811SShuah Khan if (dev->is_audio_only) 2181a61f6811SShuah Khan return 0; 2182a61f6811SShuah Khan 2183a61f6811SShuah Khan if (!dev->has_video) 2184a61f6811SShuah Khan return 0; 2185a61f6811SShuah Khan 218629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2187a61f6811SShuah Khan em28xx_stop_urbs(dev); 2188a61f6811SShuah Khan return 0; 2189a61f6811SShuah Khan } 2190a61f6811SShuah Khan 2191a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2192a61f6811SShuah Khan { 2193a61f6811SShuah Khan if (dev->is_audio_only) 2194a61f6811SShuah Khan return 0; 2195a61f6811SShuah Khan 2196a61f6811SShuah Khan if (!dev->has_video) 2197a61f6811SShuah Khan return 0; 2198a61f6811SShuah Khan 219929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2200a61f6811SShuah Khan /* what do we do here */ 2201a61f6811SShuah Khan return 0; 2202a61f6811SShuah Khan } 2203a61f6811SShuah Khan 22040c0d06caSMauro Carvalho Chehab /* 22050c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 22060c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 22070c0d06caSMauro Carvalho Chehab * calls and ioctls 22080c0d06caSMauro Carvalho Chehab */ 22090c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 22100c0d06caSMauro Carvalho Chehab { 2211917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 221295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2213c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 22140c0d06caSMauro Carvalho Chehab int errCode; 22150c0d06caSMauro Carvalho Chehab 22168e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 22178e2c8717SFrank Schaefer 22188e2c8717SFrank Schaefer vb2_fop_release(filp); 221998c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 22200c0d06caSMauro Carvalho Chehab 22218e2c8717SFrank Schaefer if (v4l2->users == 1) { 222247677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 222347677e51SMauro Carvalho Chehab if (dev->disconnected) 222401c28193SMauro Carvalho Chehab goto exit; 22250c0d06caSMauro Carvalho Chehab 22260c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 222795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 22280c0d06caSMauro Carvalho Chehab 22290c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 22300c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 22310c0d06caSMauro Carvalho Chehab 22320c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 22330c0d06caSMauro Carvalho Chehab dev->alt = 0; 22340c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2235c6d48134SMauro Carvalho Chehab errCode = usb_set_interface(udev, 0, 0); 22360c0d06caSMauro Carvalho Chehab if (errCode < 0) { 223729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2238ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 22398314d402SMauro Carvalho Chehab errCode); 22400c0d06caSMauro Carvalho Chehab } 22410c0d06caSMauro Carvalho Chehab } 22420c0d06caSMauro Carvalho Chehab 224301c28193SMauro Carvalho Chehab exit: 22448e2c8717SFrank Schaefer v4l2->users--; 224595d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 22460c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 224747677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 224847677e51SMauro Carvalho Chehab 22490c0d06caSMauro Carvalho Chehab return 0; 22500c0d06caSMauro Carvalho Chehab } 22510c0d06caSMauro Carvalho Chehab 22520c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 22530c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22540c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22550c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2256d3829fadSDevin Heitmueller .read = vb2_fop_read, 2257d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2258d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 22590c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22600c0d06caSMauro Carvalho Chehab }; 22610c0d06caSMauro Carvalho Chehab 22620c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 22630c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 22640c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 22650c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 22660c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 22670c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 22680c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22692a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2270aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22710c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 22720c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 22730c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 22740c0d06caSMauro Carvalho Chehab 2275d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2276d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2277d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2278d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2279d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2280d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2281d3829fadSDevin Heitmueller 22820c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 22830c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 22840c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 22850c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 22860c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 22870c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 22880c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 22890c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2290d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2291d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 22920c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 22930c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 22940c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22950c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 229650fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 229750fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 22980c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 229996b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 23000c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23010c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23020c0d06caSMauro Carvalho Chehab #endif 23030c0d06caSMauro Carvalho Chehab }; 23040c0d06caSMauro Carvalho Chehab 23050c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 23060c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 23070c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2308d4352f36SHans Verkuil .release = video_device_release_empty, 23090c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 23100c0d06caSMauro Carvalho Chehab }; 23110c0d06caSMauro Carvalho Chehab 23120c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 23130c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23140c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23150c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 23160c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23170c0d06caSMauro Carvalho Chehab }; 23180c0d06caSMauro Carvalho Chehab 23190c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2320a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 23210c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 23220c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 23230c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23240c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 232550fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 232650fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23270c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2328430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 23290c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23300c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23310c0d06caSMauro Carvalho Chehab #endif 23320c0d06caSMauro Carvalho Chehab }; 23330c0d06caSMauro Carvalho Chehab 23340c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 23350c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 23360c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2337d4352f36SHans Verkuil .release = video_device_release_empty, 23380c0d06caSMauro Carvalho Chehab }; 23390c0d06caSMauro Carvalho Chehab 2340b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2341b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2342b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2343b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2344b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2345b64f8e9aSMauro Carvalho Chehab 2346b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2347b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2348b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2349b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2350b64f8e9aSMauro Carvalho Chehab }; 2351b64f8e9aSMauro Carvalho Chehab 2352b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2353b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2354b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2355b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2356b64f8e9aSMauro Carvalho Chehab }; 2357b64f8e9aSMauro Carvalho Chehab 23580c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 23590c0d06caSMauro Carvalho Chehab 2360d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2361d4352f36SHans Verkuil struct video_device *vfd, 23620c0d06caSMauro Carvalho Chehab const struct video_device *template, 23630c0d06caSMauro Carvalho Chehab const char *type_name) 23640c0d06caSMauro Carvalho Chehab { 23650c0d06caSMauro Carvalho Chehab *vfd = *template; 236695d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 23670c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2368aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 2369d8c95c08SHans Verkuil vfd->tvnorms = 0; 23700c0d06caSMauro Carvalho Chehab 23710c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 237229b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 23730c0d06caSMauro Carvalho Chehab 23740c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 23750c0d06caSMauro Carvalho Chehab } 23760c0d06caSMauro Carvalho Chehab 23773319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 23780560f337SMauro Carvalho Chehab { 23793854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 23803854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 23810560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 23820560f337SMauro Carvalho Chehab struct v4l2_frequency f; 23830560f337SMauro Carvalho Chehab 23840560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 23850560f337SMauro Carvalho Chehab 23860560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 23870560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 23880560f337SMauro Carvalho Chehab 23890560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 23900560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 23910560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 23920560f337SMauro Carvalho Chehab 239395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 239495d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 23950560f337SMauro Carvalho Chehab } 23960560f337SMauro Carvalho Chehab 23970560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 23980560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 23993319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 24000560f337SMauro Carvalho Chehab 240195d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 240295d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24030560f337SMauro Carvalho Chehab } 24040560f337SMauro Carvalho Chehab 24056867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 24060560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 24070560f337SMauro Carvalho Chehab 24080560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 24096867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 24100560f337SMauro Carvalho Chehab 241195d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 241295d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 24130560f337SMauro Carvalho Chehab } 24140560f337SMauro Carvalho Chehab 24150560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 24160560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 24170560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 24180560f337SMauro Carvalho Chehab 24190560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 24200560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 24210560f337SMauro Carvalho Chehab 24220560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 24230560f337SMauro Carvalho Chehab 24240560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 24250560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 24260560f337SMauro Carvalho Chehab 242795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 24280560f337SMauro Carvalho Chehab } 24290560f337SMauro Carvalho Chehab 24300560f337SMauro Carvalho Chehab /* configure tuner */ 24310560f337SMauro Carvalho Chehab f.tuner = 0; 24320560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 24330560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 24343854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 243595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 24360560f337SMauro Carvalho Chehab } 24370560f337SMauro Carvalho Chehab 243801c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 24390c0d06caSMauro Carvalho Chehab { 24400c0d06caSMauro Carvalho Chehab u8 val; 24410c0d06caSMauro Carvalho Chehab int ret; 24420c0d06caSMauro Carvalho Chehab unsigned int maxw; 2443abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 244495d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2445b64f8e9aSMauro Carvalho Chehab 2446822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2447822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2448822b8deaSMauro Carvalho Chehab return 0; 2449822b8deaSMauro Carvalho Chehab } 2450822b8deaSMauro Carvalho Chehab 245101c28193SMauro Carvalho Chehab if (!dev->has_video) { 2452b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2453b64f8e9aSMauro Carvalho Chehab return 0; 2454b64f8e9aSMauro Carvalho Chehab } 24550c0d06caSMauro Carvalho Chehab 245629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 24570c0d06caSMauro Carvalho Chehab 245801c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 245901c28193SMauro Carvalho Chehab 246095d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 24618314d402SMauro Carvalho Chehab if (!v4l2) { 246295d2608bSFrank Schaefer mutex_unlock(&dev->lock); 246395d2608bSFrank Schaefer return -ENOMEM; 246495d2608bSFrank Schaefer } 246595d2608bSFrank Schaefer kref_init(&v4l2->ref); 2466abc1308fSFrank Schaefer v4l2->dev = dev; 246795d2608bSFrank Schaefer dev->v4l2 = v4l2; 246895d2608bSFrank Schaefer 246937ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 247037ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 247137ecc7b1SMauro Carvalho Chehab #endif 247229b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2473b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 247429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2475ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2476b64f8e9aSMauro Carvalho Chehab goto err; 2477b64f8e9aSMauro Carvalho Chehab } 2478b64f8e9aSMauro Carvalho Chehab 2479abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2480b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 248195d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2482b64f8e9aSMauro Carvalho Chehab 2483aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 24847e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 248558159171SFrank Schaefer 2486b64f8e9aSMauro Carvalho Chehab /* 2487b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2488b64f8e9aSMauro Carvalho Chehab */ 2489a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY; 24909297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2491b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2492b64f8e9aSMauro Carvalho Chehab 2493b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2494b64f8e9aSMauro Carvalho Chehab 2495aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) 249695d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 249795d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2498b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2499b64f8e9aSMauro Carvalho Chehab 2500b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 250195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 250295d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2503b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2504b64f8e9aSMauro Carvalho Chehab 2505b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 250695d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 250795d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2508b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2509b64f8e9aSMauro Carvalho Chehab 2510b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 251195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 251295d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2513b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2514b64f8e9aSMauro Carvalho Chehab 2515b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2516b64f8e9aSMauro Carvalho Chehab 2517b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 25183319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 25196867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2520b64f8e9aSMauro Carvalho Chehab 2521b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 252295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 252395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2524fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2525fdf1bc9fSMauro Carvalho Chehab NULL); 2526b64f8e9aSMauro Carvalho Chehab 2527b64f8e9aSMauro Carvalho Chehab if (has_demod) 252895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2529fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2530fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2531fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 25323319e6f8SFrank Schaefer if (tuner_addr == 0) { 2533b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2534b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2535b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2536b64f8e9aSMauro Carvalho Chehab 253795d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2538fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2539fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2540fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2541b64f8e9aSMauro Carvalho Chehab 2542b64f8e9aSMauro Carvalho Chehab if (sd) 25433319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2544b64f8e9aSMauro Carvalho Chehab } else { 254595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 254695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 25473319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2548b64f8e9aSMauro Carvalho Chehab } 2549b64f8e9aSMauro Carvalho Chehab 25503319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 25513319e6f8SFrank Schaefer } 25523319e6f8SFrank Schaefer 2553d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2554b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2555b64f8e9aSMauro Carvalho Chehab 2556b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2557b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2558b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 255929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2560ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2561b64f8e9aSMauro Carvalho Chehab __func__, ret); 2562b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2563b64f8e9aSMauro Carvalho Chehab } 2564b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2565b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2566b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2567b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2568b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2569b64f8e9aSMauro Carvalho Chehab } else { 2570b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2571b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2572b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2573b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2574b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2575b64f8e9aSMauro Carvalho Chehab } 2576b64f8e9aSMauro Carvalho Chehab 2577b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2578b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2579b64f8e9aSMauro Carvalho Chehab 2580b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2581b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2582b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2583b64f8e9aSMauro Carvalho Chehab 2584aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 2585b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2586b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2587b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 258829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2589ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2590b64f8e9aSMauro Carvalho Chehab __func__, ret); 2591b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2592b64f8e9aSMauro Carvalho Chehab } 2593b64f8e9aSMauro Carvalho Chehab msleep(3); 2594b64f8e9aSMauro Carvalho Chehab 2595b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2596b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 259729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2598ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2599b64f8e9aSMauro Carvalho Chehab __func__, ret); 2600b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2601b64f8e9aSMauro Carvalho Chehab } 2602b64f8e9aSMauro Carvalho Chehab msleep(3); 2603b64f8e9aSMauro Carvalho Chehab } 2604b64f8e9aSMauro Carvalho Chehab 26050c0d06caSMauro Carvalho Chehab /* set default norm */ 260652faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 26078774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 260858159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 26090c0d06caSMauro Carvalho Chehab 26100c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 261106e20672SFrank Schaefer v4l2->format = &format[0]; 26120c0d06caSMauro Carvalho Chehab 26130c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 26140c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 26150c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 26160c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 26170c0d06caSMauro Carvalho Chehab maxw /= 2; 26180c0d06caSMauro Carvalho Chehab 26190c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 26200c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 26210c0d06caSMauro Carvalho Chehab 26220c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 26230c0d06caSMauro Carvalho Chehab 26240c0d06caSMauro Carvalho Chehab /* Audio defaults */ 26250c0d06caSMauro Carvalho Chehab dev->mute = 1; 26260c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 26270c0d06caSMauro Carvalho Chehab 26280c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 26290c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 26300c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 26310c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 26320c0d06caSMauro Carvalho Chehab 26330c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 26340c0d06caSMauro Carvalho Chehab 26358f8b113aSFrank Schaefer /* Add image controls */ 26368f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 26378f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2638ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2639ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26408f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 26418f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2642ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2643ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26448f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 26458f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2646ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2647ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26488f8b113aSFrank Schaefer V4L2_CID_SATURATION, 26498f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2650ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2651ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26528f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 26538f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2654ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2655ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26568f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 26578f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2658ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2659ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26608f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 26618f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 26628f8b113aSFrank Schaefer 26638f8b113aSFrank Schaefer /* Reset image controls */ 26648f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2665ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2666ad298055SFrank Schaefer ret = hdl->error; 2667b64f8e9aSMauro Carvalho Chehab if (ret) 2668b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26698f8b113aSFrank Schaefer 26700c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2671d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 267227a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 267327a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2674d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2675d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 26760c0d06caSMauro Carvalho Chehab 26776e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 2678aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 2679d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2680d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2681d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 26823bc85cceSFrank Schaefer } else { 2683d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 26846e46dabaSFrank Schaefer } 268566df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2686d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2687d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2688d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2689d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 269066df67b7SFrank Schaefer } 2691920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2692d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2693d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2694c2dcef83SFrank Schaefer } 26956e46dabaSFrank Schaefer 26960c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2697d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 26980c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 26990c0d06caSMauro Carvalho Chehab if (ret) { 270029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2701ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2702b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27030c0d06caSMauro Carvalho Chehab } 27040c0d06caSMauro Carvalho Chehab 27050c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 27060c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2707d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 27080c0d06caSMauro Carvalho Chehab "vbi"); 27090c0d06caSMauro Carvalho Chehab 2710d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2711d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2712d3829fadSDevin Heitmueller 271366df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2714d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 271566df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2716d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2717d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2718d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2719d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 272066df67b7SFrank Schaefer } 2721920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2722d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2723d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2724c2dcef83SFrank Schaefer } 272566df67b7SFrank Schaefer 27260c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2727d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 27280c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 27290c0d06caSMauro Carvalho Chehab if (ret < 0) { 273029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2731ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2732b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27330c0d06caSMauro Carvalho Chehab } 27340c0d06caSMauro Carvalho Chehab } 27350c0d06caSMauro Carvalho Chehab 27360c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2737d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 27380c0d06caSMauro Carvalho Chehab "radio"); 2739d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 27400c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 27410c0d06caSMauro Carvalho Chehab if (ret < 0) { 274229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2743ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2744b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27450c0d06caSMauro Carvalho Chehab } 274629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2747ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2748d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 27490c0d06caSMauro Carvalho Chehab } 27500c0d06caSMauro Carvalho Chehab 275137ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 275237ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 275337ecc7b1SMauro Carvalho Chehab 27540d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2755de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 275637ecc7b1SMauro Carvalho Chehab if (ret) { 275729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2758ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 275937ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 276037ecc7b1SMauro Carvalho Chehab goto unregister_dev; 276137ecc7b1SMauro Carvalho Chehab } 27620d37ba62SArnd Bergmann #endif 276337ecc7b1SMauro Carvalho Chehab 276429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2765ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2766d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 27670c0d06caSMauro Carvalho Chehab 2768d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 276929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2770ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2771d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 27720c0d06caSMauro Carvalho Chehab 2773b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 277495d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2775b64f8e9aSMauro Carvalho Chehab 2776b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2777b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2778b64f8e9aSMauro Carvalho Chehab 277929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2780ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 27819634614fSMauro Carvalho Chehab 278247677e51SMauro Carvalho Chehab kref_get(&dev->ref); 278347677e51SMauro Carvalho Chehab 278401c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 27850c0d06caSMauro Carvalho Chehab return 0; 2786b64f8e9aSMauro Carvalho Chehab 2787b64f8e9aSMauro Carvalho Chehab unregister_dev: 278856a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 278929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2790ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 279156a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 279256a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 279356a7f515SMauro Carvalho Chehab } 279456a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 279529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2796ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 279756a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 279856a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 279956a7f515SMauro Carvalho Chehab } 280056a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 280129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2802ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 280356a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 280456a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 280556a7f515SMauro Carvalho Chehab } 280656a7f515SMauro Carvalho Chehab 2807abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 280895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2809b64f8e9aSMauro Carvalho Chehab err: 281095d2608bSFrank Schaefer dev->v4l2 = NULL; 281195d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 281201c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2813b64f8e9aSMauro Carvalho Chehab return ret; 28140c0d06caSMauro Carvalho Chehab } 281501c28193SMauro Carvalho Chehab 281601c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 281701c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 281801c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 281901c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 282001c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2821a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2822a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 282301c28193SMauro Carvalho Chehab }; 282401c28193SMauro Carvalho Chehab 282501c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 282601c28193SMauro Carvalho Chehab { 282701c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 282801c28193SMauro Carvalho Chehab } 282901c28193SMauro Carvalho Chehab 283001c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 283101c28193SMauro Carvalho Chehab { 283201c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 283301c28193SMauro Carvalho Chehab } 283401c28193SMauro Carvalho Chehab 283501c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 283601c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2837