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 1096f9fe90a4SMauro Carvalho Chehab /* 1097f9fe90a4SMauro Carvalho Chehab * Make sure streaming is not already in progress for this type 1098f9fe90a4SMauro Carvalho Chehab * of filehandle (e.g. video, vbi) 1099f9fe90a4SMauro Carvalho Chehab */ 1100d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1101d3829fadSDevin Heitmueller if (rc) 1102d3829fadSDevin Heitmueller return rc; 1103d3829fadSDevin Heitmueller 11048139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1105d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1106d3829fadSDevin Heitmueller 1107d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1108d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1109d3829fadSDevin Heitmueller 1110f9fe90a4SMauro Carvalho Chehab /* 1111f9fe90a4SMauro Carvalho Chehab * Needed, since GPIO might have disabled power of 1112f9fe90a4SMauro Carvalho Chehab * some i2c device 1113d3829fadSDevin Heitmueller */ 1114d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1115d3829fadSDevin Heitmueller 1116f0e38230SFrank Schaefer v4l2->capture_type = -1; 1117c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1118c647a91aSFrank Schaefer dev->analog_xfer_bulk, 11190c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 11200c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1121c647a91aSFrank Schaefer dev->packet_multiplier, 11220fa4a402SFrank Schaefer em28xx_urb_data_copy); 11230c0d06caSMauro Carvalho Chehab if (rc < 0) 1124032f1ddfSFrank Schaefer return rc; 1125d3829fadSDevin Heitmueller 1126d3829fadSDevin Heitmueller /* 1127d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1128d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1129d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1130d3829fadSDevin Heitmueller */ 1131d3829fadSDevin Heitmueller 1132d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1133d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11343854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11352d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11362d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1137d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1138d3829fadSDevin Heitmueller else 1139d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1140f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 114195d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 114213d52fe4SMauro Carvalho Chehab 114313d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 114413d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11450c0d06caSMauro Carvalho Chehab } 11460c0d06caSMauro Carvalho Chehab 11478139a4d5SFrank Schaefer v4l2->streaming_users++; 1148032f1ddfSFrank Schaefer 11490c0d06caSMauro Carvalho Chehab return rc; 11500c0d06caSMauro Carvalho Chehab } 11510c0d06caSMauro Carvalho Chehab 1152e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11530c0d06caSMauro Carvalho Chehab { 1154d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11558139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11560c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1157d3829fadSDevin Heitmueller unsigned long flags = 0; 11580c0d06caSMauro Carvalho Chehab 1159d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11600c0d06caSMauro Carvalho Chehab 1161d3829fadSDevin Heitmueller res_free(dev, vq->type); 1162d3829fadSDevin Heitmueller 11638139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 116413d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 116513d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 116613d52fe4SMauro Carvalho Chehab 1167d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1168d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11690c0d06caSMauro Carvalho Chehab } 11700c0d06caSMauro Carvalho Chehab 1171d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1172f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vid_buf) { 11732d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11742d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1175627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1176627530c3SFrank Schaefer } 1177d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1178d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1179fdf1bc9fSMauro Carvalho Chehab 1180d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1181d3829fadSDevin Heitmueller list_del(&buf->list); 11822d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1183d3829fadSDevin Heitmueller } 1184d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1185d3829fadSDevin Heitmueller } 1186d3829fadSDevin Heitmueller 1187e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11880c0d06caSMauro Carvalho Chehab { 1189d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11908139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1191d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1192d3829fadSDevin Heitmueller unsigned long flags = 0; 11930c0d06caSMauro Carvalho Chehab 1194d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11950c0d06caSMauro Carvalho Chehab 1196d3829fadSDevin Heitmueller res_free(dev, vq->type); 1197d3829fadSDevin Heitmueller 11988139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 119913d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 120013d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 120113d52fe4SMauro Carvalho Chehab 1202d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1203d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 12040c0d06caSMauro Carvalho Chehab } 12050c0d06caSMauro Carvalho Chehab 1206d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1207f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vbi_buf) { 12082d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 12092d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1210627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1211627530c3SFrank Schaefer } 1212d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1213d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1214fdf1bc9fSMauro Carvalho Chehab 1215d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1216d3829fadSDevin Heitmueller list_del(&buf->list); 12172d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1218d3829fadSDevin Heitmueller } 1219d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1220d3829fadSDevin Heitmueller } 1221d3829fadSDevin Heitmueller 1222d3829fadSDevin Heitmueller static void 1223d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1224d3829fadSDevin Heitmueller { 12252d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1226d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 12272d700715SJunghak Sung struct em28xx_buffer *buf = 12282d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1229d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1230d3829fadSDevin Heitmueller unsigned long flags = 0; 1231d3829fadSDevin Heitmueller 1232d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1233d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1234d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1235d3829fadSDevin Heitmueller 1236d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1237d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1238d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1239d3829fadSDevin Heitmueller } 1240d3829fadSDevin Heitmueller 12411bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = { 1242d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12430c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12440c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1245d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1246d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1247d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1248d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12490c0d06caSMauro Carvalho Chehab }; 12500c0d06caSMauro Carvalho Chehab 125101c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1252d3829fadSDevin Heitmueller { 1253d3829fadSDevin Heitmueller int rc; 1254d3829fadSDevin Heitmueller struct vb2_queue *q; 125527a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1256d3829fadSDevin Heitmueller 1257d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 125827a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1259d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1260ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1261ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1262d3829fadSDevin Heitmueller q->drv_priv = dev; 1263d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1264d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1265d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1266d3829fadSDevin Heitmueller 1267d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1268d3829fadSDevin Heitmueller if (rc < 0) 1269d3829fadSDevin Heitmueller return rc; 1270d3829fadSDevin Heitmueller 1271d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 127227a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1273d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1274d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1275ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1276d3829fadSDevin Heitmueller q->drv_priv = dev; 1277d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1278d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1279d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1280d3829fadSDevin Heitmueller 1281d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1282d3829fadSDevin Heitmueller if (rc < 0) 1283d3829fadSDevin Heitmueller return rc; 1284d3829fadSDevin Heitmueller 1285d3829fadSDevin Heitmueller return 0; 1286d3829fadSDevin Heitmueller } 1287d3829fadSDevin Heitmueller 1288f9fe90a4SMauro Carvalho Chehab /* 1289f9fe90a4SMauro Carvalho Chehab * v4l2 interface 1290f9fe90a4SMauro Carvalho Chehab */ 12910c0d06caSMauro Carvalho Chehab 12920c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12930c0d06caSMauro Carvalho Chehab { 129495d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1295fdf1bc9fSMauro Carvalho Chehab 12960c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12970c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 12980c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 12990c0d06caSMauro Carvalho Chehab 13000c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 13010c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 13020c0d06caSMauro Carvalho Chehab 130395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 13040c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 13050c0d06caSMauro Carvalho Chehab 1306aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 13070c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 130895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 13090c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 13100c0d06caSMauro Carvalho Chehab } 13110c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 131295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1313fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1314fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 13150c0d06caSMauro Carvalho Chehab } 13160c0d06caSMauro Carvalho Chehab 13170c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 131895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 13190c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 13200c0d06caSMauro Carvalho Chehab } 13210c0d06caSMauro Carvalho Chehab 13220c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 13230c0d06caSMauro Carvalho Chehab } 13240c0d06caSMauro Carvalho Chehab 132501c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 13260c0d06caSMauro Carvalho Chehab { 1327081b945eSHans Verkuil struct em28xx *dev = priv; 13280c0d06caSMauro Carvalho Chehab 13290c0d06caSMauro Carvalho Chehab /* 1330081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1331081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1332081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1333081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 13340c0d06caSMauro Carvalho Chehab */ 13350c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13360c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1337081b945eSHans Verkuil dev->mute = ctrl->val; 1338081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13390c0d06caSMauro Carvalho Chehab break; 13400c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1341081b945eSHans Verkuil dev->volume = ctrl->val; 1342081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1343081b945eSHans Verkuil break; 1344081b945eSHans Verkuil } 1345081b945eSHans Verkuil } 1346081b945eSHans Verkuil 1347081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1348081b945eSHans Verkuil { 1349abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1350abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1351abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13528f8b113aSFrank Schaefer int ret = -EINVAL; 1353081b945eSHans Verkuil 1354081b945eSHans Verkuil switch (ctrl->id) { 1355081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1356081b945eSHans Verkuil dev->mute = ctrl->val; 13578f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1358081b945eSHans Verkuil break; 1359081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1360081b945eSHans Verkuil dev->volume = ctrl->val; 13618f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13628f8b113aSFrank Schaefer break; 13638f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13648f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13658f8b113aSFrank Schaefer break; 13668f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13678f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13688f8b113aSFrank Schaefer break; 13698f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13708f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13718f8b113aSFrank Schaefer break; 13728f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13738f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13748f8b113aSFrank Schaefer break; 13758f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13768f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13778f8b113aSFrank Schaefer break; 13788f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13798f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13800c0d06caSMauro Carvalho Chehab break; 13810c0d06caSMauro Carvalho Chehab } 13820c0d06caSMauro Carvalho Chehab 13838f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13840c0d06caSMauro Carvalho Chehab } 13850c0d06caSMauro Carvalho Chehab 13868068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1387081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1388081b945eSHans Verkuil }; 1389081b945eSHans Verkuil 13906b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13910c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13920c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13930c0d06caSMauro Carvalho Chehab { 13940c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13950c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13960c0d06caSMauro Carvalho Chehab 13970c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 139881685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 139981685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 14000c0d06caSMauro Carvalho Chehab 14010c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 140281685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 140381685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 14040c0d06caSMauro Carvalho Chehab } 14050c0d06caSMauro Carvalho Chehab 1406b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1407b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1408b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1409b8374138SFrank Schaefer { 1410b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1411b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1412b8374138SFrank Schaefer 1413b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1414b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 14150962a763SMauro Carvalho Chehab 14160962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 14170962a763SMauro Carvalho Chehab if (*width < 1) 14180962a763SMauro Carvalho Chehab *width = 1; 14190962a763SMauro Carvalho Chehab if (*height < 1) 14200962a763SMauro Carvalho Chehab *height = 1; 1421b8374138SFrank Schaefer } 1422b8374138SFrank Schaefer 1423f9fe90a4SMauro Carvalho Chehab /* 1424f9fe90a4SMauro Carvalho Chehab * IOCTL vidioc handling 1425f9fe90a4SMauro Carvalho Chehab */ 14260c0d06caSMauro Carvalho Chehab 14270c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 14280c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14290c0d06caSMauro Carvalho Chehab { 1430917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1431753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14320c0d06caSMauro Carvalho Chehab 1433753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1434753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 143506e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 143606e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1437753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14380c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14390c0d06caSMauro Carvalho Chehab 14400c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 144158159171SFrank Schaefer if (v4l2->progressive) 14420c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14430c0d06caSMauro Carvalho Chehab else 144458159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14450c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14460c0d06caSMauro Carvalho Chehab return 0; 14470c0d06caSMauro Carvalho Chehab } 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14500c0d06caSMauro Carvalho Chehab { 14510c0d06caSMauro Carvalho Chehab unsigned int i; 14520c0d06caSMauro Carvalho Chehab 14530c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14540c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14550c0d06caSMauro Carvalho Chehab return &format[i]; 14560c0d06caSMauro Carvalho Chehab 14570c0d06caSMauro Carvalho Chehab return NULL; 14580c0d06caSMauro Carvalho Chehab } 14590c0d06caSMauro Carvalho Chehab 14600c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14610c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14620c0d06caSMauro Carvalho Chehab { 1463917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 146458159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14650c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14660c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14670c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14680c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14690c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14700c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14710c0d06caSMauro Carvalho Chehab 14720c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14730c0d06caSMauro Carvalho Chehab if (!fmt) { 1474f823ce2aSMauro Carvalho Chehab fmt = &format[0]; 1475f823ce2aSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid. Using default (%08x).\n", 1476f823ce2aSMauro Carvalho Chehab f->fmt.pix.pixelformat, fmt->fourcc); 14770c0d06caSMauro Carvalho Chehab } 14780c0d06caSMauro Carvalho Chehab 14790c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14800c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14810c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14820c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1483d3829fadSDevin Heitmueller /* 1484d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1485d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1486d3829fadSDevin Heitmueller * to 50% 1487d3829fadSDevin Heitmueller */ 14880c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14890c0d06caSMauro Carvalho Chehab width /= 2; 14900c0d06caSMauro Carvalho Chehab } else { 1491f9fe90a4SMauro Carvalho Chehab /* 1492f9fe90a4SMauro Carvalho Chehab * width must even because of the YUYV format 1493f9fe90a4SMauro Carvalho Chehab * height must be even because of interlacing 1494f9fe90a4SMauro Carvalho Chehab */ 14950c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14960c0d06caSMauro Carvalho Chehab 1, 0); 14970c0d06caSMauro Carvalho Chehab } 14980962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 14990962a763SMauro Carvalho Chehab if (width < 1) 15000962a763SMauro Carvalho Chehab width = 1; 15010962a763SMauro Carvalho Chehab if (height < 1) 15020962a763SMauro Carvalho Chehab height = 1; 15030c0d06caSMauro Carvalho Chehab 15046b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 150546f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 15060c0d06caSMauro Carvalho Chehab 15070c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 15080c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 15090c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1510e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 15110c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 15120c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 151358159171SFrank Schaefer if (v4l2->progressive) 15140c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 15150c0d06caSMauro Carvalho Chehab else 151658159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 15170c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 151851dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 15190c0d06caSMauro Carvalho Chehab 15200c0d06caSMauro Carvalho Chehab return 0; 15210c0d06caSMauro Carvalho Chehab } 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 1524f9fe90a4SMauro Carvalho Chehab unsigned int width, unsigned int height) 15250c0d06caSMauro Carvalho Chehab { 15260c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1527753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 15300c0d06caSMauro Carvalho Chehab if (!fmt) 15310c0d06caSMauro Carvalho Chehab return -EINVAL; 15320c0d06caSMauro Carvalho Chehab 153306e20672SFrank Schaefer v4l2->format = fmt; 1534753aee77SFrank Schaefer v4l2->width = width; 1535753aee77SFrank Schaefer v4l2->height = height; 15360c0d06caSMauro Carvalho Chehab 15370c0d06caSMauro Carvalho Chehab /* set new image size */ 1538753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1539753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15400c0d06caSMauro Carvalho Chehab 15410c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15420c0d06caSMauro Carvalho Chehab 15430c0d06caSMauro Carvalho Chehab return 0; 15440c0d06caSMauro Carvalho Chehab } 15450c0d06caSMauro Carvalho Chehab 15460c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15470c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15480c0d06caSMauro Carvalho Chehab { 1549d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15508139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15510c0d06caSMauro Carvalho Chehab 1552c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1553d3829fadSDevin Heitmueller return -EBUSY; 15540c0d06caSMauro Carvalho Chehab 15550c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15560c0d06caSMauro Carvalho Chehab 15570c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15580c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15590c0d06caSMauro Carvalho Chehab } 15600c0d06caSMauro Carvalho Chehab 15610c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15620c0d06caSMauro Carvalho Chehab { 1563917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15640c0d06caSMauro Carvalho Chehab 156552faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15660c0d06caSMauro Carvalho Chehab 15670c0d06caSMauro Carvalho Chehab return 0; 15680c0d06caSMauro Carvalho Chehab } 15690c0d06caSMauro Carvalho Chehab 15700c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15710c0d06caSMauro Carvalho Chehab { 1572917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15730c0d06caSMauro Carvalho Chehab 157495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15750c0d06caSMauro Carvalho Chehab 15760c0d06caSMauro Carvalho Chehab return 0; 15770c0d06caSMauro Carvalho Chehab } 15780c0d06caSMauro Carvalho Chehab 1579314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15800c0d06caSMauro Carvalho Chehab { 1581917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1582753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15830c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15840c0d06caSMauro Carvalho Chehab 158552faaf78SFrank Schaefer if (norm == v4l2->norm) 1586d8c95c08SHans Verkuil return 0; 15870c0d06caSMauro Carvalho Chehab 15888139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1589d8c95c08SHans Verkuil return -EBUSY; 1590d8c95c08SHans Verkuil 159152faaf78SFrank Schaefer v4l2->norm = norm; 15920c0d06caSMauro Carvalho Chehab 15930c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1594d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1595314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15960c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15970c0d06caSMauro Carvalho Chehab 15980c0d06caSMauro Carvalho Chehab /* set new image size */ 1599753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1600753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1601753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1602753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 16030c0d06caSMauro Carvalho Chehab 16040c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 16058774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 16060c0d06caSMauro Carvalho Chehab 16070c0d06caSMauro Carvalho Chehab return 0; 16080c0d06caSMauro Carvalho Chehab } 16090c0d06caSMauro Carvalho Chehab 16100c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 16110c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16120c0d06caSMauro Carvalho Chehab { 16134471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 0 }; 1614917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 161552faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16160c0d06caSMauro Carvalho Chehab int rc = 0; 16170c0d06caSMauro Carvalho Chehab 16184471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16194471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16204471109eSHans Verkuil return -EINVAL; 16214471109eSHans Verkuil 162286ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16234471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 1624aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 162552faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 16264471109eSHans Verkuil video, g_frame_interval, &ival); 16274471109eSHans Verkuil if (!rc) 16284471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16294471109eSHans Verkuil } else { 163052faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 16310c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 16324471109eSHans Verkuil } 16330c0d06caSMauro Carvalho Chehab 16340c0d06caSMauro Carvalho Chehab return rc; 16350c0d06caSMauro Carvalho Chehab } 16360c0d06caSMauro Carvalho Chehab 16370c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 16380c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16390c0d06caSMauro Carvalho Chehab { 1640917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16414471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 16424471109eSHans Verkuil 0, 16434471109eSHans Verkuil p->parm.capture.timeperframe 16444471109eSHans Verkuil }; 16454471109eSHans Verkuil int rc = 0; 16460c0d06caSMauro Carvalho Chehab 1647aa62980bSMauro Carvalho Chehab if (!dev->is_webcam) 16484471109eSHans Verkuil return -ENOTTY; 16494471109eSHans Verkuil 16504471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16514471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16524471109eSHans Verkuil return -EINVAL; 16534471109eSHans Verkuil 16544471109eSHans Verkuil memset(&p->parm, 0, sizeof(p->parm)); 165586ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16564471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 16574471109eSHans Verkuil rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0, 16584471109eSHans Verkuil video, s_frame_interval, &ival); 16594471109eSHans Verkuil if (!rc) 16604471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16614471109eSHans Verkuil return rc; 16620c0d06caSMauro Carvalho Chehab } 16630c0d06caSMauro Carvalho Chehab 16640c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16650c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16660c0d06caSMauro Carvalho Chehab { 1667917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16680c0d06caSMauro Carvalho Chehab unsigned int n; 1669258c4304SMauro Carvalho Chehab int j; 16700c0d06caSMauro Carvalho Chehab 16710c0d06caSMauro Carvalho Chehab n = i->index; 16720c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16730c0d06caSMauro Carvalho Chehab return -EINVAL; 1674f9fe90a4SMauro Carvalho Chehab if (!INPUT(n)->type) 16750c0d06caSMauro Carvalho Chehab return -EINVAL; 16760c0d06caSMauro Carvalho Chehab 16770c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16780c0d06caSMauro Carvalho Chehab 1679cc1e6315SMauro Carvalho Chehab strscpy(i->name, iname[INPUT(n)->type], sizeof(i->name)); 16800c0d06caSMauro Carvalho Chehab 1681f9fe90a4SMauro Carvalho Chehab if (INPUT(n)->type == EM28XX_VMUX_TELEVISION) 16820c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16830c0d06caSMauro Carvalho Chehab 1684d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1685d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1686aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1687d8c95c08SHans Verkuil i->capabilities = 0; 16880c0d06caSMauro Carvalho Chehab 1689258c4304SMauro Carvalho Chehab /* Dynamically generates an audioset bitmask */ 1690258c4304SMauro Carvalho Chehab i->audioset = 0; 1691258c4304SMauro Carvalho Chehab for (j = 0; j < MAX_EM28XX_INPUT; j++) 1692258c4304SMauro Carvalho Chehab if (dev->amux_map[j] != EM28XX_AMUX_UNUSED) 1693258c4304SMauro Carvalho Chehab i->audioset |= 1 << j; 1694258c4304SMauro Carvalho Chehab 16950c0d06caSMauro Carvalho Chehab return 0; 16960c0d06caSMauro Carvalho Chehab } 16970c0d06caSMauro Carvalho Chehab 16980c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16990c0d06caSMauro Carvalho Chehab { 1700917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17010c0d06caSMauro Carvalho Chehab 17020c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 17030c0d06caSMauro Carvalho Chehab 17040c0d06caSMauro Carvalho Chehab return 0; 17050c0d06caSMauro Carvalho Chehab } 17060c0d06caSMauro Carvalho Chehab 17070c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 17080c0d06caSMauro Carvalho Chehab { 1709917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17100c0d06caSMauro Carvalho Chehab 17110c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 17120c0d06caSMauro Carvalho Chehab return -EINVAL; 1713f9fe90a4SMauro Carvalho Chehab if (!INPUT(i)->type) 17140c0d06caSMauro Carvalho Chehab return -EINVAL; 17150c0d06caSMauro Carvalho Chehab 17160c0d06caSMauro Carvalho Chehab video_mux(dev, i); 17170c0d06caSMauro Carvalho Chehab return 0; 17180c0d06caSMauro Carvalho Chehab } 17190c0d06caSMauro Carvalho Chehab 1720258c4304SMauro Carvalho Chehab static int em28xx_fill_audio_input(struct em28xx *dev, 1721258c4304SMauro Carvalho Chehab const char *s, 1722258c4304SMauro Carvalho Chehab struct v4l2_audio *a, 1723258c4304SMauro Carvalho Chehab unsigned int index) 17240c0d06caSMauro Carvalho Chehab { 1725258c4304SMauro Carvalho Chehab unsigned int idx = dev->amux_map[index]; 17260c0d06caSMauro Carvalho Chehab 1727258c4304SMauro Carvalho Chehab /* 1728258c4304SMauro Carvalho Chehab * With msp3400, almost all mappings use the default (amux = 0). 1729258c4304SMauro Carvalho Chehab * The only one may use a different value is WinTV USB2, where it 1730258c4304SMauro Carvalho Chehab * can also be SCART1 input. 1731258c4304SMauro Carvalho Chehab * As it is very doubtful that we would see new boards with msp3400, 1732258c4304SMauro Carvalho Chehab * let's just reuse the existing switch. 1733258c4304SMauro Carvalho Chehab */ 1734258c4304SMauro Carvalho Chehab if (dev->has_msp34xx && idx != EM28XX_AMUX_UNUSED) 1735258c4304SMauro Carvalho Chehab idx = EM28XX_AMUX_LINE_IN; 1736258c4304SMauro Carvalho Chehab 1737258c4304SMauro Carvalho Chehab switch (idx) { 17380c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 1739cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television", sizeof(a->name)); 17400c0d06caSMauro Carvalho Chehab break; 17410c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 1742cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Line In", sizeof(a->name)); 17430c0d06caSMauro Carvalho Chehab break; 17440c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 1745cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television alt", sizeof(a->name)); 17460c0d06caSMauro Carvalho Chehab break; 17470c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 1748cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Phone", sizeof(a->name)); 17490c0d06caSMauro Carvalho Chehab break; 17500c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 1751cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Mic", sizeof(a->name)); 17520c0d06caSMauro Carvalho Chehab break; 17530c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 1754cc1e6315SMauro Carvalho Chehab strscpy(a->name, "CD", sizeof(a->name)); 17550c0d06caSMauro Carvalho Chehab break; 17560c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 1757cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Aux", sizeof(a->name)); 17580c0d06caSMauro Carvalho Chehab break; 17590c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 1760cc1e6315SMauro Carvalho Chehab strscpy(a->name, "PCM", sizeof(a->name)); 17610c0d06caSMauro Carvalho Chehab break; 1762258c4304SMauro Carvalho Chehab case EM28XX_AMUX_UNUSED: 17630c0d06caSMauro Carvalho Chehab default: 17640c0d06caSMauro Carvalho Chehab return -EINVAL; 17650c0d06caSMauro Carvalho Chehab } 1766258c4304SMauro Carvalho Chehab a->index = index; 17670c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 17680c0d06caSMauro Carvalho Chehab 1769258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: audio input index %d is '%s'\n", 1770258c4304SMauro Carvalho Chehab s, a->index, a->name); 1771258c4304SMauro Carvalho Chehab 17720c0d06caSMauro Carvalho Chehab return 0; 17730c0d06caSMauro Carvalho Chehab } 17740c0d06caSMauro Carvalho Chehab 1775258c4304SMauro Carvalho Chehab static int vidioc_enumaudio(struct file *file, void *fh, struct v4l2_audio *a) 1776258c4304SMauro Carvalho Chehab { 1777258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file); 1778258c4304SMauro Carvalho Chehab 1779258c4304SMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 1780258c4304SMauro Carvalho Chehab return -EINVAL; 1781258c4304SMauro Carvalho Chehab 1782258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, a->index); 1783258c4304SMauro Carvalho Chehab } 1784258c4304SMauro Carvalho Chehab 1785258c4304SMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 1786258c4304SMauro Carvalho Chehab { 1787258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file); 1788258c4304SMauro Carvalho Chehab int i; 1789258c4304SMauro Carvalho Chehab 1790258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) 1791258c4304SMauro Carvalho Chehab if (dev->ctl_ainput == dev->amux_map[i]) 1792258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, i); 1793258c4304SMauro Carvalho Chehab 1794258c4304SMauro Carvalho Chehab /* Should never happen! */ 1795258c4304SMauro Carvalho Chehab return -EINVAL; 1796258c4304SMauro Carvalho Chehab } 1797258c4304SMauro Carvalho Chehab 1798f9fe90a4SMauro Carvalho Chehab static int vidioc_s_audio(struct file *file, void *priv, 1799f9fe90a4SMauro Carvalho Chehab const struct v4l2_audio *a) 18000c0d06caSMauro Carvalho Chehab { 1801917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1802258c4304SMauro Carvalho Chehab int idx, i; 18030c0d06caSMauro Carvalho Chehab 18040c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 18050c0d06caSMauro Carvalho Chehab return -EINVAL; 1806258c4304SMauro Carvalho Chehab 1807258c4304SMauro Carvalho Chehab idx = dev->amux_map[a->index]; 1808258c4304SMauro Carvalho Chehab 1809258c4304SMauro Carvalho Chehab if (idx == EM28XX_AMUX_UNUSED) 18100c0d06caSMauro Carvalho Chehab return -EINVAL; 18110c0d06caSMauro Carvalho Chehab 1812258c4304SMauro Carvalho Chehab dev->ctl_ainput = idx; 1813258c4304SMauro Carvalho Chehab 1814258c4304SMauro Carvalho Chehab /* 1815258c4304SMauro Carvalho Chehab * FIXME: This is wrong, as different inputs at em28xx_cards 1816258c4304SMauro Carvalho Chehab * may have different audio outputs. So, the right thing 1817258c4304SMauro Carvalho Chehab * to do is to implement VIDIOC_G_AUDOUT/VIDIOC_S_AUDOUT. 1818258c4304SMauro Carvalho Chehab * With the current board definitions, this would work fine, 1819258c4304SMauro Carvalho Chehab * as, currently, all boards fit. 1820258c4304SMauro Carvalho Chehab */ 1821258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) 1822258c4304SMauro Carvalho Chehab if (idx == dev->amux_map[i]) 1823258c4304SMauro Carvalho Chehab break; 1824258c4304SMauro Carvalho Chehab if (i == MAX_EM28XX_INPUT) 1825258c4304SMauro Carvalho Chehab return -EINVAL; 1826258c4304SMauro Carvalho Chehab 1827258c4304SMauro Carvalho Chehab dev->ctl_aoutput = INPUT(i)->aout; 18280c0d06caSMauro Carvalho Chehab 18290c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 18300c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 18310c0d06caSMauro Carvalho Chehab 1832258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: set audio input to %d\n", __func__, 1833258c4304SMauro Carvalho Chehab dev->ctl_ainput); 1834258c4304SMauro Carvalho Chehab 18350c0d06caSMauro Carvalho Chehab return 0; 18360c0d06caSMauro Carvalho Chehab } 18370c0d06caSMauro Carvalho Chehab 18380c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 18390c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18400c0d06caSMauro Carvalho Chehab { 1841917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18420c0d06caSMauro Carvalho Chehab 1843f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 18440c0d06caSMauro Carvalho Chehab return -EINVAL; 18450c0d06caSMauro Carvalho Chehab 1846cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Tuner", sizeof(t->name)); 18470c0d06caSMauro Carvalho Chehab 184895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18490c0d06caSMauro Carvalho Chehab return 0; 18500c0d06caSMauro Carvalho Chehab } 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 18532f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18540c0d06caSMauro Carvalho Chehab { 1855917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18560c0d06caSMauro Carvalho Chehab 1857f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 18580c0d06caSMauro Carvalho Chehab return -EINVAL; 18590c0d06caSMauro Carvalho Chehab 186095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18610c0d06caSMauro Carvalho Chehab return 0; 18620c0d06caSMauro Carvalho Chehab } 18630c0d06caSMauro Carvalho Chehab 18640c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 18650c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 18660c0d06caSMauro Carvalho Chehab { 1867917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18683854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18690c0d06caSMauro Carvalho Chehab 1870f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 187120deebfeSHans Verkuil return -EINVAL; 187220deebfeSHans Verkuil 18733854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 18740c0d06caSMauro Carvalho Chehab return 0; 18750c0d06caSMauro Carvalho Chehab } 18760c0d06caSMauro Carvalho Chehab 18770c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1878b530a447SHans Verkuil const struct v4l2_frequency *f) 18790c0d06caSMauro Carvalho Chehab { 1880b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1881917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 188295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18830c0d06caSMauro Carvalho Chehab 1884f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 18850c0d06caSMauro Carvalho Chehab return -EINVAL; 18860c0d06caSMauro Carvalho Chehab 188795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 188895d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 18893854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 18900c0d06caSMauro Carvalho Chehab 18910c0d06caSMauro Carvalho Chehab return 0; 18920c0d06caSMauro Carvalho Chehab } 18930c0d06caSMauro Carvalho Chehab 1894cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 189596b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 189696b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 18973b2d17b4SHans Verkuil { 1898917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18993b2d17b4SHans Verkuil 19003b2d17b4SHans Verkuil if (chip->match.addr > 1) 19013b2d17b4SHans Verkuil return -EINVAL; 19023b2d17b4SHans Verkuil if (chip->match.addr == 1) 1903c0decac1SMauro Carvalho Chehab strscpy(chip->name, "ac97", sizeof(chip->name)); 19043b2d17b4SHans Verkuil else 1905c0decac1SMauro Carvalho Chehab strscpy(chip->name, 190695d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 19073b2d17b4SHans Verkuil return 0; 19083b2d17b4SHans Verkuil } 19093b2d17b4SHans Verkuil 191035deba32SFrank Schaefer static int em28xx_reg_len(int reg) 191135deba32SFrank Schaefer { 191235deba32SFrank Schaefer switch (reg) { 191335deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 191435deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 191535deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 191635deba32SFrank Schaefer return 2; 191735deba32SFrank Schaefer default: 191835deba32SFrank Schaefer return 1; 191935deba32SFrank Schaefer } 192035deba32SFrank Schaefer } 19210c0d06caSMauro Carvalho Chehab 19220c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 19230c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 19240c0d06caSMauro Carvalho Chehab { 1925917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19260c0d06caSMauro Carvalho Chehab int ret; 19270c0d06caSMauro Carvalho Chehab 19283b2d17b4SHans Verkuil if (reg->match.addr > 1) 19293b2d17b4SHans Verkuil return -EINVAL; 1930abca2056SHans Verkuil if (reg->match.addr) { 19310c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 19320c0d06caSMauro Carvalho Chehab if (ret < 0) 19330c0d06caSMauro Carvalho Chehab return ret; 19340c0d06caSMauro Carvalho Chehab 19350c0d06caSMauro Carvalho Chehab reg->val = ret; 19360c0d06caSMauro Carvalho Chehab reg->size = 1; 19370c0d06caSMauro Carvalho Chehab return 0; 19380c0d06caSMauro Carvalho Chehab } 19390c0d06caSMauro Carvalho Chehab 19400c0d06caSMauro Carvalho Chehab /* Match host */ 19410c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 19420c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 19430c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 19440c0d06caSMauro Carvalho Chehab 19450c0d06caSMauro Carvalho Chehab if (ret < 0) 19460c0d06caSMauro Carvalho Chehab return ret; 19470c0d06caSMauro Carvalho Chehab 19480c0d06caSMauro Carvalho Chehab reg->val = ret; 19490c0d06caSMauro Carvalho Chehab } else { 19500c0d06caSMauro Carvalho Chehab __le16 val = 0; 1951fdf1bc9fSMauro Carvalho Chehab 195201c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 19530c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 19540c0d06caSMauro Carvalho Chehab if (ret < 0) 19550c0d06caSMauro Carvalho Chehab return ret; 19560c0d06caSMauro Carvalho Chehab 19570c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 19580c0d06caSMauro Carvalho Chehab } 19590c0d06caSMauro Carvalho Chehab 19600c0d06caSMauro Carvalho Chehab return 0; 19610c0d06caSMauro Carvalho Chehab } 19620c0d06caSMauro Carvalho Chehab 19630c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1964977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 19650c0d06caSMauro Carvalho Chehab { 1966917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19670c0d06caSMauro Carvalho Chehab __le16 buf; 19680c0d06caSMauro Carvalho Chehab 19693b2d17b4SHans Verkuil if (reg->match.addr > 1) 19703b2d17b4SHans Verkuil return -EINVAL; 1971abca2056SHans Verkuil if (reg->match.addr) 19720c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab /* Match host */ 19750c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 19760c0d06caSMauro Carvalho Chehab 19770c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 19780c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 19790c0d06caSMauro Carvalho Chehab } 19800c0d06caSMauro Carvalho Chehab #endif 19810c0d06caSMauro Carvalho Chehab 19820c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 19830c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 19840c0d06caSMauro Carvalho Chehab { 1985a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1986917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1987ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1988c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 19890c0d06caSMauro Carvalho Chehab 1990c0decac1SMauro Carvalho Chehab strscpy(cap->driver, "em28xx", sizeof(cap->driver)); 1991c0decac1SMauro Carvalho Chehab strscpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1992c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 19930c0d06caSMauro Carvalho Chehab 1994a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1995a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1996a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1997a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1998a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1999a9d79fe5SHans Verkuil else 20001d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 20010c0d06caSMauro Carvalho Chehab 2002920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 2003a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 20040c0d06caSMauro Carvalho Chehab 20050c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 2006a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 20070c0d06caSMauro Carvalho Chehab 2008f9fe90a4SMauro Carvalho Chehab cap->capabilities = cap->device_caps | 2009f9fe90a4SMauro Carvalho Chehab V4L2_CAP_DEVICE_CAPS | V4L2_CAP_READWRITE | 2010f9fe90a4SMauro Carvalho Chehab V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 2011d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 20121d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 2013d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 2014a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 20150c0d06caSMauro Carvalho Chehab return 0; 20160c0d06caSMauro Carvalho Chehab } 20170c0d06caSMauro Carvalho Chehab 20180c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 20190c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 20200c0d06caSMauro Carvalho Chehab { 20210c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 20220c0d06caSMauro Carvalho Chehab return -EINVAL; 20230c0d06caSMauro Carvalho Chehab 2024c0decac1SMauro Carvalho Chehab strscpy(f->description, format[f->index].name, sizeof(f->description)); 20250c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 20260c0d06caSMauro Carvalho Chehab 20270c0d06caSMauro Carvalho Chehab return 0; 20280c0d06caSMauro Carvalho Chehab } 20290c0d06caSMauro Carvalho Chehab 20300c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 20310c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 20320c0d06caSMauro Carvalho Chehab { 2033917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20340c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 20350c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 20360c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 20370c0d06caSMauro Carvalho Chehab 20380c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 20390c0d06caSMauro Carvalho Chehab if (!fmt) { 20400c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 20410c0d06caSMauro Carvalho Chehab fsize->pixel_format); 20420c0d06caSMauro Carvalho Chehab return -EINVAL; 20430c0d06caSMauro Carvalho Chehab } 20440c0d06caSMauro Carvalho Chehab 20450c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 20460c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 20470c0d06caSMauro Carvalho Chehab return -EINVAL; 20480c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 20490c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 20500c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 20510c0d06caSMauro Carvalho Chehab return 0; 20520c0d06caSMauro Carvalho Chehab } 20530c0d06caSMauro Carvalho Chehab 20540c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 20550c0d06caSMauro Carvalho Chehab return -EINVAL; 20560c0d06caSMauro Carvalho Chehab 20570c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 20580c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 20596c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 20606c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 20616c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 20620c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 20636c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 20646c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 20650c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 20660c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 20670c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 20680c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 20690c0d06caSMauro Carvalho Chehab return 0; 20700c0d06caSMauro Carvalho Chehab } 20710c0d06caSMauro Carvalho Chehab 20720c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 20730c0d06caSMauro Carvalho Chehab 20740c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 20750c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 20760c0d06caSMauro Carvalho Chehab { 2077917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 2078753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20790c0d06caSMauro Carvalho Chehab 2080753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 20810c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 20820c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 20830c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 20840c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 2085753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 2086753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 20872a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 20880c0d06caSMauro Carvalho Chehab 20890c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 209052faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 20910c0d06caSMauro Carvalho Chehab /* NTSC */ 20920c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 20930c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 209452faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 20950c0d06caSMauro Carvalho Chehab /* PAL */ 20960c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 20970c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 20980c0d06caSMauro Carvalho Chehab } 20990c0d06caSMauro Carvalho Chehab 21000c0d06caSMauro Carvalho Chehab return 0; 21010c0d06caSMauro Carvalho Chehab } 21020c0d06caSMauro Carvalho Chehab 2103f9fe90a4SMauro Carvalho Chehab /* 2104f9fe90a4SMauro Carvalho Chehab * RADIO ESPECIFIC IOCTLS 2105f9fe90a4SMauro Carvalho Chehab */ 21060c0d06caSMauro Carvalho Chehab 21070c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 21080c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 21090c0d06caSMauro Carvalho Chehab { 2110917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 21110c0d06caSMauro Carvalho Chehab 21120c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 21130c0d06caSMauro Carvalho Chehab return -EINVAL; 21140c0d06caSMauro Carvalho Chehab 2115cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Radio", sizeof(t->name)); 21160c0d06caSMauro Carvalho Chehab 211795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 21180c0d06caSMauro Carvalho Chehab 21190c0d06caSMauro Carvalho Chehab return 0; 21200c0d06caSMauro Carvalho Chehab } 21210c0d06caSMauro Carvalho Chehab 21220c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 21232f73c7c5SHans Verkuil const struct v4l2_tuner *t) 21240c0d06caSMauro Carvalho Chehab { 2125917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 21260c0d06caSMauro Carvalho Chehab 2127f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 21280c0d06caSMauro Carvalho Chehab return -EINVAL; 21290c0d06caSMauro Carvalho Chehab 213095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 21310c0d06caSMauro Carvalho Chehab 21320c0d06caSMauro Carvalho Chehab return 0; 21330c0d06caSMauro Carvalho Chehab } 21340c0d06caSMauro Carvalho Chehab 21350c0d06caSMauro Carvalho Chehab /* 213695d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 213795d2608bSFrank Schaefer * 213895d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 213995d2608bSFrank Schaefer * 214095d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 214195d2608bSFrank Schaefer */ 2142f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 214395d2608bSFrank Schaefer { 214495d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 214595d2608bSFrank Schaefer 2146abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 214795d2608bSFrank Schaefer kfree(v4l2); 214895d2608bSFrank Schaefer } 214995d2608bSFrank Schaefer 215095d2608bSFrank Schaefer /* 21510c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 21520c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 21530c0d06caSMauro Carvalho Chehab */ 21540c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 21550c0d06caSMauro Carvalho Chehab { 21560c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 21570c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 215895d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 21590c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 21603c0f90e1SFrank Schaefer int ret; 21610c0d06caSMauro Carvalho Chehab 21620c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 21630c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 21640c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 21650c0d06caSMauro Carvalho Chehab break; 21660c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 21670c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 21680c0d06caSMauro Carvalho Chehab break; 21694e170240SFrank Schaefer case VFL_TYPE_RADIO: 21704e170240SFrank Schaefer break; 21714e170240SFrank Schaefer default: 21724e170240SFrank Schaefer return -EINVAL; 21730c0d06caSMauro Carvalho Chehab } 21740c0d06caSMauro Carvalho Chehab 21758e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 21768e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 21778e2c8717SFrank Schaefer v4l2->users); 21780c0d06caSMauro Carvalho Chehab 21790c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21800c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21813c0f90e1SFrank Schaefer 21823c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 21833c0f90e1SFrank Schaefer if (ret) { 218429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2185ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 21863c0f90e1SFrank Schaefer __func__, ret); 21870c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21883c0f90e1SFrank Schaefer return ret; 21890c0d06caSMauro Carvalho Chehab } 21900c0d06caSMauro Carvalho Chehab 21918e2c8717SFrank Schaefer if (v4l2->users == 0) { 21920c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 21934e170240SFrank Schaefer 21944e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 21950c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 21960c0d06caSMauro Carvalho Chehab 21974e170240SFrank Schaefer /* 21984e170240SFrank Schaefer * Needed, since GPIO might have disabled power 21994e170240SFrank Schaefer * of some i2c devices 22000c0d06caSMauro Carvalho Chehab */ 22010c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 22020c0d06caSMauro Carvalho Chehab } 2203d3829fadSDevin Heitmueller 2204d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 22050c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 220695d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 22070c0d06caSMauro Carvalho Chehab } 22080c0d06caSMauro Carvalho Chehab 220947677e51SMauro Carvalho Chehab kref_get(&dev->ref); 221095d2608bSFrank Schaefer kref_get(&v4l2->ref); 22118e2c8717SFrank Schaefer v4l2->users++; 22120c0d06caSMauro Carvalho Chehab 22130c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 22140c0d06caSMauro Carvalho Chehab 2215d3829fadSDevin Heitmueller return 0; 22160c0d06caSMauro Carvalho Chehab } 22170c0d06caSMauro Carvalho Chehab 22180c0d06caSMauro Carvalho Chehab /* 221901c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 22200c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 22210c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 22220c0d06caSMauro Carvalho Chehab */ 222301c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 22240c0d06caSMauro Carvalho Chehab { 222595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 222695d2608bSFrank Schaefer 2227822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2228822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2229822b8deaSMauro Carvalho Chehab return 0; 2230822b8deaSMauro Carvalho Chehab } 2231822b8deaSMauro Carvalho Chehab 223201c28193SMauro Carvalho Chehab if (!dev->has_video) { 223301c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 223401c28193SMauro Carvalho Chehab return 0; 223501c28193SMauro Carvalho Chehab } 22360c0d06caSMauro Carvalho Chehab 2237f9fe90a4SMauro Carvalho Chehab if (!v4l2) 223895d2608bSFrank Schaefer return 0; 223995d2608bSFrank Schaefer 224029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2241aa929ad7SMauro Carvalho Chehab 2242ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2243ebbfbc20SMauro Carvalho Chehab 224495d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 22455ad10de6SFrank Schaefer 224623e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 224723e8642cSFrank Schaefer 224837ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 224937ecc7b1SMauro Carvalho Chehab 2250d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 225129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2252d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2253d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 22540c0d06caSMauro Carvalho Chehab } 2255d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 225629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2257d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2258d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 22590c0d06caSMauro Carvalho Chehab } 2260d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 226129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2262d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2263d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 22640c0d06caSMauro Carvalho Chehab } 226501c28193SMauro Carvalho Chehab 2266abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 226795d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2268103f18a2SFrank Schaefer 226995d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 227095d2608bSFrank Schaefer 2271ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 227295d2608bSFrank Schaefer 227347677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 22745ad10de6SFrank Schaefer 227501c28193SMauro Carvalho Chehab return 0; 22760c0d06caSMauro Carvalho Chehab } 22770c0d06caSMauro Carvalho Chehab 2278a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2279a61f6811SShuah Khan { 2280a61f6811SShuah Khan if (dev->is_audio_only) 2281a61f6811SShuah Khan return 0; 2282a61f6811SShuah Khan 2283a61f6811SShuah Khan if (!dev->has_video) 2284a61f6811SShuah Khan return 0; 2285a61f6811SShuah Khan 228629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2287a61f6811SShuah Khan em28xx_stop_urbs(dev); 2288a61f6811SShuah Khan return 0; 2289a61f6811SShuah Khan } 2290a61f6811SShuah Khan 2291a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2292a61f6811SShuah Khan { 2293a61f6811SShuah Khan if (dev->is_audio_only) 2294a61f6811SShuah Khan return 0; 2295a61f6811SShuah Khan 2296a61f6811SShuah Khan if (!dev->has_video) 2297a61f6811SShuah Khan return 0; 2298a61f6811SShuah Khan 229929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2300a61f6811SShuah Khan /* what do we do here */ 2301a61f6811SShuah Khan return 0; 2302a61f6811SShuah Khan } 2303a61f6811SShuah Khan 23040c0d06caSMauro Carvalho Chehab /* 23050c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 23060c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 23070c0d06caSMauro Carvalho Chehab * calls and ioctls 23080c0d06caSMauro Carvalho Chehab */ 23090c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 23100c0d06caSMauro Carvalho Chehab { 2311917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 231295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2313c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 2314f9fe90a4SMauro Carvalho Chehab int err; 23150c0d06caSMauro Carvalho Chehab 23168e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 23178e2c8717SFrank Schaefer 23188e2c8717SFrank Schaefer vb2_fop_release(filp); 231998c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 23200c0d06caSMauro Carvalho Chehab 23218e2c8717SFrank Schaefer if (v4l2->users == 1) { 232247677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 232347677e51SMauro Carvalho Chehab if (dev->disconnected) 232401c28193SMauro Carvalho Chehab goto exit; 23250c0d06caSMauro Carvalho Chehab 23260c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 23273aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 23280c0d06caSMauro Carvalho Chehab 23290c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 23300c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 23310c0d06caSMauro Carvalho Chehab 23320c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 23330c0d06caSMauro Carvalho Chehab dev->alt = 0; 23340c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2335f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, 0, 0); 2336f9fe90a4SMauro Carvalho Chehab if (err < 0) { 233729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2338ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 2339f9fe90a4SMauro Carvalho Chehab err); 23400c0d06caSMauro Carvalho Chehab } 23410c0d06caSMauro Carvalho Chehab } 23420c0d06caSMauro Carvalho Chehab 234301c28193SMauro Carvalho Chehab exit: 23448e2c8717SFrank Schaefer v4l2->users--; 234595d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 23460c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 234747677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 234847677e51SMauro Carvalho Chehab 23490c0d06caSMauro Carvalho Chehab return 0; 23500c0d06caSMauro Carvalho Chehab } 23510c0d06caSMauro Carvalho Chehab 23520c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 23530c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23540c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23550c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2356d3829fadSDevin Heitmueller .read = vb2_fop_read, 2357d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2358d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 23590c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23600c0d06caSMauro Carvalho Chehab }; 23610c0d06caSMauro Carvalho Chehab 23620c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 23630c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 23640c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 23650c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 23660c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 23670c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 23680c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23692a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2370aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23710c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 2372258c4304SMauro Carvalho Chehab .vidioc_enumaudio = vidioc_enumaudio, 23730c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 23740c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 23750c0d06caSMauro Carvalho Chehab 2376d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2377d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2378d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2379d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2380d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2381d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2382d3829fadSDevin Heitmueller 23830c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 23840c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 23850c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 23860c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 23870c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 23880c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 23890c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 23900c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2391d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2392d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 23930c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 23940c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 23950c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23960c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 239750fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 239850fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23990c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 240096b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 24010c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24020c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24030c0d06caSMauro Carvalho Chehab #endif 24040c0d06caSMauro Carvalho Chehab }; 24050c0d06caSMauro Carvalho Chehab 24060c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 24070c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 24080c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2409d4352f36SHans Verkuil .release = video_device_release_empty, 24100c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 24110c0d06caSMauro Carvalho Chehab }; 24120c0d06caSMauro Carvalho Chehab 24130c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 24140c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 24150c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 24160c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 24170c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 24180c0d06caSMauro Carvalho Chehab }; 24190c0d06caSMauro Carvalho Chehab 24200c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2421a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 24220c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 24230c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 24240c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 24250c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 242650fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 242750fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 24280c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2429430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 24300c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24310c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24320c0d06caSMauro Carvalho Chehab #endif 24330c0d06caSMauro Carvalho Chehab }; 24340c0d06caSMauro Carvalho Chehab 24350c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 24360c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 24370c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2438d4352f36SHans Verkuil .release = video_device_release_empty, 24390c0d06caSMauro Carvalho Chehab }; 24400c0d06caSMauro Carvalho Chehab 2441b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2442b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2443b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2444b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2445b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2446b64f8e9aSMauro Carvalho Chehab 2447b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2448b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2449b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2450b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2451b64f8e9aSMauro Carvalho Chehab }; 2452b64f8e9aSMauro Carvalho Chehab 2453b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2454b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2455b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2456b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2457b64f8e9aSMauro Carvalho Chehab }; 2458b64f8e9aSMauro Carvalho Chehab 24590c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 24600c0d06caSMauro Carvalho Chehab 2461d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2462d4352f36SHans Verkuil struct video_device *vfd, 24630c0d06caSMauro Carvalho Chehab const struct video_device *template, 24640c0d06caSMauro Carvalho Chehab const char *type_name) 24650c0d06caSMauro Carvalho Chehab { 24660c0d06caSMauro Carvalho Chehab *vfd = *template; 246795d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 24680c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2469aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 2470d8c95c08SHans Verkuil vfd->tvnorms = 0; 24710c0d06caSMauro Carvalho Chehab 24720c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 247329b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 24740c0d06caSMauro Carvalho Chehab 24750c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 24760c0d06caSMauro Carvalho Chehab } 24770c0d06caSMauro Carvalho Chehab 24783319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 24790560f337SMauro Carvalho Chehab { 24803854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 24813854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 24820560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 24830560f337SMauro Carvalho Chehab struct v4l2_frequency f; 24840560f337SMauro Carvalho Chehab 24850560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 24860560f337SMauro Carvalho Chehab 24870560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 24880560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 24890560f337SMauro Carvalho Chehab 24900560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 24910560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 24920560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 24930560f337SMauro Carvalho Chehab 249495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 249595d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24960560f337SMauro Carvalho Chehab } 24970560f337SMauro Carvalho Chehab 2498f9fe90a4SMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT && dev->tuner_type) { 24990560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 25003319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 25010560f337SMauro Carvalho Chehab 250295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 250395d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 25040560f337SMauro Carvalho Chehab } 25050560f337SMauro Carvalho Chehab 25066867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 25070560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 25080560f337SMauro Carvalho Chehab 25090560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 25106867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 25110560f337SMauro Carvalho Chehab 251295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 251395d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 25140560f337SMauro Carvalho Chehab } 25150560f337SMauro Carvalho Chehab 25160560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 25170560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 25180560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 25190560f337SMauro Carvalho Chehab 25200560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 25210560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 25220560f337SMauro Carvalho Chehab 25230560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 25240560f337SMauro Carvalho Chehab 25250560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 25260560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 25270560f337SMauro Carvalho Chehab 252895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 25290560f337SMauro Carvalho Chehab } 25300560f337SMauro Carvalho Chehab 25310560f337SMauro Carvalho Chehab /* configure tuner */ 25320560f337SMauro Carvalho Chehab f.tuner = 0; 25330560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 25340560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 25353854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 253695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 25370560f337SMauro Carvalho Chehab } 25380560f337SMauro Carvalho Chehab 253901c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 25400c0d06caSMauro Carvalho Chehab { 25410c0d06caSMauro Carvalho Chehab u8 val; 25420c0d06caSMauro Carvalho Chehab int ret; 25430c0d06caSMauro Carvalho Chehab unsigned int maxw; 2544abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 254595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2546b64f8e9aSMauro Carvalho Chehab 2547822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2548822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2549822b8deaSMauro Carvalho Chehab return 0; 2550822b8deaSMauro Carvalho Chehab } 2551822b8deaSMauro Carvalho Chehab 255201c28193SMauro Carvalho Chehab if (!dev->has_video) { 2553b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2554b64f8e9aSMauro Carvalho Chehab return 0; 2555b64f8e9aSMauro Carvalho Chehab } 25560c0d06caSMauro Carvalho Chehab 255729b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 25580c0d06caSMauro Carvalho Chehab 255901c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 256001c28193SMauro Carvalho Chehab 2561f9fe90a4SMauro Carvalho Chehab v4l2 = kzalloc(sizeof(*v4l2), GFP_KERNEL); 25628314d402SMauro Carvalho Chehab if (!v4l2) { 256395d2608bSFrank Schaefer mutex_unlock(&dev->lock); 256495d2608bSFrank Schaefer return -ENOMEM; 256595d2608bSFrank Schaefer } 256695d2608bSFrank Schaefer kref_init(&v4l2->ref); 2567abc1308fSFrank Schaefer v4l2->dev = dev; 256895d2608bSFrank Schaefer dev->v4l2 = v4l2; 256995d2608bSFrank Schaefer 257037ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 257137ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 257237ecc7b1SMauro Carvalho Chehab #endif 257329b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2574b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 257529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2576ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2577b64f8e9aSMauro Carvalho Chehab goto err; 2578b64f8e9aSMauro Carvalho Chehab } 2579b64f8e9aSMauro Carvalho Chehab 2580abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2581b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 258295d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2583b64f8e9aSMauro Carvalho Chehab 2584aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 25857e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 258658159171SFrank Schaefer 2587b64f8e9aSMauro Carvalho Chehab /* 2588b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2589b64f8e9aSMauro Carvalho Chehab */ 2590a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY; 25919297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2592b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2593b64f8e9aSMauro Carvalho Chehab 2594b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2595b64f8e9aSMauro Carvalho Chehab 2596aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) 259795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 259895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2599b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2600b64f8e9aSMauro Carvalho Chehab 2601b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 260295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 260395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2604b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2605b64f8e9aSMauro Carvalho Chehab 2606b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 260795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 260895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2609b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2610b64f8e9aSMauro Carvalho Chehab 2611b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 261295d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 261395d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2614b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2615b64f8e9aSMauro Carvalho Chehab 2616b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2617b64f8e9aSMauro Carvalho Chehab 2618b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 26193319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 26206867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2621b64f8e9aSMauro Carvalho Chehab 2622b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 262395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 262495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2625fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2626fdf1bc9fSMauro Carvalho Chehab NULL); 2627b64f8e9aSMauro Carvalho Chehab 2628b64f8e9aSMauro Carvalho Chehab if (has_demod) 262995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2630fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2631fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2632fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 26333319e6f8SFrank Schaefer if (tuner_addr == 0) { 2634b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2635b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2636b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2637b64f8e9aSMauro Carvalho Chehab 263895d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2639fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2640fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2641fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2642b64f8e9aSMauro Carvalho Chehab 2643b64f8e9aSMauro Carvalho Chehab if (sd) 26443319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2645b64f8e9aSMauro Carvalho Chehab } else { 264695d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 264795d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 26483319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2649b64f8e9aSMauro Carvalho Chehab } 2650b64f8e9aSMauro Carvalho Chehab 26513319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 26523319e6f8SFrank Schaefer } 26533319e6f8SFrank Schaefer 2654d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2655b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2656b64f8e9aSMauro Carvalho Chehab 2657b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2658b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2659b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 266029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2661ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2662b64f8e9aSMauro Carvalho Chehab __func__, ret); 2663b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2664b64f8e9aSMauro Carvalho Chehab } 2665b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2666b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2667b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2668b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2669b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2670b64f8e9aSMauro Carvalho Chehab } else { 2671b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2672b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2673b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2674b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2675b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2676b64f8e9aSMauro Carvalho Chehab } 2677b64f8e9aSMauro Carvalho Chehab 2678b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2679b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2680b64f8e9aSMauro Carvalho Chehab 2681b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2682b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2683b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2684b64f8e9aSMauro Carvalho Chehab 2685aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 2686b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2687b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2688b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 268929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2690ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2691b64f8e9aSMauro Carvalho Chehab __func__, ret); 2692b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2693b64f8e9aSMauro Carvalho Chehab } 2694f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2695b64f8e9aSMauro Carvalho Chehab 2696b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2697b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 269829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2699ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2700b64f8e9aSMauro Carvalho Chehab __func__, ret); 2701b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2702b64f8e9aSMauro Carvalho Chehab } 2703f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2704b64f8e9aSMauro Carvalho Chehab } 2705b64f8e9aSMauro Carvalho Chehab 27060c0d06caSMauro Carvalho Chehab /* set default norm */ 270752faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 27088774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 270958159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 27100c0d06caSMauro Carvalho Chehab 27110c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 271206e20672SFrank Schaefer v4l2->format = &format[0]; 27130c0d06caSMauro Carvalho Chehab 27140c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 2715f9fe90a4SMauro Carvalho Chehab /* 2716f9fe90a4SMauro Carvalho Chehab * MaxPacketSize for em2800 is too small to capture at full resolution 2717f9fe90a4SMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% 2718f9fe90a4SMauro Carvalho Chehab */ 27190c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 27200c0d06caSMauro Carvalho Chehab maxw /= 2; 27210c0d06caSMauro Carvalho Chehab 27220c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 27230c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 27240c0d06caSMauro Carvalho Chehab 27250c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 27260c0d06caSMauro Carvalho Chehab 27270c0d06caSMauro Carvalho Chehab /* Audio defaults */ 27280c0d06caSMauro Carvalho Chehab dev->mute = 1; 27290c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 27300c0d06caSMauro Carvalho Chehab 27310c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 27320c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 27330c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 27340c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 27350c0d06caSMauro Carvalho Chehab 27360c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 27370c0d06caSMauro Carvalho Chehab 27388f8b113aSFrank Schaefer /* Add image controls */ 2739f9fe90a4SMauro Carvalho Chehab 2740f9fe90a4SMauro Carvalho Chehab /* 2741f9fe90a4SMauro Carvalho Chehab * NOTE: at this point, the subdevices are already registered, so 2742f9fe90a4SMauro Carvalho Chehab * bridge controls are only added/enabled when no subdevice provides 2743f9fe90a4SMauro Carvalho Chehab * them 2744f9fe90a4SMauro Carvalho Chehab */ 2745f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2746ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27478f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 27488f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2749f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2750ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27518f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 27528f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2753f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2754ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27558f8b113aSFrank Schaefer V4L2_CID_SATURATION, 27568f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2757f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2758ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27598f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 27608f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2761f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2762ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27638f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 27648f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2765f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2766ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27678f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 27688f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 27698f8b113aSFrank Schaefer 27708f8b113aSFrank Schaefer /* Reset image controls */ 27718f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2772ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2773ad298055SFrank Schaefer ret = hdl->error; 2774b64f8e9aSMauro Carvalho Chehab if (ret) 2775b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27768f8b113aSFrank Schaefer 27770c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2778d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 277927a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 278027a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2781d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2782d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 27830c0d06caSMauro Carvalho Chehab 27846e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 2785aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 2786d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2787d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2788d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 27893bc85cceSFrank Schaefer } else { 2790d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 27916e46dabaSFrank Schaefer } 279266df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2793d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2794d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2795d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2796d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 279766df67b7SFrank Schaefer } 2798920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2799d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2800d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2801c2dcef83SFrank Schaefer } 28026e46dabaSFrank Schaefer 28030c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2804d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 28050c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 28060c0d06caSMauro Carvalho Chehab if (ret) { 280729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2808ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2809b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28100c0d06caSMauro Carvalho Chehab } 28110c0d06caSMauro Carvalho Chehab 28120c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 28130c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2814d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 28150c0d06caSMauro Carvalho Chehab "vbi"); 28160c0d06caSMauro Carvalho Chehab 2817d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2818d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2819d3829fadSDevin Heitmueller 282066df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2821d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 282266df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2823d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2824d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2825d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2826d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 282766df67b7SFrank Schaefer } 2828920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2829d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2830d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2831c2dcef83SFrank Schaefer } 283266df67b7SFrank Schaefer 28330c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2834d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 28350c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 28360c0d06caSMauro Carvalho Chehab if (ret < 0) { 283729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2838ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2839b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28400c0d06caSMauro Carvalho Chehab } 28410c0d06caSMauro Carvalho Chehab } 28420c0d06caSMauro Carvalho Chehab 28430c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2844d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 28450c0d06caSMauro Carvalho Chehab "radio"); 2846d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 28470c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 28480c0d06caSMauro Carvalho Chehab if (ret < 0) { 284929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2850ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2851b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28520c0d06caSMauro Carvalho Chehab } 285329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2854ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2855d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 28560c0d06caSMauro Carvalho Chehab } 28570c0d06caSMauro Carvalho Chehab 285837ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 285937ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 286037ecc7b1SMauro Carvalho Chehab 28610d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2862de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 286337ecc7b1SMauro Carvalho Chehab if (ret) { 286429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2865ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 286637ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 286737ecc7b1SMauro Carvalho Chehab goto unregister_dev; 286837ecc7b1SMauro Carvalho Chehab } 28690d37ba62SArnd Bergmann #endif 287037ecc7b1SMauro Carvalho Chehab 287129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2872ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2873d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 28740c0d06caSMauro Carvalho Chehab 2875d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 287629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2877ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2878d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 28790c0d06caSMauro Carvalho Chehab 2880b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 28813aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 2882b64f8e9aSMauro Carvalho Chehab 2883b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2884b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2885b64f8e9aSMauro Carvalho Chehab 288629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2887ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 28889634614fSMauro Carvalho Chehab 288947677e51SMauro Carvalho Chehab kref_get(&dev->ref); 289047677e51SMauro Carvalho Chehab 289101c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 28920c0d06caSMauro Carvalho Chehab return 0; 2893b64f8e9aSMauro Carvalho Chehab 2894b64f8e9aSMauro Carvalho Chehab unregister_dev: 289556a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 289629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2897ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 289856a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 289956a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 290056a7f515SMauro Carvalho Chehab } 290156a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 290229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2903ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 290456a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 290556a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 290656a7f515SMauro Carvalho Chehab } 290756a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 290829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2909ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 291056a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 291156a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 291256a7f515SMauro Carvalho Chehab } 291356a7f515SMauro Carvalho Chehab 2914abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 291595d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2916b64f8e9aSMauro Carvalho Chehab err: 291795d2608bSFrank Schaefer dev->v4l2 = NULL; 291895d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 291901c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2920b64f8e9aSMauro Carvalho Chehab return ret; 29210c0d06caSMauro Carvalho Chehab } 292201c28193SMauro Carvalho Chehab 292301c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 292401c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 292501c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 292601c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 292701c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2928a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2929a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 293001c28193SMauro Carvalho Chehab }; 293101c28193SMauro Carvalho Chehab 293201c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 293301c28193SMauro Carvalho Chehab { 293401c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 293501c28193SMauro Carvalho Chehab } 293601c28193SMauro Carvalho Chehab 293701c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 293801c28193SMauro Carvalho Chehab { 293901c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 294001c28193SMauro Carvalho Chehab } 294101c28193SMauro Carvalho Chehab 294201c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 294301c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2944