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) { 14740c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14750c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 14760c0d06caSMauro Carvalho Chehab return -EINVAL; 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; 16690c0d06caSMauro Carvalho Chehab 16700c0d06caSMauro Carvalho Chehab n = i->index; 16710c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16720c0d06caSMauro Carvalho Chehab return -EINVAL; 1673f9fe90a4SMauro Carvalho Chehab if (!INPUT(n)->type) 16740c0d06caSMauro Carvalho Chehab return -EINVAL; 16750c0d06caSMauro Carvalho Chehab 16760c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16770c0d06caSMauro Carvalho Chehab 16780c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 16790c0d06caSMauro Carvalho Chehab 1680f9fe90a4SMauro Carvalho Chehab if (INPUT(n)->type == EM28XX_VMUX_TELEVISION) 16810c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16820c0d06caSMauro Carvalho Chehab 1683d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1684d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1685aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1686d8c95c08SHans Verkuil i->capabilities = 0; 16870c0d06caSMauro Carvalho Chehab 16880c0d06caSMauro Carvalho Chehab return 0; 16890c0d06caSMauro Carvalho Chehab } 16900c0d06caSMauro Carvalho Chehab 16910c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16920c0d06caSMauro Carvalho Chehab { 1693917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16940c0d06caSMauro Carvalho Chehab 16950c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 16960c0d06caSMauro Carvalho Chehab 16970c0d06caSMauro Carvalho Chehab return 0; 16980c0d06caSMauro Carvalho Chehab } 16990c0d06caSMauro Carvalho Chehab 17000c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 17010c0d06caSMauro Carvalho Chehab { 1702917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17030c0d06caSMauro Carvalho Chehab 17040c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 17050c0d06caSMauro Carvalho Chehab return -EINVAL; 1706f9fe90a4SMauro Carvalho Chehab if (!INPUT(i)->type) 17070c0d06caSMauro Carvalho Chehab return -EINVAL; 17080c0d06caSMauro Carvalho Chehab 17090c0d06caSMauro Carvalho Chehab video_mux(dev, i); 17100c0d06caSMauro Carvalho Chehab return 0; 17110c0d06caSMauro Carvalho Chehab } 17120c0d06caSMauro Carvalho Chehab 17130c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 17140c0d06caSMauro Carvalho Chehab { 1715917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17160c0d06caSMauro Carvalho Chehab 17170c0d06caSMauro Carvalho Chehab switch (a->index) { 17180c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 17190c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 17200c0d06caSMauro Carvalho Chehab break; 17210c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 17220c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 17230c0d06caSMauro Carvalho Chehab break; 17240c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 17250c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 17260c0d06caSMauro Carvalho Chehab break; 17270c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 17280c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 17290c0d06caSMauro Carvalho Chehab break; 17300c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 17310c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 17320c0d06caSMauro Carvalho Chehab break; 17330c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 17340c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 17350c0d06caSMauro Carvalho Chehab break; 17360c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 17370c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 17380c0d06caSMauro Carvalho Chehab break; 17390c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 17400c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 17410c0d06caSMauro Carvalho Chehab break; 17420c0d06caSMauro Carvalho Chehab default: 17430c0d06caSMauro Carvalho Chehab return -EINVAL; 17440c0d06caSMauro Carvalho Chehab } 17450c0d06caSMauro Carvalho Chehab 17460c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 17470c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 17480c0d06caSMauro Carvalho Chehab 17490c0d06caSMauro Carvalho Chehab return 0; 17500c0d06caSMauro Carvalho Chehab } 17510c0d06caSMauro Carvalho Chehab 1752f9fe90a4SMauro Carvalho Chehab static int vidioc_s_audio(struct file *file, void *priv, 1753f9fe90a4SMauro Carvalho Chehab const struct v4l2_audio *a) 17540c0d06caSMauro Carvalho Chehab { 1755917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17560c0d06caSMauro Carvalho Chehab 17570c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 17580c0d06caSMauro Carvalho Chehab return -EINVAL; 1759f9fe90a4SMauro Carvalho Chehab if (!INPUT(a->index)->type) 17600c0d06caSMauro Carvalho Chehab return -EINVAL; 17610c0d06caSMauro Carvalho Chehab 17620c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 17630c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 17640c0d06caSMauro Carvalho Chehab 17650c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 17660c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 17670c0d06caSMauro Carvalho Chehab 17680c0d06caSMauro Carvalho Chehab return 0; 17690c0d06caSMauro Carvalho Chehab } 17700c0d06caSMauro Carvalho Chehab 17710c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 17720c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17730c0d06caSMauro Carvalho Chehab { 1774917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17750c0d06caSMauro Carvalho Chehab 1776f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 17770c0d06caSMauro Carvalho Chehab return -EINVAL; 17780c0d06caSMauro Carvalho Chehab 17790c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 17800c0d06caSMauro Carvalho Chehab 178195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 17820c0d06caSMauro Carvalho Chehab return 0; 17830c0d06caSMauro Carvalho Chehab } 17840c0d06caSMauro Carvalho Chehab 17850c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 17862f73c7c5SHans Verkuil const struct v4l2_tuner *t) 17870c0d06caSMauro Carvalho Chehab { 1788917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17890c0d06caSMauro Carvalho Chehab 1790f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 17910c0d06caSMauro Carvalho Chehab return -EINVAL; 17920c0d06caSMauro Carvalho Chehab 179395d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 17940c0d06caSMauro Carvalho Chehab return 0; 17950c0d06caSMauro Carvalho Chehab } 17960c0d06caSMauro Carvalho Chehab 17970c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 17980c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 17990c0d06caSMauro Carvalho Chehab { 1800917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18013854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18020c0d06caSMauro Carvalho Chehab 1803f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 180420deebfeSHans Verkuil return -EINVAL; 180520deebfeSHans Verkuil 18063854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 18070c0d06caSMauro Carvalho Chehab return 0; 18080c0d06caSMauro Carvalho Chehab } 18090c0d06caSMauro Carvalho Chehab 18100c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1811b530a447SHans Verkuil const struct v4l2_frequency *f) 18120c0d06caSMauro Carvalho Chehab { 1813b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1814917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 181595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18160c0d06caSMauro Carvalho Chehab 1817f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 18180c0d06caSMauro Carvalho Chehab return -EINVAL; 18190c0d06caSMauro Carvalho Chehab 182095d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 182195d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 18223854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 18230c0d06caSMauro Carvalho Chehab 18240c0d06caSMauro Carvalho Chehab return 0; 18250c0d06caSMauro Carvalho Chehab } 18260c0d06caSMauro Carvalho Chehab 1827cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 182896b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 182996b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 18303b2d17b4SHans Verkuil { 1831917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18323b2d17b4SHans Verkuil 18333b2d17b4SHans Verkuil if (chip->match.addr > 1) 18343b2d17b4SHans Verkuil return -EINVAL; 18353b2d17b4SHans Verkuil if (chip->match.addr == 1) 18363b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 18373b2d17b4SHans Verkuil else 183895d2608bSFrank Schaefer strlcpy(chip->name, 183995d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 18403b2d17b4SHans Verkuil return 0; 18413b2d17b4SHans Verkuil } 18423b2d17b4SHans Verkuil 184335deba32SFrank Schaefer static int em28xx_reg_len(int reg) 184435deba32SFrank Schaefer { 184535deba32SFrank Schaefer switch (reg) { 184635deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 184735deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 184835deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 184935deba32SFrank Schaefer return 2; 185035deba32SFrank Schaefer default: 185135deba32SFrank Schaefer return 1; 185235deba32SFrank Schaefer } 185335deba32SFrank Schaefer } 18540c0d06caSMauro Carvalho Chehab 18550c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 18560c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 18570c0d06caSMauro Carvalho Chehab { 1858917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18590c0d06caSMauro Carvalho Chehab int ret; 18600c0d06caSMauro Carvalho Chehab 18613b2d17b4SHans Verkuil if (reg->match.addr > 1) 18623b2d17b4SHans Verkuil return -EINVAL; 1863abca2056SHans Verkuil if (reg->match.addr) { 18640c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 18650c0d06caSMauro Carvalho Chehab if (ret < 0) 18660c0d06caSMauro Carvalho Chehab return ret; 18670c0d06caSMauro Carvalho Chehab 18680c0d06caSMauro Carvalho Chehab reg->val = ret; 18690c0d06caSMauro Carvalho Chehab reg->size = 1; 18700c0d06caSMauro Carvalho Chehab return 0; 18710c0d06caSMauro Carvalho Chehab } 18720c0d06caSMauro Carvalho Chehab 18730c0d06caSMauro Carvalho Chehab /* Match host */ 18740c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 18750c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 18760c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 18770c0d06caSMauro Carvalho Chehab 18780c0d06caSMauro Carvalho Chehab if (ret < 0) 18790c0d06caSMauro Carvalho Chehab return ret; 18800c0d06caSMauro Carvalho Chehab 18810c0d06caSMauro Carvalho Chehab reg->val = ret; 18820c0d06caSMauro Carvalho Chehab } else { 18830c0d06caSMauro Carvalho Chehab __le16 val = 0; 1884fdf1bc9fSMauro Carvalho Chehab 188501c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 18860c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 18870c0d06caSMauro Carvalho Chehab if (ret < 0) 18880c0d06caSMauro Carvalho Chehab return ret; 18890c0d06caSMauro Carvalho Chehab 18900c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 18910c0d06caSMauro Carvalho Chehab } 18920c0d06caSMauro Carvalho Chehab 18930c0d06caSMauro Carvalho Chehab return 0; 18940c0d06caSMauro Carvalho Chehab } 18950c0d06caSMauro Carvalho Chehab 18960c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1897977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 18980c0d06caSMauro Carvalho Chehab { 1899917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19000c0d06caSMauro Carvalho Chehab __le16 buf; 19010c0d06caSMauro Carvalho Chehab 19023b2d17b4SHans Verkuil if (reg->match.addr > 1) 19033b2d17b4SHans Verkuil return -EINVAL; 1904abca2056SHans Verkuil if (reg->match.addr) 19050c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 19060c0d06caSMauro Carvalho Chehab 19070c0d06caSMauro Carvalho Chehab /* Match host */ 19080c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 19090c0d06caSMauro Carvalho Chehab 19100c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 19110c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 19120c0d06caSMauro Carvalho Chehab } 19130c0d06caSMauro Carvalho Chehab #endif 19140c0d06caSMauro Carvalho Chehab 19150c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 19160c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 19170c0d06caSMauro Carvalho Chehab { 1918a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1919917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1920ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1921c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 19220c0d06caSMauro Carvalho Chehab 19230c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 19240c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1925c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 19260c0d06caSMauro Carvalho Chehab 1927a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1928a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1929a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1930a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1931a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1932a9d79fe5SHans Verkuil else 19331d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 19340c0d06caSMauro Carvalho Chehab 1935920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 1936a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 19370c0d06caSMauro Carvalho Chehab 19380c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1939a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 19400c0d06caSMauro Carvalho Chehab 1941f9fe90a4SMauro Carvalho Chehab cap->capabilities = cap->device_caps | 1942f9fe90a4SMauro Carvalho Chehab V4L2_CAP_DEVICE_CAPS | V4L2_CAP_READWRITE | 1943f9fe90a4SMauro Carvalho Chehab V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1944d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 19451d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1946d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 1947a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 19480c0d06caSMauro Carvalho Chehab return 0; 19490c0d06caSMauro Carvalho Chehab } 19500c0d06caSMauro Carvalho Chehab 19510c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 19520c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 19530c0d06caSMauro Carvalho Chehab { 19540c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 19550c0d06caSMauro Carvalho Chehab return -EINVAL; 19560c0d06caSMauro Carvalho Chehab 19570c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 19580c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 19590c0d06caSMauro Carvalho Chehab 19600c0d06caSMauro Carvalho Chehab return 0; 19610c0d06caSMauro Carvalho Chehab } 19620c0d06caSMauro Carvalho Chehab 19630c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 19640c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 19650c0d06caSMauro Carvalho Chehab { 1966917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19670c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 19680c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 19690c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 19700c0d06caSMauro Carvalho Chehab 19710c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 19720c0d06caSMauro Carvalho Chehab if (!fmt) { 19730c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 19740c0d06caSMauro Carvalho Chehab fsize->pixel_format); 19750c0d06caSMauro Carvalho Chehab return -EINVAL; 19760c0d06caSMauro Carvalho Chehab } 19770c0d06caSMauro Carvalho Chehab 19780c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 19790c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 19800c0d06caSMauro Carvalho Chehab return -EINVAL; 19810c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 19820c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 19830c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 19840c0d06caSMauro Carvalho Chehab return 0; 19850c0d06caSMauro Carvalho Chehab } 19860c0d06caSMauro Carvalho Chehab 19870c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 19880c0d06caSMauro Carvalho Chehab return -EINVAL; 19890c0d06caSMauro Carvalho Chehab 19900c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 19910c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 19926c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 19936c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 19946c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 19950c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 19966c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 19976c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 19980c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 19990c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 20000c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 20010c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 20020c0d06caSMauro Carvalho Chehab return 0; 20030c0d06caSMauro Carvalho Chehab } 20040c0d06caSMauro Carvalho Chehab 20050c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 20060c0d06caSMauro Carvalho Chehab 20070c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 20080c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 20090c0d06caSMauro Carvalho Chehab { 2010917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 2011753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20120c0d06caSMauro Carvalho Chehab 2013753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 20140c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 20150c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 20160c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 20170c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 2018753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 2019753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 20202a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 20210c0d06caSMauro Carvalho Chehab 20220c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 202352faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 20240c0d06caSMauro Carvalho Chehab /* NTSC */ 20250c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 20260c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 202752faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 20280c0d06caSMauro Carvalho Chehab /* PAL */ 20290c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 20300c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 20310c0d06caSMauro Carvalho Chehab } 20320c0d06caSMauro Carvalho Chehab 20330c0d06caSMauro Carvalho Chehab return 0; 20340c0d06caSMauro Carvalho Chehab } 20350c0d06caSMauro Carvalho Chehab 2036f9fe90a4SMauro Carvalho Chehab /* 2037f9fe90a4SMauro Carvalho Chehab * RADIO ESPECIFIC IOCTLS 2038f9fe90a4SMauro Carvalho Chehab */ 20390c0d06caSMauro Carvalho Chehab 20400c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 20410c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 20420c0d06caSMauro Carvalho Chehab { 2043917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20440c0d06caSMauro Carvalho Chehab 20450c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 20460c0d06caSMauro Carvalho Chehab return -EINVAL; 20470c0d06caSMauro Carvalho Chehab 20480c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 20490c0d06caSMauro Carvalho Chehab 205095d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 20510c0d06caSMauro Carvalho Chehab 20520c0d06caSMauro Carvalho Chehab return 0; 20530c0d06caSMauro Carvalho Chehab } 20540c0d06caSMauro Carvalho Chehab 20550c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 20562f73c7c5SHans Verkuil const struct v4l2_tuner *t) 20570c0d06caSMauro Carvalho Chehab { 2058917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20590c0d06caSMauro Carvalho Chehab 2060f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 20610c0d06caSMauro Carvalho Chehab return -EINVAL; 20620c0d06caSMauro Carvalho Chehab 206395d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 20640c0d06caSMauro Carvalho Chehab 20650c0d06caSMauro Carvalho Chehab return 0; 20660c0d06caSMauro Carvalho Chehab } 20670c0d06caSMauro Carvalho Chehab 20680c0d06caSMauro Carvalho Chehab /* 206995d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 207095d2608bSFrank Schaefer * 207195d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 207295d2608bSFrank Schaefer * 207395d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 207495d2608bSFrank Schaefer */ 2075f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 207695d2608bSFrank Schaefer { 207795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 207895d2608bSFrank Schaefer 2079abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 208095d2608bSFrank Schaefer kfree(v4l2); 208195d2608bSFrank Schaefer } 208295d2608bSFrank Schaefer 208395d2608bSFrank Schaefer /* 20840c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 20850c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 20860c0d06caSMauro Carvalho Chehab */ 20870c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 20880c0d06caSMauro Carvalho Chehab { 20890c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 20900c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 209195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20920c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 20933c0f90e1SFrank Schaefer int ret; 20940c0d06caSMauro Carvalho Chehab 20950c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 20960c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 20970c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 20980c0d06caSMauro Carvalho Chehab break; 20990c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 21000c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 21010c0d06caSMauro Carvalho Chehab break; 21024e170240SFrank Schaefer case VFL_TYPE_RADIO: 21034e170240SFrank Schaefer break; 21044e170240SFrank Schaefer default: 21054e170240SFrank Schaefer return -EINVAL; 21060c0d06caSMauro Carvalho Chehab } 21070c0d06caSMauro Carvalho Chehab 21088e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 21098e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 21108e2c8717SFrank Schaefer v4l2->users); 21110c0d06caSMauro Carvalho Chehab 21120c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21130c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21143c0f90e1SFrank Schaefer 21153c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 21163c0f90e1SFrank Schaefer if (ret) { 211729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2118ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 21193c0f90e1SFrank Schaefer __func__, ret); 21200c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21213c0f90e1SFrank Schaefer return ret; 21220c0d06caSMauro Carvalho Chehab } 21230c0d06caSMauro Carvalho Chehab 21248e2c8717SFrank Schaefer if (v4l2->users == 0) { 21250c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 21264e170240SFrank Schaefer 21274e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 21280c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 21290c0d06caSMauro Carvalho Chehab 21304e170240SFrank Schaefer /* 21314e170240SFrank Schaefer * Needed, since GPIO might have disabled power 21324e170240SFrank Schaefer * of some i2c devices 21330c0d06caSMauro Carvalho Chehab */ 21340c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 21350c0d06caSMauro Carvalho Chehab } 2136d3829fadSDevin Heitmueller 2137d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 21380c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 213995d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 21400c0d06caSMauro Carvalho Chehab } 21410c0d06caSMauro Carvalho Chehab 214247677e51SMauro Carvalho Chehab kref_get(&dev->ref); 214395d2608bSFrank Schaefer kref_get(&v4l2->ref); 21448e2c8717SFrank Schaefer v4l2->users++; 21450c0d06caSMauro Carvalho Chehab 21460c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21470c0d06caSMauro Carvalho Chehab 2148d3829fadSDevin Heitmueller return 0; 21490c0d06caSMauro Carvalho Chehab } 21500c0d06caSMauro Carvalho Chehab 21510c0d06caSMauro Carvalho Chehab /* 215201c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 21530c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 21540c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 21550c0d06caSMauro Carvalho Chehab */ 215601c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 21570c0d06caSMauro Carvalho Chehab { 215895d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 215995d2608bSFrank Schaefer 2160822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2161822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2162822b8deaSMauro Carvalho Chehab return 0; 2163822b8deaSMauro Carvalho Chehab } 2164822b8deaSMauro Carvalho Chehab 216501c28193SMauro Carvalho Chehab if (!dev->has_video) { 216601c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 216701c28193SMauro Carvalho Chehab return 0; 216801c28193SMauro Carvalho Chehab } 21690c0d06caSMauro Carvalho Chehab 2170f9fe90a4SMauro Carvalho Chehab if (!v4l2) 217195d2608bSFrank Schaefer return 0; 217295d2608bSFrank Schaefer 217329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2174aa929ad7SMauro Carvalho Chehab 2175ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2176ebbfbc20SMauro Carvalho Chehab 217795d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 21785ad10de6SFrank Schaefer 217923e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 218023e8642cSFrank Schaefer 218137ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 218237ecc7b1SMauro Carvalho Chehab 2183d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 218429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2185d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2186d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 21870c0d06caSMauro Carvalho Chehab } 2188d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 218929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2190d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2191d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 21920c0d06caSMauro Carvalho Chehab } 2193d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 219429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2195d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2196d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 21970c0d06caSMauro Carvalho Chehab } 219801c28193SMauro Carvalho Chehab 2199abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 220095d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2201103f18a2SFrank Schaefer 220295d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 220395d2608bSFrank Schaefer 2204ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 220595d2608bSFrank Schaefer 220647677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 22075ad10de6SFrank Schaefer 220801c28193SMauro Carvalho Chehab return 0; 22090c0d06caSMauro Carvalho Chehab } 22100c0d06caSMauro Carvalho Chehab 2211a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2212a61f6811SShuah Khan { 2213a61f6811SShuah Khan if (dev->is_audio_only) 2214a61f6811SShuah Khan return 0; 2215a61f6811SShuah Khan 2216a61f6811SShuah Khan if (!dev->has_video) 2217a61f6811SShuah Khan return 0; 2218a61f6811SShuah Khan 221929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2220a61f6811SShuah Khan em28xx_stop_urbs(dev); 2221a61f6811SShuah Khan return 0; 2222a61f6811SShuah Khan } 2223a61f6811SShuah Khan 2224a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2225a61f6811SShuah Khan { 2226a61f6811SShuah Khan if (dev->is_audio_only) 2227a61f6811SShuah Khan return 0; 2228a61f6811SShuah Khan 2229a61f6811SShuah Khan if (!dev->has_video) 2230a61f6811SShuah Khan return 0; 2231a61f6811SShuah Khan 223229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2233a61f6811SShuah Khan /* what do we do here */ 2234a61f6811SShuah Khan return 0; 2235a61f6811SShuah Khan } 2236a61f6811SShuah Khan 22370c0d06caSMauro Carvalho Chehab /* 22380c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 22390c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 22400c0d06caSMauro Carvalho Chehab * calls and ioctls 22410c0d06caSMauro Carvalho Chehab */ 22420c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 22430c0d06caSMauro Carvalho Chehab { 2244917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 224595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2246c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 2247f9fe90a4SMauro Carvalho Chehab int err; 22480c0d06caSMauro Carvalho Chehab 22498e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 22508e2c8717SFrank Schaefer 22518e2c8717SFrank Schaefer vb2_fop_release(filp); 225298c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 22530c0d06caSMauro Carvalho Chehab 22548e2c8717SFrank Schaefer if (v4l2->users == 1) { 225547677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 225647677e51SMauro Carvalho Chehab if (dev->disconnected) 225701c28193SMauro Carvalho Chehab goto exit; 22580c0d06caSMauro Carvalho Chehab 22590c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 22603aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 22610c0d06caSMauro Carvalho Chehab 22620c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 22630c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 22640c0d06caSMauro Carvalho Chehab 22650c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 22660c0d06caSMauro Carvalho Chehab dev->alt = 0; 22670c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2268f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, 0, 0); 2269f9fe90a4SMauro Carvalho Chehab if (err < 0) { 227029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2271ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 2272f9fe90a4SMauro Carvalho Chehab err); 22730c0d06caSMauro Carvalho Chehab } 22740c0d06caSMauro Carvalho Chehab } 22750c0d06caSMauro Carvalho Chehab 227601c28193SMauro Carvalho Chehab exit: 22778e2c8717SFrank Schaefer v4l2->users--; 227895d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 22790c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 228047677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 228147677e51SMauro Carvalho Chehab 22820c0d06caSMauro Carvalho Chehab return 0; 22830c0d06caSMauro Carvalho Chehab } 22840c0d06caSMauro Carvalho Chehab 22850c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 22860c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22870c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22880c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2289d3829fadSDevin Heitmueller .read = vb2_fop_read, 2290d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2291d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 22920c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22930c0d06caSMauro Carvalho Chehab }; 22940c0d06caSMauro Carvalho Chehab 22950c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 22960c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 22970c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 22980c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 22990c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 23000c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 23010c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23022a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2303aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23040c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 23050c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 23060c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 23070c0d06caSMauro Carvalho Chehab 2308d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2309d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2310d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2311d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2312d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2313d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2314d3829fadSDevin Heitmueller 23150c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 23160c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 23170c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 23180c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 23190c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 23200c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 23210c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 23220c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2323d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2324d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 23250c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 23260c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 23270c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23280c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 232950fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 233050fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23310c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 233296b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 23330c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23340c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23350c0d06caSMauro Carvalho Chehab #endif 23360c0d06caSMauro Carvalho Chehab }; 23370c0d06caSMauro Carvalho Chehab 23380c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 23390c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 23400c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2341d4352f36SHans Verkuil .release = video_device_release_empty, 23420c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 23430c0d06caSMauro Carvalho Chehab }; 23440c0d06caSMauro Carvalho Chehab 23450c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 23460c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23470c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23480c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 23490c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23500c0d06caSMauro Carvalho Chehab }; 23510c0d06caSMauro Carvalho Chehab 23520c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2353a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 23540c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 23550c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 23560c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23570c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 235850fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 235950fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23600c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2361430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 23620c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23630c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23640c0d06caSMauro Carvalho Chehab #endif 23650c0d06caSMauro Carvalho Chehab }; 23660c0d06caSMauro Carvalho Chehab 23670c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 23680c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 23690c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2370d4352f36SHans Verkuil .release = video_device_release_empty, 23710c0d06caSMauro Carvalho Chehab }; 23720c0d06caSMauro Carvalho Chehab 2373b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2374b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2375b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2376b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2377b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2378b64f8e9aSMauro Carvalho Chehab 2379b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2380b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2381b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2382b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2383b64f8e9aSMauro Carvalho Chehab }; 2384b64f8e9aSMauro Carvalho Chehab 2385b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2386b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2387b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2388b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2389b64f8e9aSMauro Carvalho Chehab }; 2390b64f8e9aSMauro Carvalho Chehab 23910c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 23920c0d06caSMauro Carvalho Chehab 2393d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2394d4352f36SHans Verkuil struct video_device *vfd, 23950c0d06caSMauro Carvalho Chehab const struct video_device *template, 23960c0d06caSMauro Carvalho Chehab const char *type_name) 23970c0d06caSMauro Carvalho Chehab { 23980c0d06caSMauro Carvalho Chehab *vfd = *template; 239995d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 24000c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2401aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 2402d8c95c08SHans Verkuil vfd->tvnorms = 0; 24030c0d06caSMauro Carvalho Chehab 24040c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 240529b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 24060c0d06caSMauro Carvalho Chehab 24070c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 24080c0d06caSMauro Carvalho Chehab } 24090c0d06caSMauro Carvalho Chehab 24103319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 24110560f337SMauro Carvalho Chehab { 24123854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 24133854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 24140560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 24150560f337SMauro Carvalho Chehab struct v4l2_frequency f; 24160560f337SMauro Carvalho Chehab 24170560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 24180560f337SMauro Carvalho Chehab 24190560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 24200560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 24210560f337SMauro Carvalho Chehab 24220560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 24230560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 24240560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 24250560f337SMauro Carvalho Chehab 242695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 242795d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24280560f337SMauro Carvalho Chehab } 24290560f337SMauro Carvalho Chehab 2430f9fe90a4SMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT && dev->tuner_type) { 24310560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 24323319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 24330560f337SMauro Carvalho Chehab 243495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 243595d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24360560f337SMauro Carvalho Chehab } 24370560f337SMauro Carvalho Chehab 24386867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 24390560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 24400560f337SMauro Carvalho Chehab 24410560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 24426867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 24430560f337SMauro Carvalho Chehab 244495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 244595d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 24460560f337SMauro Carvalho Chehab } 24470560f337SMauro Carvalho Chehab 24480560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 24490560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 24500560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 24510560f337SMauro Carvalho Chehab 24520560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 24530560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 24540560f337SMauro Carvalho Chehab 24550560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 24560560f337SMauro Carvalho Chehab 24570560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 24580560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 24590560f337SMauro Carvalho Chehab 246095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 24610560f337SMauro Carvalho Chehab } 24620560f337SMauro Carvalho Chehab 24630560f337SMauro Carvalho Chehab /* configure tuner */ 24640560f337SMauro Carvalho Chehab f.tuner = 0; 24650560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 24660560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 24673854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 246895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 24690560f337SMauro Carvalho Chehab } 24700560f337SMauro Carvalho Chehab 247101c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 24720c0d06caSMauro Carvalho Chehab { 24730c0d06caSMauro Carvalho Chehab u8 val; 24740c0d06caSMauro Carvalho Chehab int ret; 24750c0d06caSMauro Carvalho Chehab unsigned int maxw; 2476abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 247795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2478b64f8e9aSMauro Carvalho Chehab 2479822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2480822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2481822b8deaSMauro Carvalho Chehab return 0; 2482822b8deaSMauro Carvalho Chehab } 2483822b8deaSMauro Carvalho Chehab 248401c28193SMauro Carvalho Chehab if (!dev->has_video) { 2485b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2486b64f8e9aSMauro Carvalho Chehab return 0; 2487b64f8e9aSMauro Carvalho Chehab } 24880c0d06caSMauro Carvalho Chehab 248929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 24900c0d06caSMauro Carvalho Chehab 249101c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 249201c28193SMauro Carvalho Chehab 2493f9fe90a4SMauro Carvalho Chehab v4l2 = kzalloc(sizeof(*v4l2), GFP_KERNEL); 24948314d402SMauro Carvalho Chehab if (!v4l2) { 249595d2608bSFrank Schaefer mutex_unlock(&dev->lock); 249695d2608bSFrank Schaefer return -ENOMEM; 249795d2608bSFrank Schaefer } 249895d2608bSFrank Schaefer kref_init(&v4l2->ref); 2499abc1308fSFrank Schaefer v4l2->dev = dev; 250095d2608bSFrank Schaefer dev->v4l2 = v4l2; 250195d2608bSFrank Schaefer 250237ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 250337ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 250437ecc7b1SMauro Carvalho Chehab #endif 250529b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2506b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 250729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2508ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2509b64f8e9aSMauro Carvalho Chehab goto err; 2510b64f8e9aSMauro Carvalho Chehab } 2511b64f8e9aSMauro Carvalho Chehab 2512abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2513b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 251495d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2515b64f8e9aSMauro Carvalho Chehab 2516aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 25177e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 251858159171SFrank Schaefer 2519b64f8e9aSMauro Carvalho Chehab /* 2520b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2521b64f8e9aSMauro Carvalho Chehab */ 2522a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY; 25239297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2524b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2525b64f8e9aSMauro Carvalho Chehab 2526b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2527b64f8e9aSMauro Carvalho Chehab 2528aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) 252995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 253095d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2531b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2532b64f8e9aSMauro Carvalho Chehab 2533b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 253495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 253595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2536b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2537b64f8e9aSMauro Carvalho Chehab 2538b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 253995d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 254095d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2541b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2542b64f8e9aSMauro Carvalho Chehab 2543b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 254495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 254595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2546b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2547b64f8e9aSMauro Carvalho Chehab 2548b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2549b64f8e9aSMauro Carvalho Chehab 2550b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 25513319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 25526867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2553b64f8e9aSMauro Carvalho Chehab 2554b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 255595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 255695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2557fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2558fdf1bc9fSMauro Carvalho Chehab NULL); 2559b64f8e9aSMauro Carvalho Chehab 2560b64f8e9aSMauro Carvalho Chehab if (has_demod) 256195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2562fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2563fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2564fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 25653319e6f8SFrank Schaefer if (tuner_addr == 0) { 2566b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2567b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2568b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2569b64f8e9aSMauro Carvalho Chehab 257095d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2571fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2572fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2573fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2574b64f8e9aSMauro Carvalho Chehab 2575b64f8e9aSMauro Carvalho Chehab if (sd) 25763319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2577b64f8e9aSMauro Carvalho Chehab } else { 257895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 257995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 25803319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2581b64f8e9aSMauro Carvalho Chehab } 2582b64f8e9aSMauro Carvalho Chehab 25833319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 25843319e6f8SFrank Schaefer } 25853319e6f8SFrank Schaefer 2586d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2587b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2588b64f8e9aSMauro Carvalho Chehab 2589b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2590b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2591b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 259229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2593ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2594b64f8e9aSMauro Carvalho Chehab __func__, ret); 2595b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2596b64f8e9aSMauro Carvalho Chehab } 2597b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2598b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2599b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2600b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2601b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2602b64f8e9aSMauro Carvalho Chehab } else { 2603b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2604b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2605b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2606b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2607b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2608b64f8e9aSMauro Carvalho Chehab } 2609b64f8e9aSMauro Carvalho Chehab 2610b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2611b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2612b64f8e9aSMauro Carvalho Chehab 2613b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2614b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2615b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2616b64f8e9aSMauro Carvalho Chehab 2617aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 2618b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2619b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2620b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 262129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2622ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2623b64f8e9aSMauro Carvalho Chehab __func__, ret); 2624b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2625b64f8e9aSMauro Carvalho Chehab } 2626f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2627b64f8e9aSMauro Carvalho Chehab 2628b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2629b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 263029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2631ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2632b64f8e9aSMauro Carvalho Chehab __func__, ret); 2633b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2634b64f8e9aSMauro Carvalho Chehab } 2635f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2636b64f8e9aSMauro Carvalho Chehab } 2637b64f8e9aSMauro Carvalho Chehab 26380c0d06caSMauro Carvalho Chehab /* set default norm */ 263952faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 26408774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 264158159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 26420c0d06caSMauro Carvalho Chehab 26430c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 264406e20672SFrank Schaefer v4l2->format = &format[0]; 26450c0d06caSMauro Carvalho Chehab 26460c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 2647f9fe90a4SMauro Carvalho Chehab /* 2648f9fe90a4SMauro Carvalho Chehab * MaxPacketSize for em2800 is too small to capture at full resolution 2649f9fe90a4SMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% 2650f9fe90a4SMauro Carvalho Chehab */ 26510c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 26520c0d06caSMauro Carvalho Chehab maxw /= 2; 26530c0d06caSMauro Carvalho Chehab 26540c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 26550c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 26560c0d06caSMauro Carvalho Chehab 26570c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 26580c0d06caSMauro Carvalho Chehab 26590c0d06caSMauro Carvalho Chehab /* Audio defaults */ 26600c0d06caSMauro Carvalho Chehab dev->mute = 1; 26610c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 26620c0d06caSMauro Carvalho Chehab 26630c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 26640c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 26650c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 26660c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 26670c0d06caSMauro Carvalho Chehab 26680c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 26690c0d06caSMauro Carvalho Chehab 26708f8b113aSFrank Schaefer /* Add image controls */ 2671f9fe90a4SMauro Carvalho Chehab 2672f9fe90a4SMauro Carvalho Chehab /* 2673f9fe90a4SMauro Carvalho Chehab * NOTE: at this point, the subdevices are already registered, so 2674f9fe90a4SMauro Carvalho Chehab * bridge controls are only added/enabled when no subdevice provides 2675f9fe90a4SMauro Carvalho Chehab * them 2676f9fe90a4SMauro Carvalho Chehab */ 2677f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2678ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26798f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 26808f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2681f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2682ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26838f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 26848f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2685f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2686ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26878f8b113aSFrank Schaefer V4L2_CID_SATURATION, 26888f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2689f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2690ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26918f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 26928f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2693f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2694ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26958f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 26968f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2697f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2698ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26998f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 27008f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 27018f8b113aSFrank Schaefer 27028f8b113aSFrank Schaefer /* Reset image controls */ 27038f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2704ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2705ad298055SFrank Schaefer ret = hdl->error; 2706b64f8e9aSMauro Carvalho Chehab if (ret) 2707b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27088f8b113aSFrank Schaefer 27090c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2710d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 271127a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 271227a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2713d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2714d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 27150c0d06caSMauro Carvalho Chehab 27166e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 2717aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 2718d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2719d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2720d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 27213bc85cceSFrank Schaefer } else { 2722d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 27236e46dabaSFrank Schaefer } 272466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2725d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2726d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2727d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2728d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 272966df67b7SFrank Schaefer } 2730920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2731d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2732d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2733c2dcef83SFrank Schaefer } 27346e46dabaSFrank Schaefer 27350c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2736d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 27370c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 27380c0d06caSMauro Carvalho Chehab if (ret) { 273929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2740ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2741b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27420c0d06caSMauro Carvalho Chehab } 27430c0d06caSMauro Carvalho Chehab 27440c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 27450c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2746d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 27470c0d06caSMauro Carvalho Chehab "vbi"); 27480c0d06caSMauro Carvalho Chehab 2749d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2750d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2751d3829fadSDevin Heitmueller 275266df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2753d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 275466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2755d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2756d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2757d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2758d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 275966df67b7SFrank Schaefer } 2760920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2761d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2762d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2763c2dcef83SFrank Schaefer } 276466df67b7SFrank Schaefer 27650c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2766d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 27670c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 27680c0d06caSMauro Carvalho Chehab if (ret < 0) { 276929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2770ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2771b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27720c0d06caSMauro Carvalho Chehab } 27730c0d06caSMauro Carvalho Chehab } 27740c0d06caSMauro Carvalho Chehab 27750c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2776d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 27770c0d06caSMauro Carvalho Chehab "radio"); 2778d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 27790c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 27800c0d06caSMauro Carvalho Chehab if (ret < 0) { 278129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2782ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2783b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27840c0d06caSMauro Carvalho Chehab } 278529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2786ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2787d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 27880c0d06caSMauro Carvalho Chehab } 27890c0d06caSMauro Carvalho Chehab 279037ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 279137ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 279237ecc7b1SMauro Carvalho Chehab 27930d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2794de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 279537ecc7b1SMauro Carvalho Chehab if (ret) { 279629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2797ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 279837ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 279937ecc7b1SMauro Carvalho Chehab goto unregister_dev; 280037ecc7b1SMauro Carvalho Chehab } 28010d37ba62SArnd Bergmann #endif 280237ecc7b1SMauro Carvalho Chehab 280329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2804ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2805d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 28060c0d06caSMauro Carvalho Chehab 2807d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 280829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2809ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2810d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 28110c0d06caSMauro Carvalho Chehab 2812b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 28133aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 2814b64f8e9aSMauro Carvalho Chehab 2815b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2816b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2817b64f8e9aSMauro Carvalho Chehab 281829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2819ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 28209634614fSMauro Carvalho Chehab 282147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 282247677e51SMauro Carvalho Chehab 282301c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 28240c0d06caSMauro Carvalho Chehab return 0; 2825b64f8e9aSMauro Carvalho Chehab 2826b64f8e9aSMauro Carvalho Chehab unregister_dev: 282756a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 282829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2829ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 283056a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 283156a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 283256a7f515SMauro Carvalho Chehab } 283356a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 283429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2835ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 283656a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 283756a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 283856a7f515SMauro Carvalho Chehab } 283956a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 284029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2841ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 284256a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 284356a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 284456a7f515SMauro Carvalho Chehab } 284556a7f515SMauro Carvalho Chehab 2846abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 284795d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2848b64f8e9aSMauro Carvalho Chehab err: 284995d2608bSFrank Schaefer dev->v4l2 = NULL; 285095d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 285101c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2852b64f8e9aSMauro Carvalho Chehab return ret; 28530c0d06caSMauro Carvalho Chehab } 285401c28193SMauro Carvalho Chehab 285501c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 285601c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 285701c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 285801c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 285901c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2860a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2861a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 286201c28193SMauro Carvalho Chehab }; 286301c28193SMauro Carvalho Chehab 286401c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 286501c28193SMauro Carvalho Chehab { 286601c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 286701c28193SMauro Carvalho Chehab } 286801c28193SMauro Carvalho Chehab 286901c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 287001c28193SMauro Carvalho Chehab { 287101c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 287201c28193SMauro Carvalho Chehab } 287301c28193SMauro Carvalho Chehab 287401c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 287501c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2876