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> 832590819SMauro Carvalho Chehab // Mauro Carvalho Chehab <mchehab@kernel.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>, " \ 4732590819SMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@kernel.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); 249f9fe90a4SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, 250f9fe90a4SMauro Carvalho Chehab v4l2->vbi_width / 4); 251753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25252faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2530560f337SMauro Carvalho Chehab /* NTSC */ 2540560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25552faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2560560f337SMauro Carvalho Chehab /* PAL */ 2570560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2580560f337SMauro Carvalho Chehab } 2590560f337SMauro Carvalho Chehab } 2600560f337SMauro Carvalho Chehab 2610560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2620560f337SMauro Carvalho Chehab } 2630560f337SMauro Carvalho Chehab 2640560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2650560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2660560f337SMauro Carvalho Chehab { 2670560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2680560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2690560f337SMauro Carvalho Chehab 2700560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2710560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2720560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2730560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2740560f337SMauro Carvalho Chehab } 2750560f337SMauro Carvalho Chehab 2760560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2770560f337SMauro Carvalho Chehab u16 width, u16 height) 2780560f337SMauro Carvalho Chehab { 2790560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2800560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2810560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2820560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2830560f337SMauro Carvalho Chehab 2840560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2850560f337SMauro Carvalho Chehab hstart, vstart, 2860560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2870560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2880560f337SMauro Carvalho Chehab 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2930560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2940560f337SMauro Carvalho Chehab 2950560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2960560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2970560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2990560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 3000560f337SMauro Carvalho Chehab } 3010560f337SMauro Carvalho Chehab } 3020560f337SMauro Carvalho Chehab 3030560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3040560f337SMauro Carvalho Chehab { 305cba8e9b3SFrank Schaefer u8 mode = 0x00; 3060560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3070560f337SMauro Carvalho Chehab 3080560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3090560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3100560f337SMauro Carvalho Chehab } else { 3110560f337SMauro Carvalho Chehab u8 buf[2]; 3120560f337SMauro Carvalho Chehab 3130560f337SMauro Carvalho Chehab buf[0] = h; 3140560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3150560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3160560f337SMauro Carvalho Chehab 3170560f337SMauro Carvalho Chehab buf[0] = v; 3180560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3190560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 320f9fe90a4SMauro Carvalho Chehab /* 321f9fe90a4SMauro Carvalho Chehab * it seems that both H and V scalers must be active 322f9fe90a4SMauro Carvalho Chehab * to work correctly 323f9fe90a4SMauro Carvalho Chehab */ 3240560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3250560f337SMauro Carvalho Chehab } 326cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3270560f337SMauro Carvalho Chehab } 3280560f337SMauro Carvalho Chehab 3290560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 33001c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3310560f337SMauro Carvalho Chehab { 332753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 333753aee77SFrank Schaefer int width = norm_maxw(dev); 334753aee77SFrank Schaefer int height = norm_maxh(dev); 3350560f337SMauro Carvalho Chehab 3360560f337SMauro Carvalho Chehab /* Properly setup VBI */ 337753aee77SFrank Schaefer v4l2->vbi_width = 720; 33852faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 339753aee77SFrank Schaefer v4l2->vbi_height = 12; 3400560f337SMauro Carvalho Chehab else 341753aee77SFrank Schaefer v4l2->vbi_height = 18; 3420560f337SMauro Carvalho Chehab 3430560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3440560f337SMauro Carvalho Chehab 3450560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3460560f337SMauro Carvalho Chehab 347f9fe90a4SMauro Carvalho Chehab /* 348f9fe90a4SMauro Carvalho Chehab * If we don't set the start position to 2 in VBI mode, we end up 349f9fe90a4SMauro Carvalho Chehab * with line 20/21 being YUYV encoded instead of being in 8-bit 350f9fe90a4SMauro Carvalho Chehab * greyscale. The core of the issue is that line 21 (and line 23 for 351f9fe90a4SMauro Carvalho Chehab * PAL WSS) are inside of active video region, and as a result they 352f9fe90a4SMauro Carvalho Chehab * get the pixelformatting associated with that area. So by cropping 353f9fe90a4SMauro Carvalho Chehab * it out, we end up with the same format as the rest of the VBI 354f9fe90a4SMauro Carvalho Chehab * region 355f9fe90a4SMauro Carvalho Chehab */ 3560560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3570560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3580560f337SMauro Carvalho Chehab else 3590560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3600560f337SMauro Carvalho Chehab 361753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3620560f337SMauro Carvalho Chehab } 3630560f337SMauro Carvalho Chehab 3640560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36501c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3660560f337SMauro Carvalho Chehab { 367753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 368c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 369f9fe90a4SMauro Carvalho Chehab int err; 3700560f337SMauro Carvalho Chehab int i; 371753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3720560f337SMauro Carvalho Chehab 373f9fe90a4SMauro Carvalho Chehab /* 374f9fe90a4SMauro Carvalho Chehab * NOTE: for isoc transfers, only alt settings > 0 are allowed 375f9fe90a4SMauro Carvalho Chehab * bulk transfers seem to work only with alt=0 ! 376f9fe90a4SMauro Carvalho Chehab */ 3770560f337SMauro Carvalho Chehab dev->alt = 0; 378f9fe90a4SMauro Carvalho Chehab if (alt > 0 && alt < dev->num_alt) { 3790560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3800560f337SMauro Carvalho Chehab dev->alt = alt; 3810560f337SMauro Carvalho Chehab goto set_alt; 3820560f337SMauro Carvalho Chehab } 3830560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3840560f337SMauro Carvalho Chehab goto set_alt; 3850560f337SMauro Carvalho Chehab 386f9fe90a4SMauro Carvalho Chehab /* 387f9fe90a4SMauro Carvalho Chehab * When image size is bigger than a certain value, 388f9fe90a4SMauro Carvalho Chehab * the frame size should be increased, otherwise, only 389f9fe90a4SMauro Carvalho Chehab * green screen will be received. 3900560f337SMauro Carvalho Chehab */ 391753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3920560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3930560f337SMauro Carvalho Chehab 3940560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3950560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3960560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3970560f337SMauro Carvalho Chehab dev->alt = i; 3980560f337SMauro Carvalho Chehab break; 399f9fe90a4SMauro Carvalho Chehab /* 400f9fe90a4SMauro Carvalho Chehab * otherwise make sure that we end up with the maximum 401f9fe90a4SMauro Carvalho Chehab * bandwidth because the min_pkt_size equation might be wrong. 402f9fe90a4SMauro Carvalho Chehab * 4030560f337SMauro Carvalho Chehab */ 4040560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 4050560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 4060560f337SMauro Carvalho Chehab dev->alt = i; 4070560f337SMauro Carvalho Chehab } 4080560f337SMauro Carvalho Chehab 4090560f337SMauro Carvalho Chehab set_alt: 410f9fe90a4SMauro Carvalho Chehab /* 411f9fe90a4SMauro Carvalho Chehab * NOTE: for bulk transfers, we need to call usb_set_interface() 4120560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 413f9fe90a4SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! 414f9fe90a4SMauro Carvalho Chehab */ 4150560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4160560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4170560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4180560f337SMauro Carvalho Chehab } else { /* isoc */ 4190560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4200560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4210560f337SMauro Carvalho Chehab dev->max_pkt_size = 4220560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4230560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4240560f337SMauro Carvalho Chehab } 4250560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4260560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 427f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, dev->ifnum, dev->alt); 428f9fe90a4SMauro Carvalho Chehab if (err < 0) { 42929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 430ce8591ffSMauro Carvalho Chehab "cannot change alternate number to %d (error=%i)\n", 431f9fe90a4SMauro Carvalho Chehab dev->alt, err); 432f9fe90a4SMauro Carvalho Chehab return err; 4330560f337SMauro Carvalho Chehab } 4340560f337SMauro Carvalho Chehab return 0; 4350560f337SMauro Carvalho Chehab } 4360560f337SMauro Carvalho Chehab 437f9fe90a4SMauro Carvalho Chehab /* 438f9fe90a4SMauro Carvalho Chehab * DMA and thread functions 439f9fe90a4SMauro Carvalho Chehab */ 4400c0d06caSMauro Carvalho Chehab 4410c0d06caSMauro Carvalho Chehab /* 442948a49aaSFrank Schaefer * Finish the current buffer 4430c0d06caSMauro Carvalho Chehab */ 444948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4450c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4460c0d06caSMauro Carvalho Chehab { 447d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 448d3829fadSDevin Heitmueller 4492d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++; 450662c97cfSFrank Schaefer if (dev->v4l2->progressive) 4512d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE; 452662c97cfSFrank Schaefer else 4532d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED; 454d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns(); 455d3829fadSDevin Heitmueller 4562d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 4570c0d06caSMauro Carvalho Chehab } 4580c0d06caSMauro Carvalho Chehab 4590c0d06caSMauro Carvalho Chehab /* 46036016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4610c0d06caSMauro Carvalho Chehab */ 4620c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4630c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 46436016a35SFrank Schaefer unsigned char *usb_buf, 4654078d625SFrank Schaefer unsigned long len) 4660c0d06caSMauro Carvalho Chehab { 46758159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4680c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4690c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 47058159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4710c0d06caSMauro Carvalho Chehab 472d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 473d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4740c0d06caSMauro Carvalho Chehab 47536016a35SFrank Schaefer startread = usb_buf; 4760c0d06caSMauro Carvalho Chehab remain = len; 4770c0d06caSMauro Carvalho Chehab 47858159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 47936016a35SFrank Schaefer fieldstart = buf->vb_buf; 480c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 48136016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4820c0d06caSMauro Carvalho Chehab 4838732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4848732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4850c0d06caSMauro Carvalho Chehab 48658159171SFrank Schaefer if (v4l2->progressive) 4870c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4880c0d06caSMauro Carvalho Chehab else 4890c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4900c0d06caSMauro Carvalho Chehab 4910c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4920c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4930c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4940c0d06caSMauro Carvalho Chehab 495d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4967983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4970c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 498d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 499d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 50036016a35SFrank Schaefer (char *)startwrite; 5010c0d06caSMauro Carvalho Chehab lencopy = remain; 5020c0d06caSMauro Carvalho Chehab } 5030c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5040c0d06caSMauro Carvalho Chehab return; 5050c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5060c0d06caSMauro Carvalho Chehab 5070c0d06caSMauro Carvalho Chehab remain -= lencopy; 5080c0d06caSMauro Carvalho Chehab 5090c0d06caSMauro Carvalho Chehab while (remain > 0) { 51058159171SFrank Schaefer if (v4l2->progressive) 511c02ec71bSFrank Schaefer startwrite += lencopy; 512c02ec71bSFrank Schaefer else 5130c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5140c0d06caSMauro Carvalho Chehab startread += lencopy; 5150c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5160c0d06caSMauro Carvalho Chehab lencopy = remain; 5170c0d06caSMauro Carvalho Chehab else 5180c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5190c0d06caSMauro Carvalho Chehab 52036016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 521d3829fadSDevin Heitmueller buf->length) { 5225ccb197dSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end(2)\n", 5230c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 524d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 525f9fe90a4SMauro Carvalho Chehab remain = (char *)buf->vb_buf + buf->length - 5260c0d06caSMauro Carvalho Chehab (char *)startwrite; 527f9fe90a4SMauro Carvalho Chehab lencopy = remain; 5280c0d06caSMauro Carvalho Chehab } 5290c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5300c0d06caSMauro Carvalho Chehab break; 5310c0d06caSMauro Carvalho Chehab 5320c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5330c0d06caSMauro Carvalho Chehab 5340c0d06caSMauro Carvalho Chehab remain -= lencopy; 5350c0d06caSMauro Carvalho Chehab } 5360c0d06caSMauro Carvalho Chehab 5378732533bSFrank Schaefer buf->pos += len; 5380c0d06caSMauro Carvalho Chehab } 5390c0d06caSMauro Carvalho Chehab 54036016a35SFrank Schaefer /* 54136016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 54236016a35SFrank Schaefer */ 5430c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5440c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 54536016a35SFrank Schaefer unsigned char *usb_buf, 5464078d625SFrank Schaefer unsigned long len) 5470c0d06caSMauro Carvalho Chehab { 54836016a35SFrank Schaefer unsigned int offset; 5490c0d06caSMauro Carvalho Chehab 550d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 551d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5520c0d06caSMauro Carvalho Chehab 5538732533bSFrank Schaefer offset = buf->pos; 5540c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 55536016a35SFrank Schaefer if (buf->top_field == 0) 556753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5570c0d06caSMauro Carvalho Chehab 55836016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5598732533bSFrank Schaefer buf->pos += len; 5600c0d06caSMauro Carvalho Chehab } 5610c0d06caSMauro Carvalho Chehab 5620c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5630c0d06caSMauro Carvalho Chehab int packet, int status) 5640c0d06caSMauro Carvalho Chehab { 5650c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5660c0d06caSMauro Carvalho Chehab 5670c0d06caSMauro Carvalho Chehab switch (status) { 5680c0d06caSMauro Carvalho Chehab case -ENOENT: 569b436e26eSColin Ian King errmsg = "unlinked synchronously"; 5700c0d06caSMauro Carvalho Chehab break; 5710c0d06caSMauro Carvalho Chehab case -ECONNRESET: 572b436e26eSColin Ian King errmsg = "unlinked asynchronously"; 5730c0d06caSMauro Carvalho Chehab break; 5740c0d06caSMauro Carvalho Chehab case -ENOSR: 5750c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5760c0d06caSMauro Carvalho Chehab break; 5770c0d06caSMauro Carvalho Chehab case -EPIPE: 5780c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5790c0d06caSMauro Carvalho Chehab break; 5800c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5810c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5820c0d06caSMauro Carvalho Chehab break; 5830c0d06caSMauro Carvalho Chehab case -EPROTO: 5840c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5850c0d06caSMauro Carvalho Chehab break; 5860c0d06caSMauro Carvalho Chehab case -EILSEQ: 5870c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5880c0d06caSMauro Carvalho Chehab break; 5890c0d06caSMauro Carvalho Chehab case -ETIME: 5900c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5910c0d06caSMauro Carvalho Chehab break; 5920c0d06caSMauro Carvalho Chehab } 5930c0d06caSMauro Carvalho Chehab if (packet < 0) { 5940c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5950c0d06caSMauro Carvalho Chehab } else { 5960c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5970c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5980c0d06caSMauro Carvalho Chehab } 5990c0d06caSMauro Carvalho Chehab } 6000c0d06caSMauro Carvalho Chehab 6010c0d06caSMauro Carvalho Chehab /* 60224a6d849SFrank Schaefer * get the next available buffer from dma queue 6030c0d06caSMauro Carvalho Chehab */ 60424a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 60524a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 6060c0d06caSMauro Carvalho Chehab { 60724a6d849SFrank Schaefer struct em28xx_buffer *buf; 6080c0d06caSMauro Carvalho Chehab 6090c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 6100c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 61124a6d849SFrank Schaefer return NULL; 6120c0d06caSMauro Carvalho Chehab } 6130c0d06caSMauro Carvalho Chehab 6140c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 615d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6160c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 617d3829fadSDevin Heitmueller list_del(&buf->list); 6188732533bSFrank Schaefer buf->pos = 0; 619d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6200c0d06caSMauro Carvalho Chehab 62124a6d849SFrank Schaefer return buf; 6220c0d06caSMauro Carvalho Chehab } 6230c0d06caSMauro Carvalho Chehab 624e04c00d9SFrank Schaefer /* 625e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 626e04c00d9SFrank Schaefer */ 627e04c00d9SFrank Schaefer static struct em28xx_buffer * 628e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 629e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 630e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 631e04c00d9SFrank Schaefer { 63258159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 63358159171SFrank Schaefer 634f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 635f9fe90a4SMauro Carvalho Chehab if (buf) 636e04c00d9SFrank Schaefer finish_buffer(dev, buf); 637e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 638e04c00d9SFrank Schaefer } 639f9fe90a4SMauro Carvalho Chehab if (buf) { 640f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 641e04c00d9SFrank Schaefer buf->pos = 0; 642e04c00d9SFrank Schaefer } 643e04c00d9SFrank Schaefer 644e04c00d9SFrank Schaefer return buf; 645e04c00d9SFrank Schaefer } 646e04c00d9SFrank Schaefer 647227b7c90SFrank Schaefer /* 648227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 649227b7c90SFrank Schaefer */ 650227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 651227b7c90SFrank Schaefer unsigned char *data_pkt, 652227b7c90SFrank Schaefer unsigned int data_len) 653227b7c90SFrank Schaefer { 654753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 655227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 656227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 657227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 658227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 659227b7c90SFrank Schaefer 660f9fe90a4SMauro Carvalho Chehab /* 661f9fe90a4SMauro Carvalho Chehab * capture type 0 = vbi start 662f9fe90a4SMauro Carvalho Chehab * capture type 1 = vbi in progress 663f9fe90a4SMauro Carvalho Chehab * capture type 2 = video start 664f9fe90a4SMauro Carvalho Chehab * capture type 3 = video in progress 665f9fe90a4SMauro Carvalho Chehab */ 666227b7c90SFrank Schaefer if (data_len >= 4) { 667f9fe90a4SMauro Carvalho Chehab /* 668f9fe90a4SMauro Carvalho Chehab * NOTE: Headers are always 4 bytes and 669f9fe90a4SMauro Carvalho Chehab * never split across packets 670f9fe90a4SMauro Carvalho Chehab */ 671227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 672227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 673227b7c90SFrank Schaefer /* Continuation */ 674227b7c90SFrank Schaefer data_pkt += 4; 675227b7c90SFrank Schaefer data_len -= 4; 676227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 677227b7c90SFrank Schaefer /* Field start (VBI mode) */ 678f0e38230SFrank Schaefer v4l2->capture_type = 0; 679f0e38230SFrank Schaefer v4l2->vbi_read = 0; 680227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 681f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 682227b7c90SFrank Schaefer data_pkt += 4; 683227b7c90SFrank Schaefer data_len -= 4; 684227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 685227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 686f0e38230SFrank Schaefer v4l2->capture_type = 2; 687227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 688f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 689227b7c90SFrank Schaefer data_pkt += 4; 690227b7c90SFrank Schaefer data_len -= 4; 691227b7c90SFrank Schaefer } 692227b7c90SFrank Schaefer } 693f9fe90a4SMauro Carvalho Chehab /* 694f9fe90a4SMauro Carvalho Chehab * NOTE: With bulk transfers, intermediate data packets 695f9fe90a4SMauro Carvalho Chehab * have no continuation header 696f9fe90a4SMauro Carvalho Chehab */ 697227b7c90SFrank Schaefer 698f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 699227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 700227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 701f0e38230SFrank Schaefer v4l2->capture_type = 1; 702227b7c90SFrank Schaefer } 703227b7c90SFrank Schaefer 704f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 705753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 706f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 707f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 708227b7c90SFrank Schaefer 709227b7c90SFrank Schaefer /* Copy VBI data */ 710f9fe90a4SMauro Carvalho Chehab if (vbi_buf) 711227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 712f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 713227b7c90SFrank Schaefer 714227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 715227b7c90SFrank Schaefer /* Continue with copying video data */ 716f0e38230SFrank Schaefer v4l2->capture_type = 2; 717227b7c90SFrank Schaefer data_pkt += vbi_data_len; 718227b7c90SFrank Schaefer data_len -= vbi_data_len; 719227b7c90SFrank Schaefer } 720227b7c90SFrank Schaefer } 721227b7c90SFrank Schaefer 722f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 723227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 724227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 725f0e38230SFrank Schaefer v4l2->capture_type = 3; 726227b7c90SFrank Schaefer } 727227b7c90SFrank Schaefer 728f9fe90a4SMauro Carvalho Chehab if (v4l2->capture_type == 3 && buf && data_len > 0) 729227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 730227b7c90SFrank Schaefer } 731227b7c90SFrank Schaefer 732e507e0e5SFrank Schaefer /* 733e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 734e507e0e5SFrank Schaefer */ 735e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 736e507e0e5SFrank Schaefer unsigned char *data_pkt, 737e507e0e5SFrank Schaefer unsigned int data_len) 738e507e0e5SFrank Schaefer { 739e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 740e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 741f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7427e6c8c19SMauro Carvalho Chehab bool frame_end = false; 743e507e0e5SFrank Schaefer 744e507e0e5SFrank Schaefer /* Check for header */ 745f9fe90a4SMauro Carvalho Chehab /* 746f9fe90a4SMauro Carvalho Chehab * NOTE: at least with bulk transfers, only the first packet 747f9fe90a4SMauro Carvalho Chehab * has a header and has always set the FRAME_END bit 748f9fe90a4SMauro Carvalho Chehab */ 749e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 750e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 751e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 752f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 753e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 754e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 755e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 756e507e0e5SFrank Schaefer data_pkt += 2; 757e507e0e5SFrank Schaefer data_len -= 2; 758e507e0e5SFrank Schaefer } 759e507e0e5SFrank Schaefer 760e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 761e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 762e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 763e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 764e507e0e5SFrank Schaefer } 765f9fe90a4SMauro Carvalho Chehab /* 766f9fe90a4SMauro Carvalho Chehab * NOTE: in ISOC mode when a new frame starts and buf==NULL, 767e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 768e507e0e5SFrank Schaefer * first frame. 769e507e0e5SFrank Schaefer */ 770e507e0e5SFrank Schaefer } 771e507e0e5SFrank Schaefer 772e507e0e5SFrank Schaefer /* Copy data */ 773f9fe90a4SMauro Carvalho Chehab if (buf && data_len > 0) 774e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 775e507e0e5SFrank Schaefer 776e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 777e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 778e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 779e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 780e507e0e5SFrank Schaefer } 781e507e0e5SFrank Schaefer 782f9fe90a4SMauro Carvalho Chehab /* 783f9fe90a4SMauro Carvalho Chehab * NOTES: 784f9fe90a4SMauro Carvalho Chehab * 785f9fe90a4SMauro Carvalho Chehab * 1) Tested with USB bulk transfers only ! 786e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 787e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 788e507e0e5SFrank Schaefer * header like with the other em28xx devices. 789f9fe90a4SMauro Carvalho Chehab * 790f9fe90a4SMauro Carvalho Chehab * 2) Support for interlaced mode is pure theory. It has not been 791f9fe90a4SMauro Carvalho Chehab * tested and it is unknown if these devices actually support it. 792e507e0e5SFrank Schaefer */ 793e507e0e5SFrank Schaefer } 794e507e0e5SFrank Schaefer 795960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7960fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7970c0d06caSMauro Carvalho Chehab { 798227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 799227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 800227b7c90SFrank Schaefer unsigned int usb_data_len; 8010c0d06caSMauro Carvalho Chehab 8020c0d06caSMauro Carvalho Chehab if (!dev) 8030c0d06caSMauro Carvalho Chehab return 0; 8040c0d06caSMauro Carvalho Chehab 8052665c299SFrank Schaefer if (dev->disconnected) 8060c0d06caSMauro Carvalho Chehab return 0; 8070c0d06caSMauro Carvalho Chehab 8081653cb0cSFrank Schaefer if (urb->status < 0) 8090c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 8100c0d06caSMauro Carvalho Chehab 8114601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 8124601cc39SFrank Schaefer 8134601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 8144601cc39SFrank Schaefer num_packets = 1; 8154601cc39SFrank Schaefer else /* isoc */ 8164601cc39SFrank Schaefer num_packets = urb->number_of_packets; 8170c0d06caSMauro Carvalho Chehab 8184601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 8194601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 820227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 8214601cc39SFrank Schaefer 822227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 8234601cc39SFrank Schaefer } else { /* isoc */ 8244601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 8254601cc39SFrank Schaefer print_err_status(dev, i, 8264601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8270c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8280c0d06caSMauro Carvalho Chehab continue; 8290c0d06caSMauro Carvalho Chehab } 8300c0d06caSMauro Carvalho Chehab 831227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 832227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8330c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8340c0d06caSMauro Carvalho Chehab continue; 8350c0d06caSMauro Carvalho Chehab } 8360c0d06caSMauro Carvalho Chehab 837227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8384601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8394601cc39SFrank Schaefer } 8404601cc39SFrank Schaefer 841227b7c90SFrank Schaefer if (usb_data_len == 0) { 8424601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8434601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8444601cc39SFrank Schaefer continue; 8454601cc39SFrank Schaefer } 8460c0d06caSMauro Carvalho Chehab 847e507e0e5SFrank Schaefer if (dev->is_em25xx) 848e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 849e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 850e507e0e5SFrank Schaefer else 851e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 852e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 8530c0d06caSMauro Carvalho Chehab } 854227b7c90SFrank Schaefer return 1; 8550c0d06caSMauro Carvalho Chehab } 8560c0d06caSMauro Carvalho Chehab 857f9fe90a4SMauro Carvalho Chehab static int get_resource(enum v4l2_buf_type f_type) 858d3829fadSDevin Heitmueller { 859d3829fadSDevin Heitmueller switch (f_type) { 860d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 861d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 862d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 863d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 864d3829fadSDevin Heitmueller default: 865f9fe90a4SMauro Carvalho Chehab WARN_ON(1); 866f9fe90a4SMauro Carvalho Chehab return -1; /* Indicate that device is busy */ 867d3829fadSDevin Heitmueller } 868d3829fadSDevin Heitmueller } 869d3829fadSDevin Heitmueller 870d3829fadSDevin Heitmueller /* Usage lock check functions */ 871d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 872d3829fadSDevin Heitmueller { 873f9fe90a4SMauro Carvalho Chehab int res_type = get_resource(f_type); 874d3829fadSDevin Heitmueller 875d3829fadSDevin Heitmueller /* is it free? */ 876d3829fadSDevin Heitmueller if (dev->resources & res_type) { 877d3829fadSDevin Heitmueller /* no, someone else uses it */ 878d3829fadSDevin Heitmueller return -EBUSY; 879d3829fadSDevin Heitmueller } 880d3829fadSDevin Heitmueller 881d3829fadSDevin Heitmueller /* it's free, grab it */ 882d3829fadSDevin Heitmueller dev->resources |= res_type; 883d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 884d3829fadSDevin Heitmueller return 0; 885d3829fadSDevin Heitmueller } 886d3829fadSDevin Heitmueller 887d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 888d3829fadSDevin Heitmueller { 889f9fe90a4SMauro Carvalho Chehab int res_type = get_resource(f_type); 890d3829fadSDevin Heitmueller 891d3829fadSDevin Heitmueller dev->resources &= ~res_type; 892d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 893d3829fadSDevin Heitmueller } 894d3829fadSDevin Heitmueller 89537ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev) 89637ecc7b1SMauro Carvalho Chehab { 89737ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 89837ecc7b1SMauro Carvalho Chehab int i; 89937ecc7b1SMauro Carvalho Chehab 90037ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 90137ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 90237ecc7b1SMauro Carvalho Chehab return; 90337ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]); 90437ecc7b1SMauro Carvalho Chehab } 90537ecc7b1SMauro Carvalho Chehab #endif 90637ecc7b1SMauro Carvalho Chehab } 90737ecc7b1SMauro Carvalho Chehab 90837ecc7b1SMauro Carvalho Chehab /* 90937ecc7b1SMauro Carvalho Chehab * Media Controller helper functions 91037ecc7b1SMauro Carvalho Chehab */ 91137ecc7b1SMauro Carvalho Chehab 91237ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev) 91337ecc7b1SMauro Carvalho Chehab { 91437ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 91537ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev; 91637ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 91737ecc7b1SMauro Carvalho Chehab struct media_entity *source; 91837ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL; 91937ecc7b1SMauro Carvalho Chehab int ret, active_links = 0; 92037ecc7b1SMauro Carvalho Chehab 92137ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder) 92237ecc7b1SMauro Carvalho Chehab return 0; 92337ecc7b1SMauro Carvalho Chehab 92437ecc7b1SMauro Carvalho Chehab /* 92537ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder. 92637ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be 92737ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't 92837ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2, 92937ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs. 93037ecc7b1SMauro Carvalho Chehab */ 93137ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) { 93237ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) { 93337ecc7b1SMauro Carvalho Chehab found_link = link; 93437ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED) 93537ecc7b1SMauro Carvalho Chehab active_links++; 93637ecc7b1SMauro Carvalho Chehab break; 93737ecc7b1SMauro Carvalho Chehab } 93837ecc7b1SMauro Carvalho Chehab } 93937ecc7b1SMauro Carvalho Chehab 94037ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link) 94137ecc7b1SMauro Carvalho Chehab return 0; 94237ecc7b1SMauro Carvalho Chehab 94337ecc7b1SMauro Carvalho Chehab source = found_link->source->entity; 94437ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) { 94537ecc7b1SMauro Carvalho Chehab struct media_entity *sink; 94637ecc7b1SMauro Carvalho Chehab int flags = 0; 94737ecc7b1SMauro Carvalho Chehab 94837ecc7b1SMauro Carvalho Chehab sink = link->sink->entity; 94937ecc7b1SMauro Carvalho Chehab 95037ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder) 95137ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED; 95237ecc7b1SMauro Carvalho Chehab 95337ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags); 95437ecc7b1SMauro Carvalho Chehab if (ret) { 95529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 956ce8591ffSMauro Carvalho Chehab "Couldn't change link %s->%s to %s. Error %d\n", 95737ecc7b1SMauro Carvalho Chehab source->name, sink->name, 95837ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled", 95937ecc7b1SMauro Carvalho Chehab ret); 96037ecc7b1SMauro Carvalho Chehab return ret; 961f9fe90a4SMauro Carvalho Chehab } 962f9fe90a4SMauro Carvalho Chehab 96337ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n", 96437ecc7b1SMauro Carvalho Chehab source->name, sink->name, 96537ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled"); 96637ecc7b1SMauro Carvalho Chehab } 96737ecc7b1SMauro Carvalho Chehab #endif 96837ecc7b1SMauro Carvalho Chehab return 0; 96937ecc7b1SMauro Carvalho Chehab } 97037ecc7b1SMauro Carvalho Chehab 97137ecc7b1SMauro Carvalho Chehab static const char * const iname[] = { 97237ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite", 97337ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 97437ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 97537ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio", 97637ecc7b1SMauro Carvalho Chehab }; 97737ecc7b1SMauro Carvalho Chehab 97837ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev) 97937ecc7b1SMauro Carvalho Chehab { 98037ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER) 98137ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 98237ecc7b1SMauro Carvalho Chehab int ret, i; 98337ecc7b1SMauro Carvalho Chehab 98437ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */ 98537ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK; 98637ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad); 98737ecc7b1SMauro Carvalho Chehab if (ret < 0) 98829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 989ce8591ffSMauro Carvalho Chehab "failed to initialize video media entity!\n"); 99037ecc7b1SMauro Carvalho Chehab 99137ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) { 99237ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK; 99337ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1, 99437ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad); 99537ecc7b1SMauro Carvalho Chehab if (ret < 0) 99629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 997ce8591ffSMauro Carvalho Chehab "failed to initialize vbi media entity!\n"); 99837ecc7b1SMauro Carvalho Chehab } 99937ecc7b1SMauro Carvalho Chehab 100037ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */ 1001aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 100237ecc7b1SMauro Carvalho Chehab return; 100337ecc7b1SMauro Carvalho Chehab 100437ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */ 100537ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 100637ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i]; 100737ecc7b1SMauro Carvalho Chehab 100837ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 100937ecc7b1SMauro Carvalho Chehab break; 101037ecc7b1SMauro Carvalho Chehab 101137ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type]; 101237ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR; 101337ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 101437ecc7b1SMauro Carvalho Chehab 101537ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) { 101637ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE: 101737ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 101837ecc7b1SMauro Carvalho Chehab break; 101937ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO: 102037ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO; 102137ecc7b1SMauro Carvalho Chehab break; 102237ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */ 1023e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 102437ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF; 102537ecc7b1SMauro Carvalho Chehab break; 102637ecc7b1SMauro Carvalho Chehab } 102737ecc7b1SMauro Carvalho Chehab 102837ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 102937ecc7b1SMauro Carvalho Chehab if (ret < 0) 103029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1031ce8591ffSMauro Carvalho Chehab "failed to initialize input pad[%d]!\n", i); 103237ecc7b1SMauro Carvalho Chehab 103337ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent); 103437ecc7b1SMauro Carvalho Chehab if (ret < 0) 103529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1036ce8591ffSMauro Carvalho Chehab "failed to register input entity %d!\n", i); 103737ecc7b1SMauro Carvalho Chehab } 103837ecc7b1SMauro Carvalho Chehab #endif 103937ecc7b1SMauro Carvalho Chehab } 104037ecc7b1SMauro Carvalho Chehab 1041f9fe90a4SMauro Carvalho Chehab /* 1042f9fe90a4SMauro Carvalho Chehab * Videobuf2 operations 1043f9fe90a4SMauro Carvalho Chehab */ 10440c0d06caSMauro Carvalho Chehab 1045df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq, 1046d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 104736c0f8b3SHans Verkuil unsigned int sizes[], struct device *alloc_devs[]) 10480c0d06caSMauro Carvalho Chehab { 1049d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1050753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1051df9ecb0cSHans Verkuil unsigned long size = 105206e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 10530c0d06caSMauro Carvalho Chehab 1054df9ecb0cSHans Verkuil if (*nplanes) 1055df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0; 1056d3829fadSDevin Heitmueller *nplanes = 1; 1057d3829fadSDevin Heitmueller sizes[0] = size; 105837ecc7b1SMauro Carvalho Chehab 105937ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev); 106037ecc7b1SMauro Carvalho Chehab 10610c0d06caSMauro Carvalho Chehab return 0; 10620c0d06caSMauro Carvalho Chehab } 10630c0d06caSMauro Carvalho Chehab 10640c0d06caSMauro Carvalho Chehab static int 1065d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 10660c0d06caSMauro Carvalho Chehab { 10672d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1068d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1069753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1070d3829fadSDevin Heitmueller unsigned long size; 10710c0d06caSMauro Carvalho Chehab 10722d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field); 10730c0d06caSMauro Carvalho Chehab 107406e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 1075d3829fadSDevin Heitmueller 1076d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 1077d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 1078d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 10790c0d06caSMauro Carvalho Chehab return -EINVAL; 1080d3829fadSDevin Heitmueller } 10812d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size); 10820c0d06caSMauro Carvalho Chehab 1083d3829fadSDevin Heitmueller return 0; 10840c0d06caSMauro Carvalho Chehab } 10850c0d06caSMauro Carvalho Chehab 1086d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 1087d3829fadSDevin Heitmueller { 1088d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1089f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1090d3829fadSDevin Heitmueller struct v4l2_frequency f; 10912d700715SJunghak Sung struct v4l2_fh *owner; 1092d3829fadSDevin Heitmueller int rc = 0; 10930c0d06caSMauro Carvalho Chehab 1094d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1095d3829fadSDevin Heitmueller 1096afeaade9SMauro Carvalho Chehab dev->v4l2->field_count = 0; 1097afeaade9SMauro Carvalho Chehab 1098f9fe90a4SMauro Carvalho Chehab /* 1099f9fe90a4SMauro Carvalho Chehab * Make sure streaming is not already in progress for this type 1100f9fe90a4SMauro Carvalho Chehab * of filehandle (e.g. video, vbi) 1101f9fe90a4SMauro Carvalho Chehab */ 1102d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1103d3829fadSDevin Heitmueller if (rc) 1104d3829fadSDevin Heitmueller return rc; 1105d3829fadSDevin Heitmueller 11068139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1107d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1108d3829fadSDevin Heitmueller 1109d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1110d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1111d3829fadSDevin Heitmueller 1112f9fe90a4SMauro Carvalho Chehab /* 1113f9fe90a4SMauro Carvalho Chehab * Needed, since GPIO might have disabled power of 1114f9fe90a4SMauro Carvalho Chehab * some i2c device 1115d3829fadSDevin Heitmueller */ 1116d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1117d3829fadSDevin Heitmueller 1118f0e38230SFrank Schaefer v4l2->capture_type = -1; 1119c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1120c647a91aSFrank Schaefer dev->analog_xfer_bulk, 11210c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 11220c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1123c647a91aSFrank Schaefer dev->packet_multiplier, 11240fa4a402SFrank Schaefer em28xx_urb_data_copy); 11250c0d06caSMauro Carvalho Chehab if (rc < 0) 1126032f1ddfSFrank Schaefer return rc; 1127d3829fadSDevin Heitmueller 1128d3829fadSDevin Heitmueller /* 1129d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1130d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1131d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1132d3829fadSDevin Heitmueller */ 1133d3829fadSDevin Heitmueller 1134d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1135d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11363854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11372d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11382d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1139d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1140d3829fadSDevin Heitmueller else 1141d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1142f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 114395d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 114413d52fe4SMauro Carvalho Chehab 114513d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 114613d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11470c0d06caSMauro Carvalho Chehab } 11480c0d06caSMauro Carvalho Chehab 11498139a4d5SFrank Schaefer v4l2->streaming_users++; 1150032f1ddfSFrank Schaefer 11510c0d06caSMauro Carvalho Chehab return rc; 11520c0d06caSMauro Carvalho Chehab } 11530c0d06caSMauro Carvalho Chehab 1154e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11550c0d06caSMauro Carvalho Chehab { 1156d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11578139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11580c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1159d3829fadSDevin Heitmueller unsigned long flags = 0; 11600c0d06caSMauro Carvalho Chehab 1161d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11620c0d06caSMauro Carvalho Chehab 1163d3829fadSDevin Heitmueller res_free(dev, vq->type); 1164d3829fadSDevin Heitmueller 11658139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 116613d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 116713d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 116813d52fe4SMauro Carvalho Chehab 1169d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1170d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11710c0d06caSMauro Carvalho Chehab } 11720c0d06caSMauro Carvalho Chehab 1173d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1174f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vid_buf) { 11752d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11762d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1177627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1178627530c3SFrank Schaefer } 1179d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1180d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1181fdf1bc9fSMauro Carvalho Chehab 1182d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1183d3829fadSDevin Heitmueller list_del(&buf->list); 11842d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1185d3829fadSDevin Heitmueller } 1186d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1187d3829fadSDevin Heitmueller } 1188d3829fadSDevin Heitmueller 1189e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11900c0d06caSMauro Carvalho Chehab { 1191d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11928139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1193d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1194d3829fadSDevin Heitmueller unsigned long flags = 0; 11950c0d06caSMauro Carvalho Chehab 1196d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11970c0d06caSMauro Carvalho Chehab 1198d3829fadSDevin Heitmueller res_free(dev, vq->type); 1199d3829fadSDevin Heitmueller 12008139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 120113d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 120213d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 120313d52fe4SMauro Carvalho Chehab 1204d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1205d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 12060c0d06caSMauro Carvalho Chehab } 12070c0d06caSMauro Carvalho Chehab 1208d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1209f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vbi_buf) { 12102d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 12112d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1212627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1213627530c3SFrank Schaefer } 1214d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1215d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1216fdf1bc9fSMauro Carvalho Chehab 1217d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1218d3829fadSDevin Heitmueller list_del(&buf->list); 12192d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1220d3829fadSDevin Heitmueller } 1221d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1222d3829fadSDevin Heitmueller } 1223d3829fadSDevin Heitmueller 1224d3829fadSDevin Heitmueller static void 1225d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1226d3829fadSDevin Heitmueller { 12272d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1228d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 12292d700715SJunghak Sung struct em28xx_buffer *buf = 12302d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1231d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1232d3829fadSDevin Heitmueller unsigned long flags = 0; 1233d3829fadSDevin Heitmueller 1234d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1235d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1236d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1237d3829fadSDevin Heitmueller 1238d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1239d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1240d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1241d3829fadSDevin Heitmueller } 1242d3829fadSDevin Heitmueller 12431bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = { 1244d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12450c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12460c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1247d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1248d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1249d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1250d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12510c0d06caSMauro Carvalho Chehab }; 12520c0d06caSMauro Carvalho Chehab 125301c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1254d3829fadSDevin Heitmueller { 1255d3829fadSDevin Heitmueller int rc; 1256d3829fadSDevin Heitmueller struct vb2_queue *q; 125727a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1258d3829fadSDevin Heitmueller 1259d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 126027a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1261d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1262ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1263ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1264d3829fadSDevin Heitmueller q->drv_priv = dev; 1265d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1266d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1267d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1268d3829fadSDevin Heitmueller 1269d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1270d3829fadSDevin Heitmueller if (rc < 0) 1271d3829fadSDevin Heitmueller return rc; 1272d3829fadSDevin Heitmueller 1273d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 127427a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1275d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1276d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1277ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1278d3829fadSDevin Heitmueller q->drv_priv = dev; 1279d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1280d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1281d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1282d3829fadSDevin Heitmueller 1283d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1284d3829fadSDevin Heitmueller if (rc < 0) 1285d3829fadSDevin Heitmueller return rc; 1286d3829fadSDevin Heitmueller 1287d3829fadSDevin Heitmueller return 0; 1288d3829fadSDevin Heitmueller } 1289d3829fadSDevin Heitmueller 1290f9fe90a4SMauro Carvalho Chehab /* 1291f9fe90a4SMauro Carvalho Chehab * v4l2 interface 1292f9fe90a4SMauro Carvalho Chehab */ 12930c0d06caSMauro Carvalho Chehab 12940c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12950c0d06caSMauro Carvalho Chehab { 129695d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1297fdf1bc9fSMauro Carvalho Chehab 12980c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12990c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 13000c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 13010c0d06caSMauro Carvalho Chehab 13020c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 13030c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 13040c0d06caSMauro Carvalho Chehab 130595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 13060c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 13070c0d06caSMauro Carvalho Chehab 1308aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 13090c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 131095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 13110c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 13120c0d06caSMauro Carvalho Chehab } 13130c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 131495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1315fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1316fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 13170c0d06caSMauro Carvalho Chehab } 13180c0d06caSMauro Carvalho Chehab 13190c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 132095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 13210c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 13220c0d06caSMauro Carvalho Chehab } 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 13250c0d06caSMauro Carvalho Chehab } 13260c0d06caSMauro Carvalho Chehab 132701c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 13280c0d06caSMauro Carvalho Chehab { 1329081b945eSHans Verkuil struct em28xx *dev = priv; 13300c0d06caSMauro Carvalho Chehab 13310c0d06caSMauro Carvalho Chehab /* 1332081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1333081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1334081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1335081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 13360c0d06caSMauro Carvalho Chehab */ 13370c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13380c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1339081b945eSHans Verkuil dev->mute = ctrl->val; 1340081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13410c0d06caSMauro Carvalho Chehab break; 13420c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1343081b945eSHans Verkuil dev->volume = ctrl->val; 1344081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1345081b945eSHans Verkuil break; 1346081b945eSHans Verkuil } 1347081b945eSHans Verkuil } 1348081b945eSHans Verkuil 1349081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1350081b945eSHans Verkuil { 1351abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1352abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1353abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13548f8b113aSFrank Schaefer int ret = -EINVAL; 1355081b945eSHans Verkuil 1356081b945eSHans Verkuil switch (ctrl->id) { 1357081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1358081b945eSHans Verkuil dev->mute = ctrl->val; 13598f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1360081b945eSHans Verkuil break; 1361081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1362081b945eSHans Verkuil dev->volume = ctrl->val; 13638f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13648f8b113aSFrank Schaefer break; 13658f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13668f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13678f8b113aSFrank Schaefer break; 13688f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13698f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13708f8b113aSFrank Schaefer break; 13718f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13728f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13738f8b113aSFrank Schaefer break; 13748f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13758f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13768f8b113aSFrank Schaefer break; 13778f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13788f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13798f8b113aSFrank Schaefer break; 13808f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13818f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13820c0d06caSMauro Carvalho Chehab break; 13830c0d06caSMauro Carvalho Chehab } 13840c0d06caSMauro Carvalho Chehab 13858f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13860c0d06caSMauro Carvalho Chehab } 13870c0d06caSMauro Carvalho Chehab 13888068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1389081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1390081b945eSHans Verkuil }; 1391081b945eSHans Verkuil 13926b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13930c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13940c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13950c0d06caSMauro Carvalho Chehab { 13960c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13970c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13980c0d06caSMauro Carvalho Chehab 13990c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 140081685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 140181685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 14020c0d06caSMauro Carvalho Chehab 14030c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 140481685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 140581685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 14060c0d06caSMauro Carvalho Chehab } 14070c0d06caSMauro Carvalho Chehab 1408b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1409b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1410b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1411b8374138SFrank Schaefer { 1412b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1413b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1414b8374138SFrank Schaefer 1415b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1416b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 14170962a763SMauro Carvalho Chehab 14180962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 14190962a763SMauro Carvalho Chehab if (*width < 1) 14200962a763SMauro Carvalho Chehab *width = 1; 14210962a763SMauro Carvalho Chehab if (*height < 1) 14220962a763SMauro Carvalho Chehab *height = 1; 1423b8374138SFrank Schaefer } 1424b8374138SFrank Schaefer 1425f9fe90a4SMauro Carvalho Chehab /* 1426f9fe90a4SMauro Carvalho Chehab * IOCTL vidioc handling 1427f9fe90a4SMauro Carvalho Chehab */ 14280c0d06caSMauro Carvalho Chehab 14290c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 14300c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14310c0d06caSMauro Carvalho Chehab { 1432917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1433753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14340c0d06caSMauro Carvalho Chehab 1435753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1436753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 143706e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 143806e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1439753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14400c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14410c0d06caSMauro Carvalho Chehab 14420c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 144358159171SFrank Schaefer if (v4l2->progressive) 14440c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14450c0d06caSMauro Carvalho Chehab else 144658159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14470c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14480c0d06caSMauro Carvalho Chehab return 0; 14490c0d06caSMauro Carvalho Chehab } 14500c0d06caSMauro Carvalho Chehab 14510c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14520c0d06caSMauro Carvalho Chehab { 14530c0d06caSMauro Carvalho Chehab unsigned int i; 14540c0d06caSMauro Carvalho Chehab 14550c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14560c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14570c0d06caSMauro Carvalho Chehab return &format[i]; 14580c0d06caSMauro Carvalho Chehab 14590c0d06caSMauro Carvalho Chehab return NULL; 14600c0d06caSMauro Carvalho Chehab } 14610c0d06caSMauro Carvalho Chehab 14620c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14630c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14640c0d06caSMauro Carvalho Chehab { 1465917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 146658159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14670c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14680c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14690c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14700c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14710c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14720c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14730c0d06caSMauro Carvalho Chehab 14740c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14750c0d06caSMauro Carvalho Chehab if (!fmt) { 1476f823ce2aSMauro Carvalho Chehab fmt = &format[0]; 1477f823ce2aSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid. Using default (%08x).\n", 1478f823ce2aSMauro Carvalho Chehab f->fmt.pix.pixelformat, fmt->fourcc); 14790c0d06caSMauro Carvalho Chehab } 14800c0d06caSMauro Carvalho Chehab 14810c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14820c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14830c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14840c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1485d3829fadSDevin Heitmueller /* 1486d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1487d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1488d3829fadSDevin Heitmueller * to 50% 1489d3829fadSDevin Heitmueller */ 14900c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14910c0d06caSMauro Carvalho Chehab width /= 2; 14920c0d06caSMauro Carvalho Chehab } else { 1493f9fe90a4SMauro Carvalho Chehab /* 1494f9fe90a4SMauro Carvalho Chehab * width must even because of the YUYV format 1495f9fe90a4SMauro Carvalho Chehab * height must be even because of interlacing 1496f9fe90a4SMauro Carvalho Chehab */ 14970c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14980c0d06caSMauro Carvalho Chehab 1, 0); 14990c0d06caSMauro Carvalho Chehab } 15000962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 15010962a763SMauro Carvalho Chehab if (width < 1) 15020962a763SMauro Carvalho Chehab width = 1; 15030962a763SMauro Carvalho Chehab if (height < 1) 15040962a763SMauro Carvalho Chehab height = 1; 15050c0d06caSMauro Carvalho Chehab 15066b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 150746f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 15100c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 15110c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1512e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 15130c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 15140c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 151558159171SFrank Schaefer if (v4l2->progressive) 15160c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 15170c0d06caSMauro Carvalho Chehab else 151858159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 15190c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 152051dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 15210c0d06caSMauro Carvalho Chehab 15220c0d06caSMauro Carvalho Chehab return 0; 15230c0d06caSMauro Carvalho Chehab } 15240c0d06caSMauro Carvalho Chehab 15250c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 1526f9fe90a4SMauro Carvalho Chehab unsigned int width, unsigned int height) 15270c0d06caSMauro Carvalho Chehab { 15280c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1529753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15300c0d06caSMauro Carvalho Chehab 15310c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 15320c0d06caSMauro Carvalho Chehab if (!fmt) 15330c0d06caSMauro Carvalho Chehab return -EINVAL; 15340c0d06caSMauro Carvalho Chehab 153506e20672SFrank Schaefer v4l2->format = fmt; 1536753aee77SFrank Schaefer v4l2->width = width; 1537753aee77SFrank Schaefer v4l2->height = height; 15380c0d06caSMauro Carvalho Chehab 15390c0d06caSMauro Carvalho Chehab /* set new image size */ 1540753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1541753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15420c0d06caSMauro Carvalho Chehab 15430c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15440c0d06caSMauro Carvalho Chehab 15450c0d06caSMauro Carvalho Chehab return 0; 15460c0d06caSMauro Carvalho Chehab } 15470c0d06caSMauro Carvalho Chehab 15480c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15490c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15500c0d06caSMauro Carvalho Chehab { 1551d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15528139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15530c0d06caSMauro Carvalho Chehab 1554c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1555d3829fadSDevin Heitmueller return -EBUSY; 15560c0d06caSMauro Carvalho Chehab 15570c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15580c0d06caSMauro Carvalho Chehab 15590c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15600c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15610c0d06caSMauro Carvalho Chehab } 15620c0d06caSMauro Carvalho Chehab 15630c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15640c0d06caSMauro Carvalho Chehab { 1565917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15660c0d06caSMauro Carvalho Chehab 156752faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15680c0d06caSMauro Carvalho Chehab 15690c0d06caSMauro Carvalho Chehab return 0; 15700c0d06caSMauro Carvalho Chehab } 15710c0d06caSMauro Carvalho Chehab 15720c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15730c0d06caSMauro Carvalho Chehab { 1574917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15750c0d06caSMauro Carvalho Chehab 157695d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15770c0d06caSMauro Carvalho Chehab 15780c0d06caSMauro Carvalho Chehab return 0; 15790c0d06caSMauro Carvalho Chehab } 15800c0d06caSMauro Carvalho Chehab 1581314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15820c0d06caSMauro Carvalho Chehab { 1583917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1584753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15850c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15860c0d06caSMauro Carvalho Chehab 158752faaf78SFrank Schaefer if (norm == v4l2->norm) 1588d8c95c08SHans Verkuil return 0; 15890c0d06caSMauro Carvalho Chehab 15908139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1591d8c95c08SHans Verkuil return -EBUSY; 1592d8c95c08SHans Verkuil 159352faaf78SFrank Schaefer v4l2->norm = norm; 15940c0d06caSMauro Carvalho Chehab 15950c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1596d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1597314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15980c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15990c0d06caSMauro Carvalho Chehab 16000c0d06caSMauro Carvalho Chehab /* set new image size */ 1601753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1602753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1603753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1604753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 16050c0d06caSMauro Carvalho Chehab 16060c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 16078774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 16080c0d06caSMauro Carvalho Chehab 16090c0d06caSMauro Carvalho Chehab return 0; 16100c0d06caSMauro Carvalho Chehab } 16110c0d06caSMauro Carvalho Chehab 16120c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 16130c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16140c0d06caSMauro Carvalho Chehab { 16154471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 0 }; 1616917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 161752faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16180c0d06caSMauro Carvalho Chehab int rc = 0; 16190c0d06caSMauro Carvalho Chehab 16204471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16214471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16224471109eSHans Verkuil return -EINVAL; 16234471109eSHans Verkuil 162486ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16254471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 1626aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 162752faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 16284471109eSHans Verkuil video, g_frame_interval, &ival); 16294471109eSHans Verkuil if (!rc) 16304471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16314471109eSHans Verkuil } else { 163252faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 16330c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 16344471109eSHans Verkuil } 16350c0d06caSMauro Carvalho Chehab 16360c0d06caSMauro Carvalho Chehab return rc; 16370c0d06caSMauro Carvalho Chehab } 16380c0d06caSMauro Carvalho Chehab 16390c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 16400c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16410c0d06caSMauro Carvalho Chehab { 1642917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16434471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 16444471109eSHans Verkuil 0, 16454471109eSHans Verkuil p->parm.capture.timeperframe 16464471109eSHans Verkuil }; 16474471109eSHans Verkuil int rc = 0; 16480c0d06caSMauro Carvalho Chehab 1649aa62980bSMauro Carvalho Chehab if (!dev->is_webcam) 16504471109eSHans Verkuil return -ENOTTY; 16514471109eSHans Verkuil 16524471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16534471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16544471109eSHans Verkuil return -EINVAL; 16554471109eSHans Verkuil 16564471109eSHans Verkuil memset(&p->parm, 0, sizeof(p->parm)); 165786ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16584471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 16594471109eSHans Verkuil rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0, 16604471109eSHans Verkuil video, s_frame_interval, &ival); 16614471109eSHans Verkuil if (!rc) 16624471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16634471109eSHans Verkuil return rc; 16640c0d06caSMauro Carvalho Chehab } 16650c0d06caSMauro Carvalho Chehab 16660c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16670c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16680c0d06caSMauro Carvalho Chehab { 1669917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16700c0d06caSMauro Carvalho Chehab unsigned int n; 1671258c4304SMauro Carvalho Chehab int j; 16720c0d06caSMauro Carvalho Chehab 16730c0d06caSMauro Carvalho Chehab n = i->index; 16740c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16750c0d06caSMauro Carvalho Chehab return -EINVAL; 1676f9fe90a4SMauro Carvalho Chehab if (!INPUT(n)->type) 16770c0d06caSMauro Carvalho Chehab return -EINVAL; 16780c0d06caSMauro Carvalho Chehab 16790c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16800c0d06caSMauro Carvalho Chehab 1681cc1e6315SMauro Carvalho Chehab strscpy(i->name, iname[INPUT(n)->type], sizeof(i->name)); 16820c0d06caSMauro Carvalho Chehab 1683f9fe90a4SMauro Carvalho Chehab if (INPUT(n)->type == EM28XX_VMUX_TELEVISION) 16840c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16850c0d06caSMauro Carvalho Chehab 1686d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1687d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1688aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1689d8c95c08SHans Verkuil i->capabilities = 0; 16900c0d06caSMauro Carvalho Chehab 1691258c4304SMauro Carvalho Chehab /* Dynamically generates an audioset bitmask */ 1692258c4304SMauro Carvalho Chehab i->audioset = 0; 1693258c4304SMauro Carvalho Chehab for (j = 0; j < MAX_EM28XX_INPUT; j++) 1694258c4304SMauro Carvalho Chehab if (dev->amux_map[j] != EM28XX_AMUX_UNUSED) 1695258c4304SMauro Carvalho Chehab i->audioset |= 1 << j; 1696258c4304SMauro Carvalho Chehab 16970c0d06caSMauro Carvalho Chehab return 0; 16980c0d06caSMauro Carvalho Chehab } 16990c0d06caSMauro Carvalho Chehab 17000c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 17010c0d06caSMauro Carvalho Chehab { 1702917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17030c0d06caSMauro Carvalho Chehab 17040c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 17050c0d06caSMauro Carvalho Chehab 17060c0d06caSMauro Carvalho Chehab return 0; 17070c0d06caSMauro Carvalho Chehab } 17080c0d06caSMauro Carvalho Chehab 17090c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 17100c0d06caSMauro Carvalho Chehab { 1711917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17120c0d06caSMauro Carvalho Chehab 17130c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 17140c0d06caSMauro Carvalho Chehab return -EINVAL; 1715f9fe90a4SMauro Carvalho Chehab if (!INPUT(i)->type) 17160c0d06caSMauro Carvalho Chehab return -EINVAL; 17170c0d06caSMauro Carvalho Chehab 17180c0d06caSMauro Carvalho Chehab video_mux(dev, i); 17190c0d06caSMauro Carvalho Chehab return 0; 17200c0d06caSMauro Carvalho Chehab } 17210c0d06caSMauro Carvalho Chehab 1722258c4304SMauro Carvalho Chehab static int em28xx_fill_audio_input(struct em28xx *dev, 1723258c4304SMauro Carvalho Chehab const char *s, 1724258c4304SMauro Carvalho Chehab struct v4l2_audio *a, 1725258c4304SMauro Carvalho Chehab unsigned int index) 17260c0d06caSMauro Carvalho Chehab { 1727258c4304SMauro Carvalho Chehab unsigned int idx = dev->amux_map[index]; 17280c0d06caSMauro Carvalho Chehab 1729258c4304SMauro Carvalho Chehab /* 1730258c4304SMauro Carvalho Chehab * With msp3400, almost all mappings use the default (amux = 0). 1731258c4304SMauro Carvalho Chehab * The only one may use a different value is WinTV USB2, where it 1732258c4304SMauro Carvalho Chehab * can also be SCART1 input. 1733258c4304SMauro Carvalho Chehab * As it is very doubtful that we would see new boards with msp3400, 1734258c4304SMauro Carvalho Chehab * let's just reuse the existing switch. 1735258c4304SMauro Carvalho Chehab */ 1736258c4304SMauro Carvalho Chehab if (dev->has_msp34xx && idx != EM28XX_AMUX_UNUSED) 1737258c4304SMauro Carvalho Chehab idx = EM28XX_AMUX_LINE_IN; 1738258c4304SMauro Carvalho Chehab 1739258c4304SMauro Carvalho Chehab switch (idx) { 17400c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 1741cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television", sizeof(a->name)); 17420c0d06caSMauro Carvalho Chehab break; 17430c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 1744cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Line In", sizeof(a->name)); 17450c0d06caSMauro Carvalho Chehab break; 17460c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 1747cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television alt", sizeof(a->name)); 17480c0d06caSMauro Carvalho Chehab break; 17490c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 1750cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Phone", sizeof(a->name)); 17510c0d06caSMauro Carvalho Chehab break; 17520c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 1753cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Mic", sizeof(a->name)); 17540c0d06caSMauro Carvalho Chehab break; 17550c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 1756cc1e6315SMauro Carvalho Chehab strscpy(a->name, "CD", sizeof(a->name)); 17570c0d06caSMauro Carvalho Chehab break; 17580c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 1759cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Aux", sizeof(a->name)); 17600c0d06caSMauro Carvalho Chehab break; 17610c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 1762cc1e6315SMauro Carvalho Chehab strscpy(a->name, "PCM", sizeof(a->name)); 17630c0d06caSMauro Carvalho Chehab break; 1764258c4304SMauro Carvalho Chehab case EM28XX_AMUX_UNUSED: 17650c0d06caSMauro Carvalho Chehab default: 17660c0d06caSMauro Carvalho Chehab return -EINVAL; 17670c0d06caSMauro Carvalho Chehab } 1768258c4304SMauro Carvalho Chehab a->index = index; 17690c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 17700c0d06caSMauro Carvalho Chehab 1771258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: audio input index %d is '%s'\n", 1772258c4304SMauro Carvalho Chehab s, a->index, a->name); 1773258c4304SMauro Carvalho Chehab 17740c0d06caSMauro Carvalho Chehab return 0; 17750c0d06caSMauro Carvalho Chehab } 17760c0d06caSMauro Carvalho Chehab 1777258c4304SMauro Carvalho Chehab static int vidioc_enumaudio(struct file *file, void *fh, struct v4l2_audio *a) 1778258c4304SMauro Carvalho Chehab { 1779258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file); 1780258c4304SMauro Carvalho Chehab 1781258c4304SMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 1782258c4304SMauro Carvalho Chehab return -EINVAL; 1783258c4304SMauro Carvalho Chehab 1784258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, a->index); 1785258c4304SMauro Carvalho Chehab } 1786258c4304SMauro Carvalho Chehab 1787258c4304SMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 1788258c4304SMauro Carvalho Chehab { 1789258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file); 1790258c4304SMauro Carvalho Chehab int i; 1791258c4304SMauro Carvalho Chehab 1792258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) 1793258c4304SMauro Carvalho Chehab if (dev->ctl_ainput == dev->amux_map[i]) 1794258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, i); 1795258c4304SMauro Carvalho Chehab 1796258c4304SMauro Carvalho Chehab /* Should never happen! */ 1797258c4304SMauro Carvalho Chehab return -EINVAL; 1798258c4304SMauro Carvalho Chehab } 1799258c4304SMauro Carvalho Chehab 1800f9fe90a4SMauro Carvalho Chehab static int vidioc_s_audio(struct file *file, void *priv, 1801f9fe90a4SMauro Carvalho Chehab const struct v4l2_audio *a) 18020c0d06caSMauro Carvalho Chehab { 1803917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1804258c4304SMauro Carvalho Chehab int idx, i; 18050c0d06caSMauro Carvalho Chehab 18060c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 18070c0d06caSMauro Carvalho Chehab return -EINVAL; 1808258c4304SMauro Carvalho Chehab 1809258c4304SMauro Carvalho Chehab idx = dev->amux_map[a->index]; 1810258c4304SMauro Carvalho Chehab 1811258c4304SMauro Carvalho Chehab if (idx == EM28XX_AMUX_UNUSED) 18120c0d06caSMauro Carvalho Chehab return -EINVAL; 18130c0d06caSMauro Carvalho Chehab 1814258c4304SMauro Carvalho Chehab dev->ctl_ainput = idx; 1815258c4304SMauro Carvalho Chehab 1816258c4304SMauro Carvalho Chehab /* 1817258c4304SMauro Carvalho Chehab * FIXME: This is wrong, as different inputs at em28xx_cards 1818258c4304SMauro Carvalho Chehab * may have different audio outputs. So, the right thing 1819258c4304SMauro Carvalho Chehab * to do is to implement VIDIOC_G_AUDOUT/VIDIOC_S_AUDOUT. 1820258c4304SMauro Carvalho Chehab * With the current board definitions, this would work fine, 1821258c4304SMauro Carvalho Chehab * as, currently, all boards fit. 1822258c4304SMauro Carvalho Chehab */ 1823258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) 1824258c4304SMauro Carvalho Chehab if (idx == dev->amux_map[i]) 1825258c4304SMauro Carvalho Chehab break; 1826258c4304SMauro Carvalho Chehab if (i == MAX_EM28XX_INPUT) 1827258c4304SMauro Carvalho Chehab return -EINVAL; 1828258c4304SMauro Carvalho Chehab 1829258c4304SMauro Carvalho Chehab dev->ctl_aoutput = INPUT(i)->aout; 18300c0d06caSMauro Carvalho Chehab 18310c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 18320c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 18330c0d06caSMauro Carvalho Chehab 1834258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: set audio input to %d\n", __func__, 1835258c4304SMauro Carvalho Chehab dev->ctl_ainput); 1836258c4304SMauro Carvalho Chehab 18370c0d06caSMauro Carvalho Chehab return 0; 18380c0d06caSMauro Carvalho Chehab } 18390c0d06caSMauro Carvalho Chehab 18400c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 18410c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18420c0d06caSMauro Carvalho Chehab { 1843917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18440c0d06caSMauro Carvalho Chehab 1845f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 18460c0d06caSMauro Carvalho Chehab return -EINVAL; 18470c0d06caSMauro Carvalho Chehab 1848cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Tuner", sizeof(t->name)); 18490c0d06caSMauro Carvalho Chehab 185095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18510c0d06caSMauro Carvalho Chehab return 0; 18520c0d06caSMauro Carvalho Chehab } 18530c0d06caSMauro Carvalho Chehab 18540c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 18552f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18560c0d06caSMauro Carvalho Chehab { 1857917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18580c0d06caSMauro Carvalho Chehab 1859f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 18600c0d06caSMauro Carvalho Chehab return -EINVAL; 18610c0d06caSMauro Carvalho Chehab 186295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18630c0d06caSMauro Carvalho Chehab return 0; 18640c0d06caSMauro Carvalho Chehab } 18650c0d06caSMauro Carvalho Chehab 18660c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 18670c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 18680c0d06caSMauro Carvalho Chehab { 1869917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18703854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18710c0d06caSMauro Carvalho Chehab 1872f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 187320deebfeSHans Verkuil return -EINVAL; 187420deebfeSHans Verkuil 18753854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 18760c0d06caSMauro Carvalho Chehab return 0; 18770c0d06caSMauro Carvalho Chehab } 18780c0d06caSMauro Carvalho Chehab 18790c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1880b530a447SHans Verkuil const struct v4l2_frequency *f) 18810c0d06caSMauro Carvalho Chehab { 1882b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1883917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 188495d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18850c0d06caSMauro Carvalho Chehab 1886f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 18870c0d06caSMauro Carvalho Chehab return -EINVAL; 18880c0d06caSMauro Carvalho Chehab 188995d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 189095d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 18913854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 18920c0d06caSMauro Carvalho Chehab 18930c0d06caSMauro Carvalho Chehab return 0; 18940c0d06caSMauro Carvalho Chehab } 18950c0d06caSMauro Carvalho Chehab 1896cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 189796b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 189896b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 18993b2d17b4SHans Verkuil { 1900917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19013b2d17b4SHans Verkuil 19023b2d17b4SHans Verkuil if (chip->match.addr > 1) 19033b2d17b4SHans Verkuil return -EINVAL; 19043b2d17b4SHans Verkuil if (chip->match.addr == 1) 1905c0decac1SMauro Carvalho Chehab strscpy(chip->name, "ac97", sizeof(chip->name)); 19063b2d17b4SHans Verkuil else 1907c0decac1SMauro Carvalho Chehab strscpy(chip->name, 190895d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 19093b2d17b4SHans Verkuil return 0; 19103b2d17b4SHans Verkuil } 19113b2d17b4SHans Verkuil 191235deba32SFrank Schaefer static int em28xx_reg_len(int reg) 191335deba32SFrank Schaefer { 191435deba32SFrank Schaefer switch (reg) { 191535deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 191635deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 191735deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 191835deba32SFrank Schaefer return 2; 191935deba32SFrank Schaefer default: 192035deba32SFrank Schaefer return 1; 192135deba32SFrank Schaefer } 192235deba32SFrank Schaefer } 19230c0d06caSMauro Carvalho Chehab 19240c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 19250c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 19260c0d06caSMauro Carvalho Chehab { 1927917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19280c0d06caSMauro Carvalho Chehab int ret; 19290c0d06caSMauro Carvalho Chehab 19303b2d17b4SHans Verkuil if (reg->match.addr > 1) 19313b2d17b4SHans Verkuil return -EINVAL; 1932abca2056SHans Verkuil if (reg->match.addr) { 19330c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 19340c0d06caSMauro Carvalho Chehab if (ret < 0) 19350c0d06caSMauro Carvalho Chehab return ret; 19360c0d06caSMauro Carvalho Chehab 19370c0d06caSMauro Carvalho Chehab reg->val = ret; 19380c0d06caSMauro Carvalho Chehab reg->size = 1; 19390c0d06caSMauro Carvalho Chehab return 0; 19400c0d06caSMauro Carvalho Chehab } 19410c0d06caSMauro Carvalho Chehab 19420c0d06caSMauro Carvalho Chehab /* Match host */ 19430c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 19440c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 19450c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 19460c0d06caSMauro Carvalho Chehab 19470c0d06caSMauro Carvalho Chehab if (ret < 0) 19480c0d06caSMauro Carvalho Chehab return ret; 19490c0d06caSMauro Carvalho Chehab 19500c0d06caSMauro Carvalho Chehab reg->val = ret; 19510c0d06caSMauro Carvalho Chehab } else { 19520c0d06caSMauro Carvalho Chehab __le16 val = 0; 1953fdf1bc9fSMauro Carvalho Chehab 195401c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 19550c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 19560c0d06caSMauro Carvalho Chehab if (ret < 0) 19570c0d06caSMauro Carvalho Chehab return ret; 19580c0d06caSMauro Carvalho Chehab 19590c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 19600c0d06caSMauro Carvalho Chehab } 19610c0d06caSMauro Carvalho Chehab 19620c0d06caSMauro Carvalho Chehab return 0; 19630c0d06caSMauro Carvalho Chehab } 19640c0d06caSMauro Carvalho Chehab 19650c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1966977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 19670c0d06caSMauro Carvalho Chehab { 1968917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19690c0d06caSMauro Carvalho Chehab __le16 buf; 19700c0d06caSMauro Carvalho Chehab 19713b2d17b4SHans Verkuil if (reg->match.addr > 1) 19723b2d17b4SHans Verkuil return -EINVAL; 1973abca2056SHans Verkuil if (reg->match.addr) 19740c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 19750c0d06caSMauro Carvalho Chehab 19760c0d06caSMauro Carvalho Chehab /* Match host */ 19770c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 19780c0d06caSMauro Carvalho Chehab 19790c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 19800c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 19810c0d06caSMauro Carvalho Chehab } 19820c0d06caSMauro Carvalho Chehab #endif 19830c0d06caSMauro Carvalho Chehab 19840c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 19850c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 19860c0d06caSMauro Carvalho Chehab { 1987a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1988917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1989ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1990c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 19910c0d06caSMauro Carvalho Chehab 1992c0decac1SMauro Carvalho Chehab strscpy(cap->driver, "em28xx", sizeof(cap->driver)); 1993c0decac1SMauro Carvalho Chehab strscpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1994c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 19950c0d06caSMauro Carvalho Chehab 1996a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1997a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1998a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1999a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 2000a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 2001a9d79fe5SHans Verkuil else 20021d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 20030c0d06caSMauro Carvalho Chehab 2004920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 2005a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 20060c0d06caSMauro Carvalho Chehab 20070c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 2008a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 20090c0d06caSMauro Carvalho Chehab 2010f9fe90a4SMauro Carvalho Chehab cap->capabilities = cap->device_caps | 2011f9fe90a4SMauro Carvalho Chehab V4L2_CAP_DEVICE_CAPS | V4L2_CAP_READWRITE | 2012f9fe90a4SMauro Carvalho Chehab V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 2013d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 20141d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 2015d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 2016a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 20170c0d06caSMauro Carvalho Chehab return 0; 20180c0d06caSMauro Carvalho Chehab } 20190c0d06caSMauro Carvalho Chehab 20200c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 20210c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 20220c0d06caSMauro Carvalho Chehab { 20230c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 20240c0d06caSMauro Carvalho Chehab return -EINVAL; 20250c0d06caSMauro Carvalho Chehab 2026c0decac1SMauro Carvalho Chehab strscpy(f->description, format[f->index].name, sizeof(f->description)); 20270c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 20280c0d06caSMauro Carvalho Chehab 20290c0d06caSMauro Carvalho Chehab return 0; 20300c0d06caSMauro Carvalho Chehab } 20310c0d06caSMauro Carvalho Chehab 20320c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 20330c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 20340c0d06caSMauro Carvalho Chehab { 2035917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20360c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 20370c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 20380c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 20390c0d06caSMauro Carvalho Chehab 20400c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 20410c0d06caSMauro Carvalho Chehab if (!fmt) { 20420c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 20430c0d06caSMauro Carvalho Chehab fsize->pixel_format); 20440c0d06caSMauro Carvalho Chehab return -EINVAL; 20450c0d06caSMauro Carvalho Chehab } 20460c0d06caSMauro Carvalho Chehab 20470c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 20480c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 20490c0d06caSMauro Carvalho Chehab return -EINVAL; 20500c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 20510c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 20520c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 20530c0d06caSMauro Carvalho Chehab return 0; 20540c0d06caSMauro Carvalho Chehab } 20550c0d06caSMauro Carvalho Chehab 20560c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 20570c0d06caSMauro Carvalho Chehab return -EINVAL; 20580c0d06caSMauro Carvalho Chehab 20590c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 20600c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 20616c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 20626c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 20636c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 20640c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 20656c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 20666c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 20670c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 20680c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 20690c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 20700c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 20710c0d06caSMauro Carvalho Chehab return 0; 20720c0d06caSMauro Carvalho Chehab } 20730c0d06caSMauro Carvalho Chehab 20740c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 20750c0d06caSMauro Carvalho Chehab 20760c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 20770c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 20780c0d06caSMauro Carvalho Chehab { 2079917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 2080753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20810c0d06caSMauro Carvalho Chehab 2082753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 20830c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 20840c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 20850c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 20860c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 2087753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 2088753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 20892a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 20900c0d06caSMauro Carvalho Chehab 20910c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 209252faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 20930c0d06caSMauro Carvalho Chehab /* NTSC */ 20940c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 20950c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 209652faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 20970c0d06caSMauro Carvalho Chehab /* PAL */ 20980c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 20990c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 21000c0d06caSMauro Carvalho Chehab } 21010c0d06caSMauro Carvalho Chehab 21020c0d06caSMauro Carvalho Chehab return 0; 21030c0d06caSMauro Carvalho Chehab } 21040c0d06caSMauro Carvalho Chehab 2105f9fe90a4SMauro Carvalho Chehab /* 2106f9fe90a4SMauro Carvalho Chehab * RADIO ESPECIFIC IOCTLS 2107f9fe90a4SMauro Carvalho Chehab */ 21080c0d06caSMauro Carvalho Chehab 21090c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 21100c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 21110c0d06caSMauro Carvalho Chehab { 2112917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 21130c0d06caSMauro Carvalho Chehab 21140c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 21150c0d06caSMauro Carvalho Chehab return -EINVAL; 21160c0d06caSMauro Carvalho Chehab 2117cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Radio", sizeof(t->name)); 21180c0d06caSMauro Carvalho Chehab 211995d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 21200c0d06caSMauro Carvalho Chehab 21210c0d06caSMauro Carvalho Chehab return 0; 21220c0d06caSMauro Carvalho Chehab } 21230c0d06caSMauro Carvalho Chehab 21240c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 21252f73c7c5SHans Verkuil const struct v4l2_tuner *t) 21260c0d06caSMauro Carvalho Chehab { 2127917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 21280c0d06caSMauro Carvalho Chehab 2129f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 21300c0d06caSMauro Carvalho Chehab return -EINVAL; 21310c0d06caSMauro Carvalho Chehab 213295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 21330c0d06caSMauro Carvalho Chehab 21340c0d06caSMauro Carvalho Chehab return 0; 21350c0d06caSMauro Carvalho Chehab } 21360c0d06caSMauro Carvalho Chehab 21370c0d06caSMauro Carvalho Chehab /* 213895d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 213995d2608bSFrank Schaefer * 214095d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 214195d2608bSFrank Schaefer * 214295d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 214395d2608bSFrank Schaefer */ 2144f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 214595d2608bSFrank Schaefer { 214695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 214795d2608bSFrank Schaefer 2148abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 214995d2608bSFrank Schaefer kfree(v4l2); 215095d2608bSFrank Schaefer } 215195d2608bSFrank Schaefer 215295d2608bSFrank Schaefer /* 21530c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 21540c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 21550c0d06caSMauro Carvalho Chehab */ 21560c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 21570c0d06caSMauro Carvalho Chehab { 21580c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 21590c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 216095d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 21610c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 21623c0f90e1SFrank Schaefer int ret; 21630c0d06caSMauro Carvalho Chehab 21640c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 21650c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 21660c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 21670c0d06caSMauro Carvalho Chehab break; 21680c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 21690c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 21700c0d06caSMauro Carvalho Chehab break; 21714e170240SFrank Schaefer case VFL_TYPE_RADIO: 21724e170240SFrank Schaefer break; 21734e170240SFrank Schaefer default: 21744e170240SFrank Schaefer return -EINVAL; 21750c0d06caSMauro Carvalho Chehab } 21760c0d06caSMauro Carvalho Chehab 21778e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 21788e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 21798e2c8717SFrank Schaefer v4l2->users); 21800c0d06caSMauro Carvalho Chehab 21810c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21820c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21833c0f90e1SFrank Schaefer 21843c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 21853c0f90e1SFrank Schaefer if (ret) { 218629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2187ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 21883c0f90e1SFrank Schaefer __func__, ret); 21890c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21903c0f90e1SFrank Schaefer return ret; 21910c0d06caSMauro Carvalho Chehab } 21920c0d06caSMauro Carvalho Chehab 21938e2c8717SFrank Schaefer if (v4l2->users == 0) { 21940c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 21954e170240SFrank Schaefer 21964e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 21970c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 21980c0d06caSMauro Carvalho Chehab 21994e170240SFrank Schaefer /* 22004e170240SFrank Schaefer * Needed, since GPIO might have disabled power 22014e170240SFrank Schaefer * of some i2c devices 22020c0d06caSMauro Carvalho Chehab */ 22030c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 22040c0d06caSMauro Carvalho Chehab } 2205d3829fadSDevin Heitmueller 2206d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 22070c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 220895d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 22090c0d06caSMauro Carvalho Chehab } 22100c0d06caSMauro Carvalho Chehab 221147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 221295d2608bSFrank Schaefer kref_get(&v4l2->ref); 22138e2c8717SFrank Schaefer v4l2->users++; 22140c0d06caSMauro Carvalho Chehab 22150c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 22160c0d06caSMauro Carvalho Chehab 2217d3829fadSDevin Heitmueller return 0; 22180c0d06caSMauro Carvalho Chehab } 22190c0d06caSMauro Carvalho Chehab 22200c0d06caSMauro Carvalho Chehab /* 222101c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 22220c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 22230c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 22240c0d06caSMauro Carvalho Chehab */ 222501c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 22260c0d06caSMauro Carvalho Chehab { 222795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 222895d2608bSFrank Schaefer 2229822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2230822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2231822b8deaSMauro Carvalho Chehab return 0; 2232822b8deaSMauro Carvalho Chehab } 2233822b8deaSMauro Carvalho Chehab 223401c28193SMauro Carvalho Chehab if (!dev->has_video) { 223501c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 223601c28193SMauro Carvalho Chehab return 0; 223701c28193SMauro Carvalho Chehab } 22380c0d06caSMauro Carvalho Chehab 2239f9fe90a4SMauro Carvalho Chehab if (!v4l2) 224095d2608bSFrank Schaefer return 0; 224195d2608bSFrank Schaefer 224229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2243aa929ad7SMauro Carvalho Chehab 2244ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2245ebbfbc20SMauro Carvalho Chehab 224695d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 22475ad10de6SFrank Schaefer 224823e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 224923e8642cSFrank Schaefer 225037ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 225137ecc7b1SMauro Carvalho Chehab 2252d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 225329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2254d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2255d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 22560c0d06caSMauro Carvalho Chehab } 2257d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 225829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2259d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2260d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 22610c0d06caSMauro Carvalho Chehab } 2262d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 226329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2264d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2265d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 22660c0d06caSMauro Carvalho Chehab } 226701c28193SMauro Carvalho Chehab 2268abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 226995d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2270103f18a2SFrank Schaefer 227195d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 227295d2608bSFrank Schaefer 2273ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 227495d2608bSFrank Schaefer 227547677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 22765ad10de6SFrank Schaefer 227701c28193SMauro Carvalho Chehab return 0; 22780c0d06caSMauro Carvalho Chehab } 22790c0d06caSMauro Carvalho Chehab 2280a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2281a61f6811SShuah Khan { 2282a61f6811SShuah Khan if (dev->is_audio_only) 2283a61f6811SShuah Khan return 0; 2284a61f6811SShuah Khan 2285a61f6811SShuah Khan if (!dev->has_video) 2286a61f6811SShuah Khan return 0; 2287a61f6811SShuah Khan 228829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2289a61f6811SShuah Khan em28xx_stop_urbs(dev); 2290a61f6811SShuah Khan return 0; 2291a61f6811SShuah Khan } 2292a61f6811SShuah Khan 2293a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2294a61f6811SShuah Khan { 2295a61f6811SShuah Khan if (dev->is_audio_only) 2296a61f6811SShuah Khan return 0; 2297a61f6811SShuah Khan 2298a61f6811SShuah Khan if (!dev->has_video) 2299a61f6811SShuah Khan return 0; 2300a61f6811SShuah Khan 230129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2302a61f6811SShuah Khan /* what do we do here */ 2303a61f6811SShuah Khan return 0; 2304a61f6811SShuah Khan } 2305a61f6811SShuah Khan 23060c0d06caSMauro Carvalho Chehab /* 23070c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 23080c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 23090c0d06caSMauro Carvalho Chehab * calls and ioctls 23100c0d06caSMauro Carvalho Chehab */ 23110c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 23120c0d06caSMauro Carvalho Chehab { 2313917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 231495d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2315c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 2316f9fe90a4SMauro Carvalho Chehab int err; 23170c0d06caSMauro Carvalho Chehab 23188e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 23198e2c8717SFrank Schaefer 23208e2c8717SFrank Schaefer vb2_fop_release(filp); 232198c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 23220c0d06caSMauro Carvalho Chehab 23238e2c8717SFrank Schaefer if (v4l2->users == 1) { 232447677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 232547677e51SMauro Carvalho Chehab if (dev->disconnected) 232601c28193SMauro Carvalho Chehab goto exit; 23270c0d06caSMauro Carvalho Chehab 23280c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 23293aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 23300c0d06caSMauro Carvalho Chehab 23310c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 23320c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 23330c0d06caSMauro Carvalho Chehab 23340c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 23350c0d06caSMauro Carvalho Chehab dev->alt = 0; 23360c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2337f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, 0, 0); 2338f9fe90a4SMauro Carvalho Chehab if (err < 0) { 233929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2340ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 2341f9fe90a4SMauro Carvalho Chehab err); 23420c0d06caSMauro Carvalho Chehab } 23430c0d06caSMauro Carvalho Chehab } 23440c0d06caSMauro Carvalho Chehab 234501c28193SMauro Carvalho Chehab exit: 23468e2c8717SFrank Schaefer v4l2->users--; 234795d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 23480c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 234947677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 235047677e51SMauro Carvalho Chehab 23510c0d06caSMauro Carvalho Chehab return 0; 23520c0d06caSMauro Carvalho Chehab } 23530c0d06caSMauro Carvalho Chehab 23540c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 23550c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23560c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23570c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2358d3829fadSDevin Heitmueller .read = vb2_fop_read, 2359d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2360d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 23610c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23620c0d06caSMauro Carvalho Chehab }; 23630c0d06caSMauro Carvalho Chehab 23640c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 23650c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 23660c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 23670c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 23680c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 23690c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 23700c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23712a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2372aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23730c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 2374258c4304SMauro Carvalho Chehab .vidioc_enumaudio = vidioc_enumaudio, 23750c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 23760c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 23770c0d06caSMauro Carvalho Chehab 2378d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2379d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2380d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2381d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2382d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2383d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2384d3829fadSDevin Heitmueller 23850c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 23860c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 23870c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 23880c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 23890c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 23900c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 23910c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 23920c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2393d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2394d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 23950c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 23960c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 23970c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23980c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 239950fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 240050fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 24010c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 240296b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 24030c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24040c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24050c0d06caSMauro Carvalho Chehab #endif 24060c0d06caSMauro Carvalho Chehab }; 24070c0d06caSMauro Carvalho Chehab 24080c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 24090c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 24100c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2411d4352f36SHans Verkuil .release = video_device_release_empty, 24120c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 24130c0d06caSMauro Carvalho Chehab }; 24140c0d06caSMauro Carvalho Chehab 24150c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 24160c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 24170c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 24180c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 24190c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 24200c0d06caSMauro Carvalho Chehab }; 24210c0d06caSMauro Carvalho Chehab 24220c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2423a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 24240c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 24250c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 24260c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 24270c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 242850fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 242950fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 24300c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2431430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 24320c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24330c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24340c0d06caSMauro Carvalho Chehab #endif 24350c0d06caSMauro Carvalho Chehab }; 24360c0d06caSMauro Carvalho Chehab 24370c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 24380c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 24390c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2440d4352f36SHans Verkuil .release = video_device_release_empty, 24410c0d06caSMauro Carvalho Chehab }; 24420c0d06caSMauro Carvalho Chehab 2443b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2444b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2445b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2446b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2447b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2448b64f8e9aSMauro Carvalho Chehab 2449b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2450b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2451b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2452b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2453b64f8e9aSMauro Carvalho Chehab }; 2454b64f8e9aSMauro Carvalho Chehab 2455b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2456b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2457b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2458b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2459b64f8e9aSMauro Carvalho Chehab }; 2460b64f8e9aSMauro Carvalho Chehab 24610c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 24620c0d06caSMauro Carvalho Chehab 2463d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2464d4352f36SHans Verkuil struct video_device *vfd, 24650c0d06caSMauro Carvalho Chehab const struct video_device *template, 24660c0d06caSMauro Carvalho Chehab const char *type_name) 24670c0d06caSMauro Carvalho Chehab { 24680c0d06caSMauro Carvalho Chehab *vfd = *template; 246995d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 24700c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2471aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 2472d8c95c08SHans Verkuil vfd->tvnorms = 0; 24730c0d06caSMauro Carvalho Chehab 24740c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 247529b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 24760c0d06caSMauro Carvalho Chehab 24770c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 24780c0d06caSMauro Carvalho Chehab } 24790c0d06caSMauro Carvalho Chehab 24803319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 24810560f337SMauro Carvalho Chehab { 24823854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 24833854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 24840560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 24850560f337SMauro Carvalho Chehab struct v4l2_frequency f; 24860560f337SMauro Carvalho Chehab 24870560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 24880560f337SMauro Carvalho Chehab 24890560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 24900560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 24910560f337SMauro Carvalho Chehab 24920560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 24930560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 24940560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 24950560f337SMauro Carvalho Chehab 249695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 249795d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24980560f337SMauro Carvalho Chehab } 24990560f337SMauro Carvalho Chehab 2500f9fe90a4SMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT && dev->tuner_type) { 25010560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 25023319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 25030560f337SMauro Carvalho Chehab 250495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 250595d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 25060560f337SMauro Carvalho Chehab } 25070560f337SMauro Carvalho Chehab 25086867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 25090560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 25100560f337SMauro Carvalho Chehab 25110560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 25126867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 25130560f337SMauro Carvalho Chehab 251495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 251595d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 25160560f337SMauro Carvalho Chehab } 25170560f337SMauro Carvalho Chehab 25180560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 25190560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 25200560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 25210560f337SMauro Carvalho Chehab 25220560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 25230560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 25240560f337SMauro Carvalho Chehab 25250560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 25260560f337SMauro Carvalho Chehab 25270560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 25280560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 25290560f337SMauro Carvalho Chehab 253095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 25310560f337SMauro Carvalho Chehab } 25320560f337SMauro Carvalho Chehab 25330560f337SMauro Carvalho Chehab /* configure tuner */ 25340560f337SMauro Carvalho Chehab f.tuner = 0; 25350560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 25360560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 25373854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 253895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 25390560f337SMauro Carvalho Chehab } 25400560f337SMauro Carvalho Chehab 254101c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 25420c0d06caSMauro Carvalho Chehab { 25430c0d06caSMauro Carvalho Chehab u8 val; 25440c0d06caSMauro Carvalho Chehab int ret; 25450c0d06caSMauro Carvalho Chehab unsigned int maxw; 2546abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 254795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2548b64f8e9aSMauro Carvalho Chehab 2549822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2550822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2551822b8deaSMauro Carvalho Chehab return 0; 2552822b8deaSMauro Carvalho Chehab } 2553822b8deaSMauro Carvalho Chehab 255401c28193SMauro Carvalho Chehab if (!dev->has_video) { 2555b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2556b64f8e9aSMauro Carvalho Chehab return 0; 2557b64f8e9aSMauro Carvalho Chehab } 25580c0d06caSMauro Carvalho Chehab 255929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 25600c0d06caSMauro Carvalho Chehab 256101c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 256201c28193SMauro Carvalho Chehab 2563f9fe90a4SMauro Carvalho Chehab v4l2 = kzalloc(sizeof(*v4l2), GFP_KERNEL); 25648314d402SMauro Carvalho Chehab if (!v4l2) { 256595d2608bSFrank Schaefer mutex_unlock(&dev->lock); 256695d2608bSFrank Schaefer return -ENOMEM; 256795d2608bSFrank Schaefer } 256895d2608bSFrank Schaefer kref_init(&v4l2->ref); 2569abc1308fSFrank Schaefer v4l2->dev = dev; 257095d2608bSFrank Schaefer dev->v4l2 = v4l2; 257195d2608bSFrank Schaefer 257237ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 257337ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 257437ecc7b1SMauro Carvalho Chehab #endif 257529b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2576b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 257729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2578ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2579b64f8e9aSMauro Carvalho Chehab goto err; 2580b64f8e9aSMauro Carvalho Chehab } 2581b64f8e9aSMauro Carvalho Chehab 2582abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2583b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 258495d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2585b64f8e9aSMauro Carvalho Chehab 2586aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 25877e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 258858159171SFrank Schaefer 2589b64f8e9aSMauro Carvalho Chehab /* 2590b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2591b64f8e9aSMauro Carvalho Chehab */ 2592a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY; 25939297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2594b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2595b64f8e9aSMauro Carvalho Chehab 2596b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2597b64f8e9aSMauro Carvalho Chehab 2598aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) 259995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 260095d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2601b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2602b64f8e9aSMauro Carvalho Chehab 2603b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 260495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 260595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2606b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2607b64f8e9aSMauro Carvalho Chehab 2608b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 260995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 261095d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2611b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2612b64f8e9aSMauro Carvalho Chehab 2613b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 261495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 261595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2616b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2617b64f8e9aSMauro Carvalho Chehab 2618b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2619b64f8e9aSMauro Carvalho Chehab 2620b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 26213319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 26226867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2623b64f8e9aSMauro Carvalho Chehab 2624b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 262595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 262695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2627fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2628fdf1bc9fSMauro Carvalho Chehab NULL); 2629b64f8e9aSMauro Carvalho Chehab 2630b64f8e9aSMauro Carvalho Chehab if (has_demod) 263195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2632fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2633fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2634fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 26353319e6f8SFrank Schaefer if (tuner_addr == 0) { 2636b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2637b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2638b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2639b64f8e9aSMauro Carvalho Chehab 264095d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2641fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2642fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2643fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2644b64f8e9aSMauro Carvalho Chehab 2645b64f8e9aSMauro Carvalho Chehab if (sd) 26463319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2647b64f8e9aSMauro Carvalho Chehab } else { 264895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 264995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 26503319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2651b64f8e9aSMauro Carvalho Chehab } 2652b64f8e9aSMauro Carvalho Chehab 26533319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 26543319e6f8SFrank Schaefer } 26553319e6f8SFrank Schaefer 2656d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2657b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2658b64f8e9aSMauro Carvalho Chehab 2659b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2660b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2661b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 266229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2663ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2664b64f8e9aSMauro Carvalho Chehab __func__, ret); 2665b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2666b64f8e9aSMauro Carvalho Chehab } 2667b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2668b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2669b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2670b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2671b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2672b64f8e9aSMauro Carvalho Chehab } else { 2673b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2674b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2675b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2676b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2677b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2678b64f8e9aSMauro Carvalho Chehab } 2679b64f8e9aSMauro Carvalho Chehab 2680b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2681b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2682b64f8e9aSMauro Carvalho Chehab 2683b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2684b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2685b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2686b64f8e9aSMauro Carvalho Chehab 2687aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 2688b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2689b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2690b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 269129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2692ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2693b64f8e9aSMauro Carvalho Chehab __func__, ret); 2694b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2695b64f8e9aSMauro Carvalho Chehab } 2696f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2697b64f8e9aSMauro Carvalho Chehab 2698b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2699b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 270029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2701ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2702b64f8e9aSMauro Carvalho Chehab __func__, ret); 2703b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2704b64f8e9aSMauro Carvalho Chehab } 2705f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2706b64f8e9aSMauro Carvalho Chehab } 2707b64f8e9aSMauro Carvalho Chehab 27080c0d06caSMauro Carvalho Chehab /* set default norm */ 270952faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 27108774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 271158159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 27120c0d06caSMauro Carvalho Chehab 27130c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 271406e20672SFrank Schaefer v4l2->format = &format[0]; 27150c0d06caSMauro Carvalho Chehab 27160c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 2717f9fe90a4SMauro Carvalho Chehab /* 2718f9fe90a4SMauro Carvalho Chehab * MaxPacketSize for em2800 is too small to capture at full resolution 2719f9fe90a4SMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% 2720f9fe90a4SMauro Carvalho Chehab */ 27210c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 27220c0d06caSMauro Carvalho Chehab maxw /= 2; 27230c0d06caSMauro Carvalho Chehab 27240c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 27250c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 27260c0d06caSMauro Carvalho Chehab 27270c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 27280c0d06caSMauro Carvalho Chehab 27290c0d06caSMauro Carvalho Chehab /* Audio defaults */ 27300c0d06caSMauro Carvalho Chehab dev->mute = 1; 27310c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 27320c0d06caSMauro Carvalho Chehab 27330c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 27340c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 27350c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 27360c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 27370c0d06caSMauro Carvalho Chehab 27380c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 27390c0d06caSMauro Carvalho Chehab 27408f8b113aSFrank Schaefer /* Add image controls */ 2741f9fe90a4SMauro Carvalho Chehab 2742f9fe90a4SMauro Carvalho Chehab /* 2743f9fe90a4SMauro Carvalho Chehab * NOTE: at this point, the subdevices are already registered, so 2744f9fe90a4SMauro Carvalho Chehab * bridge controls are only added/enabled when no subdevice provides 2745f9fe90a4SMauro Carvalho Chehab * them 2746f9fe90a4SMauro Carvalho Chehab */ 2747f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2748ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27498f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 27508f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2751f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2752ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27538f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 27548f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2755f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2756ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27578f8b113aSFrank Schaefer V4L2_CID_SATURATION, 27588f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2759f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2760ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27618f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 27628f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2763f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2764ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27658f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 27668f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2767f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2768ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27698f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 27708f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 27718f8b113aSFrank Schaefer 27728f8b113aSFrank Schaefer /* Reset image controls */ 27738f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2774ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2775ad298055SFrank Schaefer ret = hdl->error; 2776b64f8e9aSMauro Carvalho Chehab if (ret) 2777b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27788f8b113aSFrank Schaefer 27790c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2780d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 278127a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 278227a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2783d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2784d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 27850c0d06caSMauro Carvalho Chehab 27866e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 2787aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 2788d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2789d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2790d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 27913bc85cceSFrank Schaefer } else { 2792d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 27936e46dabaSFrank Schaefer } 279466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2795d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2796d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2797d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2798d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 279966df67b7SFrank Schaefer } 2800920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2801d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2802d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2803c2dcef83SFrank Schaefer } 28046e46dabaSFrank Schaefer 28050c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2806d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 28070c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 28080c0d06caSMauro Carvalho Chehab if (ret) { 280929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2810ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2811b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28120c0d06caSMauro Carvalho Chehab } 28130c0d06caSMauro Carvalho Chehab 28140c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 28150c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2816d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 28170c0d06caSMauro Carvalho Chehab "vbi"); 28180c0d06caSMauro Carvalho Chehab 2819d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2820d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2821d3829fadSDevin Heitmueller 282266df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2823d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 282466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2825d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2826d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2827d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2828d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 282966df67b7SFrank Schaefer } 2830920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2831d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2832d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2833c2dcef83SFrank Schaefer } 283466df67b7SFrank Schaefer 28350c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2836d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 28370c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 28380c0d06caSMauro Carvalho Chehab if (ret < 0) { 283929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2840ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2841b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28420c0d06caSMauro Carvalho Chehab } 28430c0d06caSMauro Carvalho Chehab } 28440c0d06caSMauro Carvalho Chehab 28450c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2846d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 28470c0d06caSMauro Carvalho Chehab "radio"); 2848d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 28490c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 28500c0d06caSMauro Carvalho Chehab if (ret < 0) { 285129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2852ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2853b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28540c0d06caSMauro Carvalho Chehab } 285529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2856ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2857d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 28580c0d06caSMauro Carvalho Chehab } 28590c0d06caSMauro Carvalho Chehab 286037ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 286137ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 286237ecc7b1SMauro Carvalho Chehab 28630d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2864de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 286537ecc7b1SMauro Carvalho Chehab if (ret) { 286629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2867ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 286837ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 286937ecc7b1SMauro Carvalho Chehab goto unregister_dev; 287037ecc7b1SMauro Carvalho Chehab } 28710d37ba62SArnd Bergmann #endif 287237ecc7b1SMauro Carvalho Chehab 287329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2874ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2875d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 28760c0d06caSMauro Carvalho Chehab 2877d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 287829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2879ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2880d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 28810c0d06caSMauro Carvalho Chehab 2882b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 28833aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 2884b64f8e9aSMauro Carvalho Chehab 2885b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2886b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2887b64f8e9aSMauro Carvalho Chehab 288829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2889ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 28909634614fSMauro Carvalho Chehab 289147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 289247677e51SMauro Carvalho Chehab 289301c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 28940c0d06caSMauro Carvalho Chehab return 0; 2895b64f8e9aSMauro Carvalho Chehab 2896b64f8e9aSMauro Carvalho Chehab unregister_dev: 289756a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 289829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2899ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 290056a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 290156a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 290256a7f515SMauro Carvalho Chehab } 290356a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 290429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2905ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 290656a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 290756a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 290856a7f515SMauro Carvalho Chehab } 290956a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 291029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2911ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 291256a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 291356a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 291456a7f515SMauro Carvalho Chehab } 291556a7f515SMauro Carvalho Chehab 2916abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 291795d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2918b64f8e9aSMauro Carvalho Chehab err: 291995d2608bSFrank Schaefer dev->v4l2 = NULL; 292095d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 292101c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2922b64f8e9aSMauro Carvalho Chehab return ret; 29230c0d06caSMauro Carvalho Chehab } 292401c28193SMauro Carvalho Chehab 292501c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 292601c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 292701c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 292801c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 292901c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2930a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2931a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 293201c28193SMauro Carvalho Chehab }; 293301c28193SMauro Carvalho Chehab 293401c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 293501c28193SMauro Carvalho Chehab { 293601c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 293701c28193SMauro Carvalho Chehab } 293801c28193SMauro Carvalho Chehab 293901c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 294001c28193SMauro Carvalho Chehab { 294101c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 294201c28193SMauro Carvalho Chehab } 294301c28193SMauro Carvalho Chehab 294401c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 294501c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2946