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 .fourcc = V4L2_PIX_FMT_YUYV, 1060c0d06caSMauro Carvalho Chehab .depth = 16, 1070c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1080c0d06caSMauro Carvalho Chehab }, { 1090c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1100c0d06caSMauro Carvalho Chehab .depth = 16, 1110c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1120c0d06caSMauro Carvalho Chehab }, { 113495ab569SFrank Schaefer .fourcc = V4L2_PIX_FMT_SRGGB8, 114495ab569SFrank Schaefer .depth = 8, 115495ab569SFrank Schaefer .reg = EM28XX_OUTFMT_RGB_8_RGRG, 116495ab569SFrank Schaefer }, { 1170c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1180c0d06caSMauro Carvalho Chehab .depth = 8, 1190c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1200c0d06caSMauro Carvalho Chehab }, { 1210c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1220c0d06caSMauro Carvalho Chehab .depth = 8, 1230c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1240c0d06caSMauro Carvalho Chehab }, { 1250c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1260c0d06caSMauro Carvalho Chehab .depth = 8, 1270c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1280c0d06caSMauro Carvalho Chehab }, { 1290c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1300c0d06caSMauro Carvalho Chehab .depth = 12, 1310c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1320c0d06caSMauro Carvalho Chehab }, 1330c0d06caSMauro Carvalho Chehab }; 1340c0d06caSMauro Carvalho Chehab 13525c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */ 13625c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev) 13725c61e4cSFrank Schaefer { 138d7dc18daSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 139d7dc18daSFrank Schaefer 140aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 141d7dc18daSFrank Schaefer return v4l2->sensor_xres; 14225c61e4cSFrank Schaefer 14325c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 14425c61e4cSFrank Schaefer return 640; 14525c61e4cSFrank Schaefer 14625c61e4cSFrank Schaefer return 720; 14725c61e4cSFrank Schaefer } 14825c61e4cSFrank Schaefer 14925c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev) 15025c61e4cSFrank Schaefer { 15152faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15252faaf78SFrank Schaefer 153aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 154d7dc18daSFrank Schaefer return v4l2->sensor_yres; 15525c61e4cSFrank Schaefer 15625c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 15725c61e4cSFrank Schaefer return 480; 15825c61e4cSFrank Schaefer 15952faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480; 16025c61e4cSFrank Schaefer } 16125c61e4cSFrank Schaefer 16201c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1630560f337SMauro Carvalho Chehab { 1640560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1650560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1660560f337SMauro Carvalho Chehab return 0; 1670560f337SMauro Carvalho Chehab 168aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1690560f337SMauro Carvalho Chehab return 0; 1700560f337SMauro Carvalho Chehab 1710560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1720560f337SMauro Carvalho Chehab 1730560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1740560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1750560f337SMauro Carvalho Chehab return 1; 1760560f337SMauro Carvalho Chehab 1770560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1780560f337SMauro Carvalho Chehab return 0; 1790560f337SMauro Carvalho Chehab } 1800560f337SMauro Carvalho Chehab 1810560f337SMauro Carvalho Chehab /* 1820560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1830560f337SMauro Carvalho Chehab * configure i2c attached devices 1840560f337SMauro Carvalho Chehab */ 18501c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1860560f337SMauro Carvalho Chehab { 18795d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 188fdf1bc9fSMauro Carvalho Chehab 18995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 19095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 1910560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 1920560f337SMauro Carvalho Chehab } 1930560f337SMauro Carvalho Chehab 19401c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 1950560f337SMauro Carvalho Chehab { 1960560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 1970560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 1980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 1990560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2000560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2010560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2020560f337SMauro Carvalho Chehab 2030560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2040560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2090560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2100560f337SMauro Carvalho Chehab } 2110560f337SMauro Carvalho Chehab 21201c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2130560f337SMauro Carvalho Chehab { 2140560f337SMauro Carvalho Chehab int ret; 2150560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 216753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2170560f337SMauro Carvalho Chehab 21806e20672SFrank Schaefer fmt = v4l2->format->reg; 2190560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2200560f337SMauro Carvalho Chehab fmt |= 0x20; 2210560f337SMauro Carvalho Chehab /* 2220560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2230560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2240560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2250560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2260560f337SMauro Carvalho Chehab * 2270560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2280560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2290560f337SMauro Carvalho Chehab */ 2300560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2310560f337SMauro Carvalho Chehab if (ret < 0) 2320560f337SMauro Carvalho Chehab return ret; 2330560f337SMauro Carvalho Chehab 2349297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2350560f337SMauro Carvalho Chehab if (ret < 0) 2360560f337SMauro Carvalho Chehab return ret; 2370560f337SMauro Carvalho Chehab 2389297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2390560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2400560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2410560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 242f9fe90a4SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, 243f9fe90a4SMauro Carvalho Chehab v4l2->vbi_width / 4); 244753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 24552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2460560f337SMauro Carvalho Chehab /* NTSC */ 2470560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 24852faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2490560f337SMauro Carvalho Chehab /* PAL */ 2500560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2510560f337SMauro Carvalho Chehab } 2520560f337SMauro Carvalho Chehab } 2530560f337SMauro Carvalho Chehab 2540560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2550560f337SMauro Carvalho Chehab } 2560560f337SMauro Carvalho Chehab 2570560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2580560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2590560f337SMauro Carvalho Chehab { 2600560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2610560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2620560f337SMauro Carvalho Chehab 2630560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2640560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2650560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2660560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2670560f337SMauro Carvalho Chehab } 2680560f337SMauro Carvalho Chehab 2690560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2700560f337SMauro Carvalho Chehab u16 width, u16 height) 2710560f337SMauro Carvalho Chehab { 2720560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2730560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2740560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2750560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2760560f337SMauro Carvalho Chehab 2770560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2780560f337SMauro Carvalho Chehab hstart, vstart, 2790560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2800560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2810560f337SMauro Carvalho Chehab 2820560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2830560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2840560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2850560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2860560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2870560f337SMauro Carvalho Chehab 2880560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2890560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2900560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2910560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2920560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2930560f337SMauro Carvalho Chehab } 2940560f337SMauro Carvalho Chehab } 2950560f337SMauro Carvalho Chehab 2960560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 2970560f337SMauro Carvalho Chehab { 298cba8e9b3SFrank Schaefer u8 mode = 0x00; 2990560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3000560f337SMauro Carvalho Chehab 3010560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3020560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3030560f337SMauro Carvalho Chehab } else { 3040560f337SMauro Carvalho Chehab u8 buf[2]; 3050560f337SMauro Carvalho Chehab 3060560f337SMauro Carvalho Chehab buf[0] = h; 3070560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3080560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3090560f337SMauro Carvalho Chehab 3100560f337SMauro Carvalho Chehab buf[0] = v; 3110560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3120560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 313f9fe90a4SMauro Carvalho Chehab /* 314f9fe90a4SMauro Carvalho Chehab * it seems that both H and V scalers must be active 315f9fe90a4SMauro Carvalho Chehab * to work correctly 316f9fe90a4SMauro Carvalho Chehab */ 3170560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3180560f337SMauro Carvalho Chehab } 319cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3200560f337SMauro Carvalho Chehab } 3210560f337SMauro Carvalho Chehab 3220560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32301c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3240560f337SMauro Carvalho Chehab { 325753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 326753aee77SFrank Schaefer int width = norm_maxw(dev); 327753aee77SFrank Schaefer int height = norm_maxh(dev); 3280560f337SMauro Carvalho Chehab 3290560f337SMauro Carvalho Chehab /* Properly setup VBI */ 330753aee77SFrank Schaefer v4l2->vbi_width = 720; 33152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 332753aee77SFrank Schaefer v4l2->vbi_height = 12; 3330560f337SMauro Carvalho Chehab else 334753aee77SFrank Schaefer v4l2->vbi_height = 18; 3350560f337SMauro Carvalho Chehab 3360560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3370560f337SMauro Carvalho Chehab 3380560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3390560f337SMauro Carvalho Chehab 340f9fe90a4SMauro Carvalho Chehab /* 341f9fe90a4SMauro Carvalho Chehab * If we don't set the start position to 2 in VBI mode, we end up 342f9fe90a4SMauro Carvalho Chehab * with line 20/21 being YUYV encoded instead of being in 8-bit 343f9fe90a4SMauro Carvalho Chehab * greyscale. The core of the issue is that line 21 (and line 23 for 344f9fe90a4SMauro Carvalho Chehab * PAL WSS) are inside of active video region, and as a result they 345f9fe90a4SMauro Carvalho Chehab * get the pixelformatting associated with that area. So by cropping 346f9fe90a4SMauro Carvalho Chehab * it out, we end up with the same format as the rest of the VBI 347f9fe90a4SMauro Carvalho Chehab * region 348f9fe90a4SMauro Carvalho Chehab */ 3490560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3500560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3510560f337SMauro Carvalho Chehab else 3520560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3530560f337SMauro Carvalho Chehab 354753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3550560f337SMauro Carvalho Chehab } 3560560f337SMauro Carvalho Chehab 3570560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 35801c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3590560f337SMauro Carvalho Chehab { 360753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 361c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 362f9fe90a4SMauro Carvalho Chehab int err; 3630560f337SMauro Carvalho Chehab int i; 364753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3650560f337SMauro Carvalho Chehab 366f9fe90a4SMauro Carvalho Chehab /* 367f9fe90a4SMauro Carvalho Chehab * NOTE: for isoc transfers, only alt settings > 0 are allowed 368f9fe90a4SMauro Carvalho Chehab * bulk transfers seem to work only with alt=0 ! 369f9fe90a4SMauro Carvalho Chehab */ 3700560f337SMauro Carvalho Chehab dev->alt = 0; 371f9fe90a4SMauro Carvalho Chehab if (alt > 0 && alt < dev->num_alt) { 3720560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3730560f337SMauro Carvalho Chehab dev->alt = alt; 3740560f337SMauro Carvalho Chehab goto set_alt; 3750560f337SMauro Carvalho Chehab } 3760560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3770560f337SMauro Carvalho Chehab goto set_alt; 3780560f337SMauro Carvalho Chehab 379f9fe90a4SMauro Carvalho Chehab /* 380f9fe90a4SMauro Carvalho Chehab * When image size is bigger than a certain value, 381f9fe90a4SMauro Carvalho Chehab * the frame size should be increased, otherwise, only 382f9fe90a4SMauro Carvalho Chehab * green screen will be received. 3830560f337SMauro Carvalho Chehab */ 384753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3850560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3860560f337SMauro Carvalho Chehab 3870560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3880560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3890560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3900560f337SMauro Carvalho Chehab dev->alt = i; 3910560f337SMauro Carvalho Chehab break; 392f9fe90a4SMauro Carvalho Chehab /* 393f9fe90a4SMauro Carvalho Chehab * otherwise make sure that we end up with the maximum 394f9fe90a4SMauro Carvalho Chehab * bandwidth because the min_pkt_size equation might be wrong. 395f9fe90a4SMauro Carvalho Chehab * 3960560f337SMauro Carvalho Chehab */ 3970560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3980560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3990560f337SMauro Carvalho Chehab dev->alt = i; 4000560f337SMauro Carvalho Chehab } 4010560f337SMauro Carvalho Chehab 4020560f337SMauro Carvalho Chehab set_alt: 403f9fe90a4SMauro Carvalho Chehab /* 404f9fe90a4SMauro Carvalho Chehab * NOTE: for bulk transfers, we need to call usb_set_interface() 4050560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 406f9fe90a4SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! 407f9fe90a4SMauro Carvalho Chehab */ 4080560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4090560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4100560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4110560f337SMauro Carvalho Chehab } else { /* isoc */ 4120560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4130560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4140560f337SMauro Carvalho Chehab dev->max_pkt_size = 4150560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4160560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4170560f337SMauro Carvalho Chehab } 4180560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4190560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 420f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, dev->ifnum, dev->alt); 421f9fe90a4SMauro Carvalho Chehab if (err < 0) { 42229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 423ce8591ffSMauro Carvalho Chehab "cannot change alternate number to %d (error=%i)\n", 424f9fe90a4SMauro Carvalho Chehab dev->alt, err); 425f9fe90a4SMauro Carvalho Chehab return err; 4260560f337SMauro Carvalho Chehab } 4270560f337SMauro Carvalho Chehab return 0; 4280560f337SMauro Carvalho Chehab } 4290560f337SMauro Carvalho Chehab 430f9fe90a4SMauro Carvalho Chehab /* 431f9fe90a4SMauro Carvalho Chehab * DMA and thread functions 432f9fe90a4SMauro Carvalho Chehab */ 4330c0d06caSMauro Carvalho Chehab 4340c0d06caSMauro Carvalho Chehab /* 435948a49aaSFrank Schaefer * Finish the current buffer 4360c0d06caSMauro Carvalho Chehab */ 437948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4380c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4390c0d06caSMauro Carvalho Chehab { 440d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 441d3829fadSDevin Heitmueller 4422d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++; 443662c97cfSFrank Schaefer if (dev->v4l2->progressive) 4442d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE; 445662c97cfSFrank Schaefer else 4462d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED; 447d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns(); 448d3829fadSDevin Heitmueller 4492d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 4500c0d06caSMauro Carvalho Chehab } 4510c0d06caSMauro Carvalho Chehab 4520c0d06caSMauro Carvalho Chehab /* 45336016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4540c0d06caSMauro Carvalho Chehab */ 4550c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4560c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 45736016a35SFrank Schaefer unsigned char *usb_buf, 4584078d625SFrank Schaefer unsigned long len) 4590c0d06caSMauro Carvalho Chehab { 46058159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4610c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4620c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 46358159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4640c0d06caSMauro Carvalho Chehab 465d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 466d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4670c0d06caSMauro Carvalho Chehab 46836016a35SFrank Schaefer startread = usb_buf; 4690c0d06caSMauro Carvalho Chehab remain = len; 4700c0d06caSMauro Carvalho Chehab 47158159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 47236016a35SFrank Schaefer fieldstart = buf->vb_buf; 473c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 47436016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4750c0d06caSMauro Carvalho Chehab 4768732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4778732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4780c0d06caSMauro Carvalho Chehab 47958159171SFrank Schaefer if (v4l2->progressive) 4800c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4810c0d06caSMauro Carvalho Chehab else 4820c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4830c0d06caSMauro Carvalho Chehab 4840c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4850c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4860c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4870c0d06caSMauro Carvalho Chehab 488d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4897983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4900c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 491d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 492d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 49336016a35SFrank Schaefer (char *)startwrite; 4940c0d06caSMauro Carvalho Chehab lencopy = remain; 4950c0d06caSMauro Carvalho Chehab } 4960c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4970c0d06caSMauro Carvalho Chehab return; 4980c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4990c0d06caSMauro Carvalho Chehab 5000c0d06caSMauro Carvalho Chehab remain -= lencopy; 5010c0d06caSMauro Carvalho Chehab 5020c0d06caSMauro Carvalho Chehab while (remain > 0) { 50358159171SFrank Schaefer if (v4l2->progressive) 504c02ec71bSFrank Schaefer startwrite += lencopy; 505c02ec71bSFrank Schaefer else 5060c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5070c0d06caSMauro Carvalho Chehab startread += lencopy; 5080c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5090c0d06caSMauro Carvalho Chehab lencopy = remain; 5100c0d06caSMauro Carvalho Chehab else 5110c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5120c0d06caSMauro Carvalho Chehab 51336016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 514d3829fadSDevin Heitmueller buf->length) { 5155ccb197dSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end(2)\n", 5160c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 517d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 518f9fe90a4SMauro Carvalho Chehab remain = (char *)buf->vb_buf + buf->length - 5190c0d06caSMauro Carvalho Chehab (char *)startwrite; 520f9fe90a4SMauro Carvalho Chehab lencopy = remain; 5210c0d06caSMauro Carvalho Chehab } 5220c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5230c0d06caSMauro Carvalho Chehab break; 5240c0d06caSMauro Carvalho Chehab 5250c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5260c0d06caSMauro Carvalho Chehab 5270c0d06caSMauro Carvalho Chehab remain -= lencopy; 5280c0d06caSMauro Carvalho Chehab } 5290c0d06caSMauro Carvalho Chehab 5308732533bSFrank Schaefer buf->pos += len; 5310c0d06caSMauro Carvalho Chehab } 5320c0d06caSMauro Carvalho Chehab 53336016a35SFrank Schaefer /* 53436016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 53536016a35SFrank Schaefer */ 5360c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5370c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53836016a35SFrank Schaefer unsigned char *usb_buf, 5394078d625SFrank Schaefer unsigned long len) 5400c0d06caSMauro Carvalho Chehab { 54136016a35SFrank Schaefer unsigned int offset; 5420c0d06caSMauro Carvalho Chehab 543d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 544d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5450c0d06caSMauro Carvalho Chehab 5468732533bSFrank Schaefer offset = buf->pos; 5470c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54836016a35SFrank Schaefer if (buf->top_field == 0) 549753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5500c0d06caSMauro Carvalho Chehab 55136016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5528732533bSFrank Schaefer buf->pos += len; 5530c0d06caSMauro Carvalho Chehab } 5540c0d06caSMauro Carvalho Chehab 5550c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5560c0d06caSMauro Carvalho Chehab int packet, int status) 5570c0d06caSMauro Carvalho Chehab { 5580c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5590c0d06caSMauro Carvalho Chehab 5600c0d06caSMauro Carvalho Chehab switch (status) { 5610c0d06caSMauro Carvalho Chehab case -ENOENT: 562b436e26eSColin Ian King errmsg = "unlinked synchronously"; 5630c0d06caSMauro Carvalho Chehab break; 5640c0d06caSMauro Carvalho Chehab case -ECONNRESET: 565b436e26eSColin Ian King errmsg = "unlinked asynchronously"; 5660c0d06caSMauro Carvalho Chehab break; 5670c0d06caSMauro Carvalho Chehab case -ENOSR: 5680c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5690c0d06caSMauro Carvalho Chehab break; 5700c0d06caSMauro Carvalho Chehab case -EPIPE: 5710c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5720c0d06caSMauro Carvalho Chehab break; 5730c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5740c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5750c0d06caSMauro Carvalho Chehab break; 5760c0d06caSMauro Carvalho Chehab case -EPROTO: 5770c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5780c0d06caSMauro Carvalho Chehab break; 5790c0d06caSMauro Carvalho Chehab case -EILSEQ: 5800c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5810c0d06caSMauro Carvalho Chehab break; 5820c0d06caSMauro Carvalho Chehab case -ETIME: 5830c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5840c0d06caSMauro Carvalho Chehab break; 5850c0d06caSMauro Carvalho Chehab } 5860c0d06caSMauro Carvalho Chehab if (packet < 0) { 5870c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5880c0d06caSMauro Carvalho Chehab } else { 5890c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5900c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5910c0d06caSMauro Carvalho Chehab } 5920c0d06caSMauro Carvalho Chehab } 5930c0d06caSMauro Carvalho Chehab 5940c0d06caSMauro Carvalho Chehab /* 59524a6d849SFrank Schaefer * get the next available buffer from dma queue 5960c0d06caSMauro Carvalho Chehab */ 59724a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59824a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5990c0d06caSMauro Carvalho Chehab { 60024a6d849SFrank Schaefer struct em28xx_buffer *buf; 6010c0d06caSMauro Carvalho Chehab 6020c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 6030c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 60424a6d849SFrank Schaefer return NULL; 6050c0d06caSMauro Carvalho Chehab } 6060c0d06caSMauro Carvalho Chehab 6070c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 608d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6090c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 610d3829fadSDevin Heitmueller list_del(&buf->list); 6118732533bSFrank Schaefer buf->pos = 0; 612d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6130c0d06caSMauro Carvalho Chehab 61424a6d849SFrank Schaefer return buf; 6150c0d06caSMauro Carvalho Chehab } 6160c0d06caSMauro Carvalho Chehab 617e04c00d9SFrank Schaefer /* 618e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 619e04c00d9SFrank Schaefer */ 620e04c00d9SFrank Schaefer static struct em28xx_buffer * 621e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 622e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 623e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 624e04c00d9SFrank Schaefer { 62558159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 62658159171SFrank Schaefer 627f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 628f9fe90a4SMauro Carvalho Chehab if (buf) 629e04c00d9SFrank Schaefer finish_buffer(dev, buf); 630e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 631e04c00d9SFrank Schaefer } 632f9fe90a4SMauro Carvalho Chehab if (buf) { 633f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 634e04c00d9SFrank Schaefer buf->pos = 0; 635e04c00d9SFrank Schaefer } 636e04c00d9SFrank Schaefer 637e04c00d9SFrank Schaefer return buf; 638e04c00d9SFrank Schaefer } 639e04c00d9SFrank Schaefer 640227b7c90SFrank Schaefer /* 641227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 642227b7c90SFrank Schaefer */ 643227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 644227b7c90SFrank Schaefer unsigned char *data_pkt, 645227b7c90SFrank Schaefer unsigned int data_len) 646227b7c90SFrank Schaefer { 647753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 648227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 649227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 650227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 651227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 652227b7c90SFrank Schaefer 653f9fe90a4SMauro Carvalho Chehab /* 654f9fe90a4SMauro Carvalho Chehab * capture type 0 = vbi start 655f9fe90a4SMauro Carvalho Chehab * capture type 1 = vbi in progress 656f9fe90a4SMauro Carvalho Chehab * capture type 2 = video start 657f9fe90a4SMauro Carvalho Chehab * capture type 3 = video in progress 658f9fe90a4SMauro Carvalho Chehab */ 659227b7c90SFrank Schaefer if (data_len >= 4) { 660f9fe90a4SMauro Carvalho Chehab /* 661f9fe90a4SMauro Carvalho Chehab * NOTE: Headers are always 4 bytes and 662f9fe90a4SMauro Carvalho Chehab * never split across packets 663f9fe90a4SMauro Carvalho Chehab */ 664227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 665227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 666227b7c90SFrank Schaefer /* Continuation */ 667227b7c90SFrank Schaefer data_pkt += 4; 668227b7c90SFrank Schaefer data_len -= 4; 669227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 670227b7c90SFrank Schaefer /* Field start (VBI mode) */ 671f0e38230SFrank Schaefer v4l2->capture_type = 0; 672f0e38230SFrank Schaefer v4l2->vbi_read = 0; 673227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 674f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 675227b7c90SFrank Schaefer data_pkt += 4; 676227b7c90SFrank Schaefer data_len -= 4; 677227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 678227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 679f0e38230SFrank Schaefer v4l2->capture_type = 2; 680227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 681f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 682227b7c90SFrank Schaefer data_pkt += 4; 683227b7c90SFrank Schaefer data_len -= 4; 684227b7c90SFrank Schaefer } 685227b7c90SFrank Schaefer } 686f9fe90a4SMauro Carvalho Chehab /* 687f9fe90a4SMauro Carvalho Chehab * NOTE: With bulk transfers, intermediate data packets 688f9fe90a4SMauro Carvalho Chehab * have no continuation header 689f9fe90a4SMauro Carvalho Chehab */ 690227b7c90SFrank Schaefer 691f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 692227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 693227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 694f0e38230SFrank Schaefer v4l2->capture_type = 1; 695227b7c90SFrank Schaefer } 696227b7c90SFrank Schaefer 697f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 698753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 699f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 700f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 701227b7c90SFrank Schaefer 702227b7c90SFrank Schaefer /* Copy VBI data */ 703f9fe90a4SMauro Carvalho Chehab if (vbi_buf) 704227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 705f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 706227b7c90SFrank Schaefer 707227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 708227b7c90SFrank Schaefer /* Continue with copying video data */ 709f0e38230SFrank Schaefer v4l2->capture_type = 2; 710227b7c90SFrank Schaefer data_pkt += vbi_data_len; 711227b7c90SFrank Schaefer data_len -= vbi_data_len; 712227b7c90SFrank Schaefer } 713227b7c90SFrank Schaefer } 714227b7c90SFrank Schaefer 715f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 716227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 717227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 718f0e38230SFrank Schaefer v4l2->capture_type = 3; 719227b7c90SFrank Schaefer } 720227b7c90SFrank Schaefer 721f9fe90a4SMauro Carvalho Chehab if (v4l2->capture_type == 3 && buf && data_len > 0) 722227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 723227b7c90SFrank Schaefer } 724227b7c90SFrank Schaefer 725e507e0e5SFrank Schaefer /* 726e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 727e507e0e5SFrank Schaefer */ 728e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 729e507e0e5SFrank Schaefer unsigned char *data_pkt, 730e507e0e5SFrank Schaefer unsigned int data_len) 731e507e0e5SFrank Schaefer { 732e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 733e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 734f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7357e6c8c19SMauro Carvalho Chehab bool frame_end = false; 736e507e0e5SFrank Schaefer 737e507e0e5SFrank Schaefer /* Check for header */ 738f9fe90a4SMauro Carvalho Chehab /* 739f9fe90a4SMauro Carvalho Chehab * NOTE: at least with bulk transfers, only the first packet 740f9fe90a4SMauro Carvalho Chehab * has a header and has always set the FRAME_END bit 741f9fe90a4SMauro Carvalho Chehab */ 742e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 743e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 744e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 745f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 746e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 747e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 748e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 749e507e0e5SFrank Schaefer data_pkt += 2; 750e507e0e5SFrank Schaefer data_len -= 2; 751e507e0e5SFrank Schaefer } 752e507e0e5SFrank Schaefer 753e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 754e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 755e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 756e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 757e507e0e5SFrank Schaefer } 758f9fe90a4SMauro Carvalho Chehab /* 759f9fe90a4SMauro Carvalho Chehab * NOTE: in ISOC mode when a new frame starts and buf==NULL, 760e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 761e507e0e5SFrank Schaefer * first frame. 762e507e0e5SFrank Schaefer */ 763e507e0e5SFrank Schaefer } 764e507e0e5SFrank Schaefer 765e507e0e5SFrank Schaefer /* Copy data */ 766f9fe90a4SMauro Carvalho Chehab if (buf && data_len > 0) 767e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 768e507e0e5SFrank Schaefer 769e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 770e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 771e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 772e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 773e507e0e5SFrank Schaefer } 774e507e0e5SFrank Schaefer 775f9fe90a4SMauro Carvalho Chehab /* 776f9fe90a4SMauro Carvalho Chehab * NOTES: 777f9fe90a4SMauro Carvalho Chehab * 778f9fe90a4SMauro Carvalho Chehab * 1) Tested with USB bulk transfers only ! 779e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 780e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 781e507e0e5SFrank Schaefer * header like with the other em28xx devices. 782f9fe90a4SMauro Carvalho Chehab * 783f9fe90a4SMauro Carvalho Chehab * 2) Support for interlaced mode is pure theory. It has not been 784f9fe90a4SMauro Carvalho Chehab * tested and it is unknown if these devices actually support it. 785e507e0e5SFrank Schaefer */ 786e507e0e5SFrank Schaefer } 787e507e0e5SFrank Schaefer 788960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7890fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7900c0d06caSMauro Carvalho Chehab { 791227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 792227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 793227b7c90SFrank Schaefer unsigned int usb_data_len; 7940c0d06caSMauro Carvalho Chehab 7950c0d06caSMauro Carvalho Chehab if (!dev) 7960c0d06caSMauro Carvalho Chehab return 0; 7970c0d06caSMauro Carvalho Chehab 7982665c299SFrank Schaefer if (dev->disconnected) 7990c0d06caSMauro Carvalho Chehab return 0; 8000c0d06caSMauro Carvalho Chehab 8011653cb0cSFrank Schaefer if (urb->status < 0) 8020c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 8030c0d06caSMauro Carvalho Chehab 8044601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 8054601cc39SFrank Schaefer 8064601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 8074601cc39SFrank Schaefer num_packets = 1; 8084601cc39SFrank Schaefer else /* isoc */ 8094601cc39SFrank Schaefer num_packets = urb->number_of_packets; 8100c0d06caSMauro Carvalho Chehab 8114601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 8124601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 813227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 8144601cc39SFrank Schaefer 815227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 8164601cc39SFrank Schaefer } else { /* isoc */ 8174601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 8184601cc39SFrank Schaefer print_err_status(dev, i, 8194601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8200c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8210c0d06caSMauro Carvalho Chehab continue; 8220c0d06caSMauro Carvalho Chehab } 8230c0d06caSMauro Carvalho Chehab 824227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 825227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8260c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8270c0d06caSMauro Carvalho Chehab continue; 8280c0d06caSMauro Carvalho Chehab } 8290c0d06caSMauro Carvalho Chehab 830227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8314601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8324601cc39SFrank Schaefer } 8334601cc39SFrank Schaefer 834227b7c90SFrank Schaefer if (usb_data_len == 0) { 8354601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8364601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8374601cc39SFrank Schaefer continue; 8384601cc39SFrank Schaefer } 8390c0d06caSMauro Carvalho Chehab 840e507e0e5SFrank Schaefer if (dev->is_em25xx) 841e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 842e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 843e507e0e5SFrank Schaefer else 844e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 845e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 8460c0d06caSMauro Carvalho Chehab } 847227b7c90SFrank Schaefer return 1; 8480c0d06caSMauro Carvalho Chehab } 8490c0d06caSMauro Carvalho Chehab 850f9fe90a4SMauro Carvalho Chehab static int get_resource(enum v4l2_buf_type f_type) 851d3829fadSDevin Heitmueller { 852d3829fadSDevin Heitmueller switch (f_type) { 853d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 854d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 855d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 856d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 857d3829fadSDevin Heitmueller default: 858f9fe90a4SMauro Carvalho Chehab WARN_ON(1); 859f9fe90a4SMauro Carvalho Chehab return -1; /* Indicate that device is busy */ 860d3829fadSDevin Heitmueller } 861d3829fadSDevin Heitmueller } 862d3829fadSDevin Heitmueller 863d3829fadSDevin Heitmueller /* Usage lock check functions */ 864d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 865d3829fadSDevin Heitmueller { 866f9fe90a4SMauro Carvalho Chehab int res_type = get_resource(f_type); 867d3829fadSDevin Heitmueller 868d3829fadSDevin Heitmueller /* is it free? */ 869d3829fadSDevin Heitmueller if (dev->resources & res_type) { 870d3829fadSDevin Heitmueller /* no, someone else uses it */ 871d3829fadSDevin Heitmueller return -EBUSY; 872d3829fadSDevin Heitmueller } 873d3829fadSDevin Heitmueller 874d3829fadSDevin Heitmueller /* it's free, grab it */ 875d3829fadSDevin Heitmueller dev->resources |= res_type; 876d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 877d3829fadSDevin Heitmueller return 0; 878d3829fadSDevin Heitmueller } 879d3829fadSDevin Heitmueller 880d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 881d3829fadSDevin Heitmueller { 882f9fe90a4SMauro Carvalho Chehab int res_type = get_resource(f_type); 883d3829fadSDevin Heitmueller 884d3829fadSDevin Heitmueller dev->resources &= ~res_type; 885d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 886d3829fadSDevin Heitmueller } 887d3829fadSDevin Heitmueller 88837ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev) 88937ecc7b1SMauro Carvalho Chehab { 89037ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 89137ecc7b1SMauro Carvalho Chehab int i; 89237ecc7b1SMauro Carvalho Chehab 89337ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 89437ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 89537ecc7b1SMauro Carvalho Chehab return; 89637ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]); 89737ecc7b1SMauro Carvalho Chehab } 89837ecc7b1SMauro Carvalho Chehab #endif 89937ecc7b1SMauro Carvalho Chehab } 90037ecc7b1SMauro Carvalho Chehab 90137ecc7b1SMauro Carvalho Chehab /* 90237ecc7b1SMauro Carvalho Chehab * Media Controller helper functions 90337ecc7b1SMauro Carvalho Chehab */ 90437ecc7b1SMauro Carvalho Chehab 90537ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev) 90637ecc7b1SMauro Carvalho Chehab { 90737ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 90837ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev; 90937ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 91037ecc7b1SMauro Carvalho Chehab struct media_entity *source; 91137ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL; 91237ecc7b1SMauro Carvalho Chehab int ret, active_links = 0; 91337ecc7b1SMauro Carvalho Chehab 91437ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder) 91537ecc7b1SMauro Carvalho Chehab return 0; 91637ecc7b1SMauro Carvalho Chehab 91737ecc7b1SMauro Carvalho Chehab /* 91837ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder. 91937ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be 92037ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't 92137ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2, 92237ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs. 92337ecc7b1SMauro Carvalho Chehab */ 92437ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) { 92537ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) { 92637ecc7b1SMauro Carvalho Chehab found_link = link; 92737ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED) 92837ecc7b1SMauro Carvalho Chehab active_links++; 92937ecc7b1SMauro Carvalho Chehab break; 93037ecc7b1SMauro Carvalho Chehab } 93137ecc7b1SMauro Carvalho Chehab } 93237ecc7b1SMauro Carvalho Chehab 93337ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link) 93437ecc7b1SMauro Carvalho Chehab return 0; 93537ecc7b1SMauro Carvalho Chehab 93637ecc7b1SMauro Carvalho Chehab source = found_link->source->entity; 93737ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) { 93837ecc7b1SMauro Carvalho Chehab struct media_entity *sink; 93937ecc7b1SMauro Carvalho Chehab int flags = 0; 94037ecc7b1SMauro Carvalho Chehab 94137ecc7b1SMauro Carvalho Chehab sink = link->sink->entity; 94237ecc7b1SMauro Carvalho Chehab 94337ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder) 94437ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED; 94537ecc7b1SMauro Carvalho Chehab 94637ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags); 94737ecc7b1SMauro Carvalho Chehab if (ret) { 94829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 949ce8591ffSMauro Carvalho Chehab "Couldn't change link %s->%s to %s. Error %d\n", 95037ecc7b1SMauro Carvalho Chehab source->name, sink->name, 95137ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled", 95237ecc7b1SMauro Carvalho Chehab ret); 95337ecc7b1SMauro Carvalho Chehab return ret; 954f9fe90a4SMauro Carvalho Chehab } 955f9fe90a4SMauro Carvalho Chehab 95637ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n", 95737ecc7b1SMauro Carvalho Chehab source->name, sink->name, 95837ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled"); 95937ecc7b1SMauro Carvalho Chehab } 96037ecc7b1SMauro Carvalho Chehab #endif 96137ecc7b1SMauro Carvalho Chehab return 0; 96237ecc7b1SMauro Carvalho Chehab } 96337ecc7b1SMauro Carvalho Chehab 96437ecc7b1SMauro Carvalho Chehab static const char * const iname[] = { 96537ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite", 96637ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 96737ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 96837ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio", 96937ecc7b1SMauro Carvalho Chehab }; 97037ecc7b1SMauro Carvalho Chehab 97137ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev) 97237ecc7b1SMauro Carvalho Chehab { 97337ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER) 97437ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 97537ecc7b1SMauro Carvalho Chehab int ret, i; 97637ecc7b1SMauro Carvalho Chehab 97737ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */ 97837ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK; 97937ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad); 98037ecc7b1SMauro Carvalho Chehab if (ret < 0) 98129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 982ce8591ffSMauro Carvalho Chehab "failed to initialize video media entity!\n"); 98337ecc7b1SMauro Carvalho Chehab 98437ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) { 98537ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK; 98637ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1, 98737ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad); 98837ecc7b1SMauro Carvalho Chehab if (ret < 0) 98929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 990ce8591ffSMauro Carvalho Chehab "failed to initialize vbi media entity!\n"); 99137ecc7b1SMauro Carvalho Chehab } 99237ecc7b1SMauro Carvalho Chehab 99337ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */ 994aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 99537ecc7b1SMauro Carvalho Chehab return; 99637ecc7b1SMauro Carvalho Chehab 99737ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */ 99837ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 99937ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i]; 100037ecc7b1SMauro Carvalho Chehab 100137ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 100237ecc7b1SMauro Carvalho Chehab break; 100337ecc7b1SMauro Carvalho Chehab 100437ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type]; 100537ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR; 100637ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 100737ecc7b1SMauro Carvalho Chehab 100837ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) { 100937ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE: 101037ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 101137ecc7b1SMauro Carvalho Chehab break; 101237ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO: 101337ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO; 101437ecc7b1SMauro Carvalho Chehab break; 101537ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */ 1016e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 101737ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF; 101837ecc7b1SMauro Carvalho Chehab break; 101937ecc7b1SMauro Carvalho Chehab } 102037ecc7b1SMauro Carvalho Chehab 102137ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 102237ecc7b1SMauro Carvalho Chehab if (ret < 0) 102329b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1024ce8591ffSMauro Carvalho Chehab "failed to initialize input pad[%d]!\n", i); 102537ecc7b1SMauro Carvalho Chehab 102637ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent); 102737ecc7b1SMauro Carvalho Chehab if (ret < 0) 102829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1029ce8591ffSMauro Carvalho Chehab "failed to register input entity %d!\n", i); 103037ecc7b1SMauro Carvalho Chehab } 103137ecc7b1SMauro Carvalho Chehab #endif 103237ecc7b1SMauro Carvalho Chehab } 103337ecc7b1SMauro Carvalho Chehab 1034f9fe90a4SMauro Carvalho Chehab /* 1035f9fe90a4SMauro Carvalho Chehab * Videobuf2 operations 1036f9fe90a4SMauro Carvalho Chehab */ 10370c0d06caSMauro Carvalho Chehab 1038df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq, 1039d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 104036c0f8b3SHans Verkuil unsigned int sizes[], struct device *alloc_devs[]) 10410c0d06caSMauro Carvalho Chehab { 1042d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1043753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1044df9ecb0cSHans Verkuil unsigned long size = 104506e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 10460c0d06caSMauro Carvalho Chehab 1047df9ecb0cSHans Verkuil if (*nplanes) 1048df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0; 1049d3829fadSDevin Heitmueller *nplanes = 1; 1050d3829fadSDevin Heitmueller sizes[0] = size; 105137ecc7b1SMauro Carvalho Chehab 105237ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev); 105337ecc7b1SMauro Carvalho Chehab 10540c0d06caSMauro Carvalho Chehab return 0; 10550c0d06caSMauro Carvalho Chehab } 10560c0d06caSMauro Carvalho Chehab 10570c0d06caSMauro Carvalho Chehab static int 1058d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 10590c0d06caSMauro Carvalho Chehab { 10602d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1061d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1062753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1063d3829fadSDevin Heitmueller unsigned long size; 10640c0d06caSMauro Carvalho Chehab 10652d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field); 10660c0d06caSMauro Carvalho Chehab 106706e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 1068d3829fadSDevin Heitmueller 1069d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 1070d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 1071d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 10720c0d06caSMauro Carvalho Chehab return -EINVAL; 1073d3829fadSDevin Heitmueller } 10742d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size); 10750c0d06caSMauro Carvalho Chehab 1076d3829fadSDevin Heitmueller return 0; 10770c0d06caSMauro Carvalho Chehab } 10780c0d06caSMauro Carvalho Chehab 1079d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 1080d3829fadSDevin Heitmueller { 1081d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1082f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1083d3829fadSDevin Heitmueller struct v4l2_frequency f; 10842d700715SJunghak Sung struct v4l2_fh *owner; 1085d3829fadSDevin Heitmueller int rc = 0; 10860c0d06caSMauro Carvalho Chehab 1087d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1088d3829fadSDevin Heitmueller 1089afeaade9SMauro Carvalho Chehab dev->v4l2->field_count = 0; 1090afeaade9SMauro Carvalho Chehab 1091f9fe90a4SMauro Carvalho Chehab /* 1092f9fe90a4SMauro Carvalho Chehab * Make sure streaming is not already in progress for this type 1093f9fe90a4SMauro Carvalho Chehab * of filehandle (e.g. video, vbi) 1094f9fe90a4SMauro Carvalho Chehab */ 1095d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1096d3829fadSDevin Heitmueller if (rc) 1097d3829fadSDevin Heitmueller return rc; 1098d3829fadSDevin Heitmueller 10998139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1100d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1101d3829fadSDevin Heitmueller 1102d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1103d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1104d3829fadSDevin Heitmueller 1105f9fe90a4SMauro Carvalho Chehab /* 1106f9fe90a4SMauro Carvalho Chehab * Needed, since GPIO might have disabled power of 1107f9fe90a4SMauro Carvalho Chehab * some i2c device 1108d3829fadSDevin Heitmueller */ 1109d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1110d3829fadSDevin Heitmueller 1111f0e38230SFrank Schaefer v4l2->capture_type = -1; 1112c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1113c647a91aSFrank Schaefer dev->analog_xfer_bulk, 11140c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 11150c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1116c647a91aSFrank Schaefer dev->packet_multiplier, 11170fa4a402SFrank Schaefer em28xx_urb_data_copy); 11180c0d06caSMauro Carvalho Chehab if (rc < 0) 1119032f1ddfSFrank Schaefer return rc; 1120d3829fadSDevin Heitmueller 1121d3829fadSDevin Heitmueller /* 1122d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1123d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1124d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1125d3829fadSDevin Heitmueller */ 1126d3829fadSDevin Heitmueller 1127d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1128d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11293854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11302d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11312d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1132d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1133d3829fadSDevin Heitmueller else 1134d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1135f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 113695d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 113713d52fe4SMauro Carvalho Chehab 113813d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 113913d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11400c0d06caSMauro Carvalho Chehab } 11410c0d06caSMauro Carvalho Chehab 11428139a4d5SFrank Schaefer v4l2->streaming_users++; 1143032f1ddfSFrank Schaefer 11440c0d06caSMauro Carvalho Chehab return rc; 11450c0d06caSMauro Carvalho Chehab } 11460c0d06caSMauro Carvalho Chehab 1147e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11480c0d06caSMauro Carvalho Chehab { 1149d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11508139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11510c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1152d3829fadSDevin Heitmueller unsigned long flags = 0; 11530c0d06caSMauro Carvalho Chehab 1154d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11550c0d06caSMauro Carvalho Chehab 1156d3829fadSDevin Heitmueller res_free(dev, vq->type); 1157d3829fadSDevin Heitmueller 11588139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 115913d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 116013d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 116113d52fe4SMauro Carvalho Chehab 1162d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1163d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11640c0d06caSMauro Carvalho Chehab } 11650c0d06caSMauro Carvalho Chehab 1166d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1167f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vid_buf) { 11682d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11692d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1170627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1171627530c3SFrank Schaefer } 1172d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1173d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1174fdf1bc9fSMauro Carvalho Chehab 1175d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1176d3829fadSDevin Heitmueller list_del(&buf->list); 11772d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1178d3829fadSDevin Heitmueller } 1179d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1180d3829fadSDevin Heitmueller } 1181d3829fadSDevin Heitmueller 1182e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11830c0d06caSMauro Carvalho Chehab { 1184d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11858139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1186d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1187d3829fadSDevin Heitmueller unsigned long flags = 0; 11880c0d06caSMauro Carvalho Chehab 1189d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11900c0d06caSMauro Carvalho Chehab 1191d3829fadSDevin Heitmueller res_free(dev, vq->type); 1192d3829fadSDevin Heitmueller 11938139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 119413d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 119513d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 119613d52fe4SMauro Carvalho Chehab 1197d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1198d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11990c0d06caSMauro Carvalho Chehab } 12000c0d06caSMauro Carvalho Chehab 1201d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1202f9fe90a4SMauro Carvalho Chehab if (dev->usb_ctl.vbi_buf) { 12032d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 12042d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1205627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1206627530c3SFrank Schaefer } 1207d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1208d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1209fdf1bc9fSMauro Carvalho Chehab 1210d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1211d3829fadSDevin Heitmueller list_del(&buf->list); 12122d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1213d3829fadSDevin Heitmueller } 1214d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1215d3829fadSDevin Heitmueller } 1216d3829fadSDevin Heitmueller 1217d3829fadSDevin Heitmueller static void 1218d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1219d3829fadSDevin Heitmueller { 12202d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1221d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 12222d700715SJunghak Sung struct em28xx_buffer *buf = 12232d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1224d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1225d3829fadSDevin Heitmueller unsigned long flags = 0; 1226d3829fadSDevin Heitmueller 1227d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1228d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1229d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1230d3829fadSDevin Heitmueller 1231d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1232d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1233d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1234d3829fadSDevin Heitmueller } 1235d3829fadSDevin Heitmueller 12361bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = { 1237d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12380c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12390c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1240d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1241d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1242d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1243d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12440c0d06caSMauro Carvalho Chehab }; 12450c0d06caSMauro Carvalho Chehab 124601c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1247d3829fadSDevin Heitmueller { 1248d3829fadSDevin Heitmueller int rc; 1249d3829fadSDevin Heitmueller struct vb2_queue *q; 125027a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1251d3829fadSDevin Heitmueller 1252d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 125327a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1254d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1255ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1256ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1257d3829fadSDevin Heitmueller q->drv_priv = dev; 1258d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1259d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1260d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1261d3829fadSDevin Heitmueller 1262d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1263d3829fadSDevin Heitmueller if (rc < 0) 1264d3829fadSDevin Heitmueller return rc; 1265d3829fadSDevin Heitmueller 1266d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 126727a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1268d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1269d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1270ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1271d3829fadSDevin Heitmueller q->drv_priv = dev; 1272d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1273d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1274d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1275d3829fadSDevin Heitmueller 1276d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1277d3829fadSDevin Heitmueller if (rc < 0) 1278d3829fadSDevin Heitmueller return rc; 1279d3829fadSDevin Heitmueller 1280d3829fadSDevin Heitmueller return 0; 1281d3829fadSDevin Heitmueller } 1282d3829fadSDevin Heitmueller 1283f9fe90a4SMauro Carvalho Chehab /* 1284f9fe90a4SMauro Carvalho Chehab * v4l2 interface 1285f9fe90a4SMauro Carvalho Chehab */ 12860c0d06caSMauro Carvalho Chehab 12870c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12880c0d06caSMauro Carvalho Chehab { 128995d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1290fdf1bc9fSMauro Carvalho Chehab 12910c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12920c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 12930c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 12940c0d06caSMauro Carvalho Chehab 12950c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 12960c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 12970c0d06caSMauro Carvalho Chehab 129895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 12990c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 13000c0d06caSMauro Carvalho Chehab 1301aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 13020c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 130395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 13040c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 13050c0d06caSMauro Carvalho Chehab } 13060c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 130795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1308fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1309fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 13100c0d06caSMauro Carvalho Chehab } 13110c0d06caSMauro Carvalho Chehab 13120c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 131395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 13140c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 13150c0d06caSMauro Carvalho Chehab } 13160c0d06caSMauro Carvalho Chehab 13170c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 13180c0d06caSMauro Carvalho Chehab } 13190c0d06caSMauro Carvalho Chehab 132001c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 13210c0d06caSMauro Carvalho Chehab { 1322081b945eSHans Verkuil struct em28xx *dev = priv; 13230c0d06caSMauro Carvalho Chehab 13240c0d06caSMauro Carvalho Chehab /* 1325081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1326081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1327081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1328081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 13290c0d06caSMauro Carvalho Chehab */ 13300c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13310c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1332081b945eSHans Verkuil dev->mute = ctrl->val; 1333081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13340c0d06caSMauro Carvalho Chehab break; 13350c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1336081b945eSHans Verkuil dev->volume = ctrl->val; 1337081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1338081b945eSHans Verkuil break; 1339081b945eSHans Verkuil } 1340081b945eSHans Verkuil } 1341081b945eSHans Verkuil 1342081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1343081b945eSHans Verkuil { 1344abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1345abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1346abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13478f8b113aSFrank Schaefer int ret = -EINVAL; 1348081b945eSHans Verkuil 1349081b945eSHans Verkuil switch (ctrl->id) { 1350081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1351081b945eSHans Verkuil dev->mute = ctrl->val; 13528f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1353081b945eSHans Verkuil break; 1354081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1355081b945eSHans Verkuil dev->volume = ctrl->val; 13568f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13578f8b113aSFrank Schaefer break; 13588f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13598f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13608f8b113aSFrank Schaefer break; 13618f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13628f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13638f8b113aSFrank Schaefer break; 13648f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13658f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13668f8b113aSFrank Schaefer break; 13678f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13688f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13698f8b113aSFrank Schaefer break; 13708f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13718f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13728f8b113aSFrank Schaefer break; 13738f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13748f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13750c0d06caSMauro Carvalho Chehab break; 13760c0d06caSMauro Carvalho Chehab } 13770c0d06caSMauro Carvalho Chehab 13788f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13790c0d06caSMauro Carvalho Chehab } 13800c0d06caSMauro Carvalho Chehab 13818068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1382081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1383081b945eSHans Verkuil }; 1384081b945eSHans Verkuil 13856b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13860c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13870c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13880c0d06caSMauro Carvalho Chehab { 13890c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13900c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13910c0d06caSMauro Carvalho Chehab 13920c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 139381685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 139481685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 13950c0d06caSMauro Carvalho Chehab 13960c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 139781685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 139881685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 13990c0d06caSMauro Carvalho Chehab } 14000c0d06caSMauro Carvalho Chehab 1401b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1402b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1403b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1404b8374138SFrank Schaefer { 1405b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1406b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1407b8374138SFrank Schaefer 1408b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1409b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 14100962a763SMauro Carvalho Chehab 14110962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 14120962a763SMauro Carvalho Chehab if (*width < 1) 14130962a763SMauro Carvalho Chehab *width = 1; 14140962a763SMauro Carvalho Chehab if (*height < 1) 14150962a763SMauro Carvalho Chehab *height = 1; 1416b8374138SFrank Schaefer } 1417b8374138SFrank Schaefer 1418f9fe90a4SMauro Carvalho Chehab /* 1419f9fe90a4SMauro Carvalho Chehab * IOCTL vidioc handling 1420f9fe90a4SMauro Carvalho Chehab */ 14210c0d06caSMauro Carvalho Chehab 14220c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 14230c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14240c0d06caSMauro Carvalho Chehab { 1425917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1426753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14270c0d06caSMauro Carvalho Chehab 1428753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1429753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 143006e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 143106e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1432753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14330c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14340c0d06caSMauro Carvalho Chehab 14350c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 143658159171SFrank Schaefer if (v4l2->progressive) 14370c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14380c0d06caSMauro Carvalho Chehab else 143958159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14400c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14410c0d06caSMauro Carvalho Chehab return 0; 14420c0d06caSMauro Carvalho Chehab } 14430c0d06caSMauro Carvalho Chehab 14440c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14450c0d06caSMauro Carvalho Chehab { 14460c0d06caSMauro Carvalho Chehab unsigned int i; 14470c0d06caSMauro Carvalho Chehab 14480c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14490c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14500c0d06caSMauro Carvalho Chehab return &format[i]; 14510c0d06caSMauro Carvalho Chehab 14520c0d06caSMauro Carvalho Chehab return NULL; 14530c0d06caSMauro Carvalho Chehab } 14540c0d06caSMauro Carvalho Chehab 14550c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14560c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14570c0d06caSMauro Carvalho Chehab { 1458917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 145958159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14600c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14610c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14620c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14630c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14640c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14650c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14660c0d06caSMauro Carvalho Chehab 14670c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14680c0d06caSMauro Carvalho Chehab if (!fmt) { 1469f823ce2aSMauro Carvalho Chehab fmt = &format[0]; 1470f823ce2aSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid. Using default (%08x).\n", 1471f823ce2aSMauro Carvalho Chehab f->fmt.pix.pixelformat, fmt->fourcc); 14720c0d06caSMauro Carvalho Chehab } 14730c0d06caSMauro Carvalho Chehab 14740c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14750c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14760c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14770c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1478d3829fadSDevin Heitmueller /* 1479d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1480d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1481d3829fadSDevin Heitmueller * to 50% 1482d3829fadSDevin Heitmueller */ 14830c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14840c0d06caSMauro Carvalho Chehab width /= 2; 14850c0d06caSMauro Carvalho Chehab } else { 1486f9fe90a4SMauro Carvalho Chehab /* 1487f9fe90a4SMauro Carvalho Chehab * width must even because of the YUYV format 1488f9fe90a4SMauro Carvalho Chehab * height must be even because of interlacing 1489f9fe90a4SMauro Carvalho Chehab */ 14900c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14910c0d06caSMauro Carvalho Chehab 1, 0); 14920c0d06caSMauro Carvalho Chehab } 14930962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 14940962a763SMauro Carvalho Chehab if (width < 1) 14950962a763SMauro Carvalho Chehab width = 1; 14960962a763SMauro Carvalho Chehab if (height < 1) 14970962a763SMauro Carvalho Chehab height = 1; 14980c0d06caSMauro Carvalho Chehab 14996b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 150046f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 15010c0d06caSMauro Carvalho Chehab 15020c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 15030c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 15040c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1505e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 15060c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 15070c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 150858159171SFrank Schaefer if (v4l2->progressive) 15090c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 15100c0d06caSMauro Carvalho Chehab else 151158159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 15120c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab return 0; 15150c0d06caSMauro Carvalho Chehab } 15160c0d06caSMauro Carvalho Chehab 15170c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 1518f9fe90a4SMauro Carvalho Chehab unsigned int width, unsigned int height) 15190c0d06caSMauro Carvalho Chehab { 15200c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1521753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 15240c0d06caSMauro Carvalho Chehab if (!fmt) 15250c0d06caSMauro Carvalho Chehab return -EINVAL; 15260c0d06caSMauro Carvalho Chehab 152706e20672SFrank Schaefer v4l2->format = fmt; 1528753aee77SFrank Schaefer v4l2->width = width; 1529753aee77SFrank Schaefer v4l2->height = height; 15300c0d06caSMauro Carvalho Chehab 15310c0d06caSMauro Carvalho Chehab /* set new image size */ 1532753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1533753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15360c0d06caSMauro Carvalho Chehab 15370c0d06caSMauro Carvalho Chehab return 0; 15380c0d06caSMauro Carvalho Chehab } 15390c0d06caSMauro Carvalho Chehab 15400c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15410c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15420c0d06caSMauro Carvalho Chehab { 1543d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15448139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15450c0d06caSMauro Carvalho Chehab 1546c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1547d3829fadSDevin Heitmueller return -EBUSY; 15480c0d06caSMauro Carvalho Chehab 15490c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15500c0d06caSMauro Carvalho Chehab 15510c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15520c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15530c0d06caSMauro Carvalho Chehab } 15540c0d06caSMauro Carvalho Chehab 15550c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15560c0d06caSMauro Carvalho Chehab { 1557917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15580c0d06caSMauro Carvalho Chehab 155952faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15600c0d06caSMauro Carvalho Chehab 15610c0d06caSMauro Carvalho Chehab return 0; 15620c0d06caSMauro Carvalho Chehab } 15630c0d06caSMauro Carvalho Chehab 15640c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15650c0d06caSMauro Carvalho Chehab { 1566917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15670c0d06caSMauro Carvalho Chehab 156895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15690c0d06caSMauro Carvalho Chehab 15700c0d06caSMauro Carvalho Chehab return 0; 15710c0d06caSMauro Carvalho Chehab } 15720c0d06caSMauro Carvalho Chehab 1573314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15740c0d06caSMauro Carvalho Chehab { 1575917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1576753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15770c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15780c0d06caSMauro Carvalho Chehab 157952faaf78SFrank Schaefer if (norm == v4l2->norm) 1580d8c95c08SHans Verkuil return 0; 15810c0d06caSMauro Carvalho Chehab 15828139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1583d8c95c08SHans Verkuil return -EBUSY; 1584d8c95c08SHans Verkuil 158552faaf78SFrank Schaefer v4l2->norm = norm; 15860c0d06caSMauro Carvalho Chehab 15870c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1588d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1589314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15900c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15910c0d06caSMauro Carvalho Chehab 15920c0d06caSMauro Carvalho Chehab /* set new image size */ 1593753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1594753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1595753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1596753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15970c0d06caSMauro Carvalho Chehab 15980c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15998774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 16000c0d06caSMauro Carvalho Chehab 16010c0d06caSMauro Carvalho Chehab return 0; 16020c0d06caSMauro Carvalho Chehab } 16030c0d06caSMauro Carvalho Chehab 16040c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 16050c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16060c0d06caSMauro Carvalho Chehab { 16074471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 0 }; 1608917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 160952faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 16100c0d06caSMauro Carvalho Chehab int rc = 0; 16110c0d06caSMauro Carvalho Chehab 16124471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16134471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16144471109eSHans Verkuil return -EINVAL; 16154471109eSHans Verkuil 161686ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16174471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 1618aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 161952faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 16204471109eSHans Verkuil video, g_frame_interval, &ival); 16214471109eSHans Verkuil if (!rc) 16224471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16234471109eSHans Verkuil } else { 162452faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 16250c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 16264471109eSHans Verkuil } 16270c0d06caSMauro Carvalho Chehab 16280c0d06caSMauro Carvalho Chehab return rc; 16290c0d06caSMauro Carvalho Chehab } 16300c0d06caSMauro Carvalho Chehab 16310c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 16320c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 16330c0d06caSMauro Carvalho Chehab { 1634917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16354471109eSHans Verkuil struct v4l2_subdev_frame_interval ival = { 16364471109eSHans Verkuil 0, 16374471109eSHans Verkuil p->parm.capture.timeperframe 16384471109eSHans Verkuil }; 16394471109eSHans Verkuil int rc = 0; 16400c0d06caSMauro Carvalho Chehab 1641aa62980bSMauro Carvalho Chehab if (!dev->is_webcam) 16424471109eSHans Verkuil return -ENOTTY; 16434471109eSHans Verkuil 16444471109eSHans Verkuil if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE && 16454471109eSHans Verkuil p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE) 16464471109eSHans Verkuil return -EINVAL; 16474471109eSHans Verkuil 16484471109eSHans Verkuil memset(&p->parm, 0, sizeof(p->parm)); 164986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 16504471109eSHans Verkuil p->parm.capture.capability = V4L2_CAP_TIMEPERFRAME; 16514471109eSHans Verkuil rc = v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 0, 16524471109eSHans Verkuil video, s_frame_interval, &ival); 16534471109eSHans Verkuil if (!rc) 16544471109eSHans Verkuil p->parm.capture.timeperframe = ival.interval; 16554471109eSHans Verkuil return rc; 16560c0d06caSMauro Carvalho Chehab } 16570c0d06caSMauro Carvalho Chehab 16580c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16590c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16600c0d06caSMauro Carvalho Chehab { 1661917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16620c0d06caSMauro Carvalho Chehab unsigned int n; 1663258c4304SMauro Carvalho Chehab int j; 16640c0d06caSMauro Carvalho Chehab 16650c0d06caSMauro Carvalho Chehab n = i->index; 16660c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16670c0d06caSMauro Carvalho Chehab return -EINVAL; 1668f9fe90a4SMauro Carvalho Chehab if (!INPUT(n)->type) 16690c0d06caSMauro Carvalho Chehab return -EINVAL; 16700c0d06caSMauro Carvalho Chehab 16710c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16720c0d06caSMauro Carvalho Chehab 1673cc1e6315SMauro Carvalho Chehab strscpy(i->name, iname[INPUT(n)->type], sizeof(i->name)); 16740c0d06caSMauro Carvalho Chehab 1675f9fe90a4SMauro Carvalho Chehab if (INPUT(n)->type == EM28XX_VMUX_TELEVISION) 16760c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16770c0d06caSMauro Carvalho Chehab 1678d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1679d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1680aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 1681d8c95c08SHans Verkuil i->capabilities = 0; 16820c0d06caSMauro Carvalho Chehab 1683258c4304SMauro Carvalho Chehab /* Dynamically generates an audioset bitmask */ 1684258c4304SMauro Carvalho Chehab i->audioset = 0; 1685258c4304SMauro Carvalho Chehab for (j = 0; j < MAX_EM28XX_INPUT; j++) 1686258c4304SMauro Carvalho Chehab if (dev->amux_map[j] != EM28XX_AMUX_UNUSED) 1687258c4304SMauro Carvalho Chehab i->audioset |= 1 << j; 1688258c4304SMauro Carvalho Chehab 16890c0d06caSMauro Carvalho Chehab return 0; 16900c0d06caSMauro Carvalho Chehab } 16910c0d06caSMauro Carvalho Chehab 16920c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16930c0d06caSMauro Carvalho Chehab { 1694917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16950c0d06caSMauro Carvalho Chehab 16960c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 16970c0d06caSMauro Carvalho Chehab 16980c0d06caSMauro Carvalho Chehab return 0; 16990c0d06caSMauro Carvalho Chehab } 17000c0d06caSMauro Carvalho Chehab 17010c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 17020c0d06caSMauro Carvalho Chehab { 1703917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17040c0d06caSMauro Carvalho Chehab 17050c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 17060c0d06caSMauro Carvalho Chehab return -EINVAL; 1707f9fe90a4SMauro Carvalho Chehab if (!INPUT(i)->type) 17080c0d06caSMauro Carvalho Chehab return -EINVAL; 17090c0d06caSMauro Carvalho Chehab 17100c0d06caSMauro Carvalho Chehab video_mux(dev, i); 17110c0d06caSMauro Carvalho Chehab return 0; 17120c0d06caSMauro Carvalho Chehab } 17130c0d06caSMauro Carvalho Chehab 1714258c4304SMauro Carvalho Chehab static int em28xx_fill_audio_input(struct em28xx *dev, 1715258c4304SMauro Carvalho Chehab const char *s, 1716258c4304SMauro Carvalho Chehab struct v4l2_audio *a, 1717258c4304SMauro Carvalho Chehab unsigned int index) 17180c0d06caSMauro Carvalho Chehab { 1719258c4304SMauro Carvalho Chehab unsigned int idx = dev->amux_map[index]; 17200c0d06caSMauro Carvalho Chehab 1721258c4304SMauro Carvalho Chehab /* 1722258c4304SMauro Carvalho Chehab * With msp3400, almost all mappings use the default (amux = 0). 1723258c4304SMauro Carvalho Chehab * The only one may use a different value is WinTV USB2, where it 1724258c4304SMauro Carvalho Chehab * can also be SCART1 input. 1725258c4304SMauro Carvalho Chehab * As it is very doubtful that we would see new boards with msp3400, 1726258c4304SMauro Carvalho Chehab * let's just reuse the existing switch. 1727258c4304SMauro Carvalho Chehab */ 1728258c4304SMauro Carvalho Chehab if (dev->has_msp34xx && idx != EM28XX_AMUX_UNUSED) 1729258c4304SMauro Carvalho Chehab idx = EM28XX_AMUX_LINE_IN; 1730258c4304SMauro Carvalho Chehab 1731258c4304SMauro Carvalho Chehab switch (idx) { 17320c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 1733cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television", sizeof(a->name)); 17340c0d06caSMauro Carvalho Chehab break; 17350c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 1736cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Line In", sizeof(a->name)); 17370c0d06caSMauro Carvalho Chehab break; 17380c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 1739cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Television alt", sizeof(a->name)); 17400c0d06caSMauro Carvalho Chehab break; 17410c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 1742cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Phone", sizeof(a->name)); 17430c0d06caSMauro Carvalho Chehab break; 17440c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 1745cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Mic", sizeof(a->name)); 17460c0d06caSMauro Carvalho Chehab break; 17470c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 1748cc1e6315SMauro Carvalho Chehab strscpy(a->name, "CD", sizeof(a->name)); 17490c0d06caSMauro Carvalho Chehab break; 17500c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 1751cc1e6315SMauro Carvalho Chehab strscpy(a->name, "Aux", sizeof(a->name)); 17520c0d06caSMauro Carvalho Chehab break; 17530c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 1754cc1e6315SMauro Carvalho Chehab strscpy(a->name, "PCM", sizeof(a->name)); 17550c0d06caSMauro Carvalho Chehab break; 1756258c4304SMauro Carvalho Chehab case EM28XX_AMUX_UNUSED: 17570c0d06caSMauro Carvalho Chehab default: 17580c0d06caSMauro Carvalho Chehab return -EINVAL; 17590c0d06caSMauro Carvalho Chehab } 1760258c4304SMauro Carvalho Chehab a->index = index; 17610c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 17620c0d06caSMauro Carvalho Chehab 1763258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: audio input index %d is '%s'\n", 1764258c4304SMauro Carvalho Chehab s, a->index, a->name); 1765258c4304SMauro Carvalho Chehab 17660c0d06caSMauro Carvalho Chehab return 0; 17670c0d06caSMauro Carvalho Chehab } 17680c0d06caSMauro Carvalho Chehab 1769258c4304SMauro Carvalho Chehab static int vidioc_enumaudio(struct file *file, void *fh, struct v4l2_audio *a) 1770258c4304SMauro Carvalho Chehab { 1771258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file); 1772258c4304SMauro Carvalho Chehab 1773258c4304SMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 1774258c4304SMauro Carvalho Chehab return -EINVAL; 1775258c4304SMauro Carvalho Chehab 1776258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, a->index); 1777258c4304SMauro Carvalho Chehab } 1778258c4304SMauro Carvalho Chehab 1779258c4304SMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 1780258c4304SMauro Carvalho Chehab { 1781258c4304SMauro Carvalho Chehab struct em28xx *dev = video_drvdata(file); 1782258c4304SMauro Carvalho Chehab int i; 1783258c4304SMauro Carvalho Chehab 1784258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) 1785258c4304SMauro Carvalho Chehab if (dev->ctl_ainput == dev->amux_map[i]) 1786258c4304SMauro Carvalho Chehab return em28xx_fill_audio_input(dev, __func__, a, i); 1787258c4304SMauro Carvalho Chehab 1788258c4304SMauro Carvalho Chehab /* Should never happen! */ 1789258c4304SMauro Carvalho Chehab return -EINVAL; 1790258c4304SMauro Carvalho Chehab } 1791258c4304SMauro Carvalho Chehab 1792f9fe90a4SMauro Carvalho Chehab static int vidioc_s_audio(struct file *file, void *priv, 1793f9fe90a4SMauro Carvalho Chehab const struct v4l2_audio *a) 17940c0d06caSMauro Carvalho Chehab { 1795917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1796258c4304SMauro Carvalho Chehab int idx, i; 17970c0d06caSMauro Carvalho Chehab 17980c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 17990c0d06caSMauro Carvalho Chehab return -EINVAL; 1800258c4304SMauro Carvalho Chehab 1801258c4304SMauro Carvalho Chehab idx = dev->amux_map[a->index]; 1802258c4304SMauro Carvalho Chehab 1803258c4304SMauro Carvalho Chehab if (idx == EM28XX_AMUX_UNUSED) 18040c0d06caSMauro Carvalho Chehab return -EINVAL; 18050c0d06caSMauro Carvalho Chehab 1806258c4304SMauro Carvalho Chehab dev->ctl_ainput = idx; 1807258c4304SMauro Carvalho Chehab 1808258c4304SMauro Carvalho Chehab /* 1809258c4304SMauro Carvalho Chehab * FIXME: This is wrong, as different inputs at em28xx_cards 1810258c4304SMauro Carvalho Chehab * may have different audio outputs. So, the right thing 1811258c4304SMauro Carvalho Chehab * to do is to implement VIDIOC_G_AUDOUT/VIDIOC_S_AUDOUT. 1812258c4304SMauro Carvalho Chehab * With the current board definitions, this would work fine, 1813258c4304SMauro Carvalho Chehab * as, currently, all boards fit. 1814258c4304SMauro Carvalho Chehab */ 1815258c4304SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) 1816258c4304SMauro Carvalho Chehab if (idx == dev->amux_map[i]) 1817258c4304SMauro Carvalho Chehab break; 1818258c4304SMauro Carvalho Chehab if (i == MAX_EM28XX_INPUT) 1819258c4304SMauro Carvalho Chehab return -EINVAL; 1820258c4304SMauro Carvalho Chehab 1821258c4304SMauro Carvalho Chehab dev->ctl_aoutput = INPUT(i)->aout; 18220c0d06caSMauro Carvalho Chehab 18230c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 18240c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 18250c0d06caSMauro Carvalho Chehab 1826258c4304SMauro Carvalho Chehab em28xx_videodbg("%s: set audio input to %d\n", __func__, 1827258c4304SMauro Carvalho Chehab dev->ctl_ainput); 1828258c4304SMauro Carvalho Chehab 18290c0d06caSMauro Carvalho Chehab return 0; 18300c0d06caSMauro Carvalho Chehab } 18310c0d06caSMauro Carvalho Chehab 18320c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 18330c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 18340c0d06caSMauro Carvalho Chehab { 1835917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18360c0d06caSMauro Carvalho Chehab 1837f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 18380c0d06caSMauro Carvalho Chehab return -EINVAL; 18390c0d06caSMauro Carvalho Chehab 1840cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Tuner", sizeof(t->name)); 18410c0d06caSMauro Carvalho Chehab 184295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 18430c0d06caSMauro Carvalho Chehab return 0; 18440c0d06caSMauro Carvalho Chehab } 18450c0d06caSMauro Carvalho Chehab 18460c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 18472f73c7c5SHans Verkuil const struct v4l2_tuner *t) 18480c0d06caSMauro Carvalho Chehab { 1849917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18500c0d06caSMauro Carvalho Chehab 1851f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 18520c0d06caSMauro Carvalho Chehab return -EINVAL; 18530c0d06caSMauro Carvalho Chehab 185495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 18550c0d06caSMauro Carvalho Chehab return 0; 18560c0d06caSMauro Carvalho Chehab } 18570c0d06caSMauro Carvalho Chehab 18580c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 18590c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 18600c0d06caSMauro Carvalho Chehab { 1861917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18623854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18630c0d06caSMauro Carvalho Chehab 1864f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 186520deebfeSHans Verkuil return -EINVAL; 186620deebfeSHans Verkuil 18673854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 18680c0d06caSMauro Carvalho Chehab return 0; 18690c0d06caSMauro Carvalho Chehab } 18700c0d06caSMauro Carvalho Chehab 18710c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1872b530a447SHans Verkuil const struct v4l2_frequency *f) 18730c0d06caSMauro Carvalho Chehab { 1874b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1875917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 187695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18770c0d06caSMauro Carvalho Chehab 1878f9fe90a4SMauro Carvalho Chehab if (f->tuner != 0) 18790c0d06caSMauro Carvalho Chehab return -EINVAL; 18800c0d06caSMauro Carvalho Chehab 188195d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 188295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 18833854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 18840c0d06caSMauro Carvalho Chehab 18850c0d06caSMauro Carvalho Chehab return 0; 18860c0d06caSMauro Carvalho Chehab } 18870c0d06caSMauro Carvalho Chehab 1888cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 188996b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 189096b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 18913b2d17b4SHans Verkuil { 1892917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18933b2d17b4SHans Verkuil 18943b2d17b4SHans Verkuil if (chip->match.addr > 1) 18953b2d17b4SHans Verkuil return -EINVAL; 18963b2d17b4SHans Verkuil if (chip->match.addr == 1) 1897c0decac1SMauro Carvalho Chehab strscpy(chip->name, "ac97", sizeof(chip->name)); 18983b2d17b4SHans Verkuil else 1899c0decac1SMauro Carvalho Chehab strscpy(chip->name, 190095d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 19013b2d17b4SHans Verkuil return 0; 19023b2d17b4SHans Verkuil } 19033b2d17b4SHans Verkuil 190435deba32SFrank Schaefer static int em28xx_reg_len(int reg) 190535deba32SFrank Schaefer { 190635deba32SFrank Schaefer switch (reg) { 190735deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 190835deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 190935deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 191035deba32SFrank Schaefer return 2; 191135deba32SFrank Schaefer default: 191235deba32SFrank Schaefer return 1; 191335deba32SFrank Schaefer } 191435deba32SFrank Schaefer } 19150c0d06caSMauro Carvalho Chehab 19160c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 19170c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 19180c0d06caSMauro Carvalho Chehab { 1919917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19200c0d06caSMauro Carvalho Chehab int ret; 19210c0d06caSMauro Carvalho Chehab 19223b2d17b4SHans Verkuil if (reg->match.addr > 1) 19233b2d17b4SHans Verkuil return -EINVAL; 1924abca2056SHans Verkuil if (reg->match.addr) { 19250c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 19260c0d06caSMauro Carvalho Chehab if (ret < 0) 19270c0d06caSMauro Carvalho Chehab return ret; 19280c0d06caSMauro Carvalho Chehab 19290c0d06caSMauro Carvalho Chehab reg->val = ret; 19300c0d06caSMauro Carvalho Chehab reg->size = 1; 19310c0d06caSMauro Carvalho Chehab return 0; 19320c0d06caSMauro Carvalho Chehab } 19330c0d06caSMauro Carvalho Chehab 19340c0d06caSMauro Carvalho Chehab /* Match host */ 19350c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 19360c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 19370c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 19380c0d06caSMauro Carvalho Chehab 19390c0d06caSMauro Carvalho Chehab if (ret < 0) 19400c0d06caSMauro Carvalho Chehab return ret; 19410c0d06caSMauro Carvalho Chehab 19420c0d06caSMauro Carvalho Chehab reg->val = ret; 19430c0d06caSMauro Carvalho Chehab } else { 19440c0d06caSMauro Carvalho Chehab __le16 val = 0; 1945fdf1bc9fSMauro Carvalho Chehab 194601c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 19470c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 19480c0d06caSMauro Carvalho Chehab if (ret < 0) 19490c0d06caSMauro Carvalho Chehab return ret; 19500c0d06caSMauro Carvalho Chehab 19510c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 19520c0d06caSMauro Carvalho Chehab } 19530c0d06caSMauro Carvalho Chehab 19540c0d06caSMauro Carvalho Chehab return 0; 19550c0d06caSMauro Carvalho Chehab } 19560c0d06caSMauro Carvalho Chehab 19570c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1958977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 19590c0d06caSMauro Carvalho Chehab { 1960917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19610c0d06caSMauro Carvalho Chehab __le16 buf; 19620c0d06caSMauro Carvalho Chehab 19633b2d17b4SHans Verkuil if (reg->match.addr > 1) 19643b2d17b4SHans Verkuil return -EINVAL; 1965abca2056SHans Verkuil if (reg->match.addr) 19660c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 19670c0d06caSMauro Carvalho Chehab 19680c0d06caSMauro Carvalho Chehab /* Match host */ 19690c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 19700c0d06caSMauro Carvalho Chehab 19710c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 19720c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 19730c0d06caSMauro Carvalho Chehab } 19740c0d06caSMauro Carvalho Chehab #endif 19750c0d06caSMauro Carvalho Chehab 19760c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 19770c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 19780c0d06caSMauro Carvalho Chehab { 1979917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1980ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1981c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 19820c0d06caSMauro Carvalho Chehab 1983c0decac1SMauro Carvalho Chehab strscpy(cap->driver, "em28xx", sizeof(cap->driver)); 1984c0decac1SMauro Carvalho Chehab strscpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1985c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 19860c0d06caSMauro Carvalho Chehab 19878c3854d0SHans Verkuil cap->capabilities = V4L2_CAP_DEVICE_CAPS | V4L2_CAP_READWRITE | 1988a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1989920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 19908c3854d0SHans Verkuil cap->capabilities |= V4L2_CAP_AUDIO; 19910c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 19928c3854d0SHans Verkuil cap->capabilities |= V4L2_CAP_TUNER; 1993d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 19941d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1995d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 1996a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 19970c0d06caSMauro Carvalho Chehab return 0; 19980c0d06caSMauro Carvalho Chehab } 19990c0d06caSMauro Carvalho Chehab 20000c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 20010c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 20020c0d06caSMauro Carvalho Chehab { 20030c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 20040c0d06caSMauro Carvalho Chehab return -EINVAL; 20050c0d06caSMauro Carvalho Chehab 20060c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 20070c0d06caSMauro Carvalho Chehab 20080c0d06caSMauro Carvalho Chehab return 0; 20090c0d06caSMauro Carvalho Chehab } 20100c0d06caSMauro Carvalho Chehab 20110c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 20120c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 20130c0d06caSMauro Carvalho Chehab { 2014917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20150c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 20160c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 20170c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 20180c0d06caSMauro Carvalho Chehab 20190c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 20200c0d06caSMauro Carvalho Chehab if (!fmt) { 20210c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 20220c0d06caSMauro Carvalho Chehab fsize->pixel_format); 20230c0d06caSMauro Carvalho Chehab return -EINVAL; 20240c0d06caSMauro Carvalho Chehab } 20250c0d06caSMauro Carvalho Chehab 20260c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 20270c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 20280c0d06caSMauro Carvalho Chehab return -EINVAL; 20290c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 20300c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 20310c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 20320c0d06caSMauro Carvalho Chehab return 0; 20330c0d06caSMauro Carvalho Chehab } 20340c0d06caSMauro Carvalho Chehab 20350c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 20360c0d06caSMauro Carvalho Chehab return -EINVAL; 20370c0d06caSMauro Carvalho Chehab 20380c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 20390c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 20406c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 20416c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 20426c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 20430c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 20446c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 20456c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 20460c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 20470c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 20480c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 20490c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 20500c0d06caSMauro Carvalho Chehab return 0; 20510c0d06caSMauro Carvalho Chehab } 20520c0d06caSMauro Carvalho Chehab 20530c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 20540c0d06caSMauro Carvalho Chehab 20550c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 20560c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 20570c0d06caSMauro Carvalho Chehab { 2058917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 2059753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20600c0d06caSMauro Carvalho Chehab 2061753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 20620c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 20630c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 20640c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 20650c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 2066753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 2067753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 20682a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 20690c0d06caSMauro Carvalho Chehab 20700c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 207152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 20720c0d06caSMauro Carvalho Chehab /* NTSC */ 20730c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 20740c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 207552faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 20760c0d06caSMauro Carvalho Chehab /* PAL */ 20770c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 20780c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 20790c0d06caSMauro Carvalho Chehab } 20800c0d06caSMauro Carvalho Chehab 20810c0d06caSMauro Carvalho Chehab return 0; 20820c0d06caSMauro Carvalho Chehab } 20830c0d06caSMauro Carvalho Chehab 2084f9fe90a4SMauro Carvalho Chehab /* 2085f9fe90a4SMauro Carvalho Chehab * RADIO ESPECIFIC IOCTLS 2086f9fe90a4SMauro Carvalho Chehab */ 20870c0d06caSMauro Carvalho Chehab 20880c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 20890c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 20900c0d06caSMauro Carvalho Chehab { 2091917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20920c0d06caSMauro Carvalho Chehab 20930c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 20940c0d06caSMauro Carvalho Chehab return -EINVAL; 20950c0d06caSMauro Carvalho Chehab 2096cc1e6315SMauro Carvalho Chehab strscpy(t->name, "Radio", sizeof(t->name)); 20970c0d06caSMauro Carvalho Chehab 209895d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 20990c0d06caSMauro Carvalho Chehab 21000c0d06caSMauro Carvalho Chehab return 0; 21010c0d06caSMauro Carvalho Chehab } 21020c0d06caSMauro Carvalho Chehab 21030c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 21042f73c7c5SHans Verkuil const struct v4l2_tuner *t) 21050c0d06caSMauro Carvalho Chehab { 2106917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 21070c0d06caSMauro Carvalho Chehab 2108f9fe90a4SMauro Carvalho Chehab if (t->index != 0) 21090c0d06caSMauro Carvalho Chehab return -EINVAL; 21100c0d06caSMauro Carvalho Chehab 211195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 21120c0d06caSMauro Carvalho Chehab 21130c0d06caSMauro Carvalho Chehab return 0; 21140c0d06caSMauro Carvalho Chehab } 21150c0d06caSMauro Carvalho Chehab 21160c0d06caSMauro Carvalho Chehab /* 211795d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 211895d2608bSFrank Schaefer * 211995d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 212095d2608bSFrank Schaefer * 212195d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 212295d2608bSFrank Schaefer */ 2123f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 212495d2608bSFrank Schaefer { 212595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 212695d2608bSFrank Schaefer 2127abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 212895d2608bSFrank Schaefer kfree(v4l2); 212995d2608bSFrank Schaefer } 213095d2608bSFrank Schaefer 213195d2608bSFrank Schaefer /* 21320c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 21330c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 21340c0d06caSMauro Carvalho Chehab */ 21350c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 21360c0d06caSMauro Carvalho Chehab { 21370c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 21380c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 213995d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 21400c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 21413c0f90e1SFrank Schaefer int ret; 21420c0d06caSMauro Carvalho Chehab 21430c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 21447fbbbc78SHans Verkuil case VFL_TYPE_VIDEO: 21450c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 21460c0d06caSMauro Carvalho Chehab break; 21470c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 21480c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 21490c0d06caSMauro Carvalho Chehab break; 21504e170240SFrank Schaefer case VFL_TYPE_RADIO: 21514e170240SFrank Schaefer break; 21524e170240SFrank Schaefer default: 21534e170240SFrank Schaefer return -EINVAL; 21540c0d06caSMauro Carvalho Chehab } 21550c0d06caSMauro Carvalho Chehab 21568e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 21578e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 21588e2c8717SFrank Schaefer v4l2->users); 21590c0d06caSMauro Carvalho Chehab 21600c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 21610c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 21623c0f90e1SFrank Schaefer 21633c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 21643c0f90e1SFrank Schaefer if (ret) { 216529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2166ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 21673c0f90e1SFrank Schaefer __func__, ret); 21680c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21693c0f90e1SFrank Schaefer return ret; 21700c0d06caSMauro Carvalho Chehab } 21710c0d06caSMauro Carvalho Chehab 21728e2c8717SFrank Schaefer if (v4l2->users == 0) { 21730c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 21744e170240SFrank Schaefer 21754e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 21760c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 21770c0d06caSMauro Carvalho Chehab 21784e170240SFrank Schaefer /* 21794e170240SFrank Schaefer * Needed, since GPIO might have disabled power 21804e170240SFrank Schaefer * of some i2c devices 21810c0d06caSMauro Carvalho Chehab */ 21820c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 21830c0d06caSMauro Carvalho Chehab } 2184d3829fadSDevin Heitmueller 2185d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 21860c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 218795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 21880c0d06caSMauro Carvalho Chehab } 21890c0d06caSMauro Carvalho Chehab 219047677e51SMauro Carvalho Chehab kref_get(&dev->ref); 219195d2608bSFrank Schaefer kref_get(&v4l2->ref); 21928e2c8717SFrank Schaefer v4l2->users++; 21930c0d06caSMauro Carvalho Chehab 21940c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 21950c0d06caSMauro Carvalho Chehab 2196d3829fadSDevin Heitmueller return 0; 21970c0d06caSMauro Carvalho Chehab } 21980c0d06caSMauro Carvalho Chehab 21990c0d06caSMauro Carvalho Chehab /* 220001c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 22010c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 22026b338c72SGeert Uytterhoeven * called when the device gets disconnected or at module unload 22030c0d06caSMauro Carvalho Chehab */ 220401c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 22050c0d06caSMauro Carvalho Chehab { 220695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 220795d2608bSFrank Schaefer 2208822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2209822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2210822b8deaSMauro Carvalho Chehab return 0; 2211822b8deaSMauro Carvalho Chehab } 2212822b8deaSMauro Carvalho Chehab 221301c28193SMauro Carvalho Chehab if (!dev->has_video) { 221401c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 221501c28193SMauro Carvalho Chehab return 0; 221601c28193SMauro Carvalho Chehab } 22170c0d06caSMauro Carvalho Chehab 2218f9fe90a4SMauro Carvalho Chehab if (!v4l2) 221995d2608bSFrank Schaefer return 0; 222095d2608bSFrank Schaefer 222129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2222aa929ad7SMauro Carvalho Chehab 2223ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2224ebbfbc20SMauro Carvalho Chehab 222595d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 22265ad10de6SFrank Schaefer 222723e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 222823e8642cSFrank Schaefer 222937ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 223037ecc7b1SMauro Carvalho Chehab 2231d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 223229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2233d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2234d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 22350c0d06caSMauro Carvalho Chehab } 2236d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 223729b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2238d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2239d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 22400c0d06caSMauro Carvalho Chehab } 2241d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 224229b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2243d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2244d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 22450c0d06caSMauro Carvalho Chehab } 224601c28193SMauro Carvalho Chehab 2247abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 224895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2249103f18a2SFrank Schaefer 225095d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 225195d2608bSFrank Schaefer 2252ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 225395d2608bSFrank Schaefer 225447677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 22555ad10de6SFrank Schaefer 225601c28193SMauro Carvalho Chehab return 0; 22570c0d06caSMauro Carvalho Chehab } 22580c0d06caSMauro Carvalho Chehab 2259a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2260a61f6811SShuah Khan { 2261a61f6811SShuah Khan if (dev->is_audio_only) 2262a61f6811SShuah Khan return 0; 2263a61f6811SShuah Khan 2264a61f6811SShuah Khan if (!dev->has_video) 2265a61f6811SShuah Khan return 0; 2266a61f6811SShuah Khan 226729b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2268a61f6811SShuah Khan em28xx_stop_urbs(dev); 2269a61f6811SShuah Khan return 0; 2270a61f6811SShuah Khan } 2271a61f6811SShuah Khan 2272a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2273a61f6811SShuah Khan { 2274a61f6811SShuah Khan if (dev->is_audio_only) 2275a61f6811SShuah Khan return 0; 2276a61f6811SShuah Khan 2277a61f6811SShuah Khan if (!dev->has_video) 2278a61f6811SShuah Khan return 0; 2279a61f6811SShuah Khan 228029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2281a61f6811SShuah Khan /* what do we do here */ 2282a61f6811SShuah Khan return 0; 2283a61f6811SShuah Khan } 2284a61f6811SShuah Khan 22850c0d06caSMauro Carvalho Chehab /* 22860c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 22870c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 22880c0d06caSMauro Carvalho Chehab * calls and ioctls 22890c0d06caSMauro Carvalho Chehab */ 22900c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 22910c0d06caSMauro Carvalho Chehab { 2292917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 229395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2294c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 2295f9fe90a4SMauro Carvalho Chehab int err; 22960c0d06caSMauro Carvalho Chehab 22978e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 22988e2c8717SFrank Schaefer 22998e2c8717SFrank Schaefer vb2_fop_release(filp); 230098c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 23010c0d06caSMauro Carvalho Chehab 23028e2c8717SFrank Schaefer if (v4l2->users == 1) { 230347677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 230447677e51SMauro Carvalho Chehab if (dev->disconnected) 230501c28193SMauro Carvalho Chehab goto exit; 23060c0d06caSMauro Carvalho Chehab 23070c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 23083aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 23090c0d06caSMauro Carvalho Chehab 23100c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 23110c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 23120c0d06caSMauro Carvalho Chehab 23130c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 23140c0d06caSMauro Carvalho Chehab dev->alt = 0; 23150c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2316f9fe90a4SMauro Carvalho Chehab err = usb_set_interface(udev, 0, 0); 2317f9fe90a4SMauro Carvalho Chehab if (err < 0) { 231829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2319ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 2320f9fe90a4SMauro Carvalho Chehab err); 23210c0d06caSMauro Carvalho Chehab } 23220c0d06caSMauro Carvalho Chehab } 23230c0d06caSMauro Carvalho Chehab 232401c28193SMauro Carvalho Chehab exit: 23258e2c8717SFrank Schaefer v4l2->users--; 232695d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 23270c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 232847677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 232947677e51SMauro Carvalho Chehab 23300c0d06caSMauro Carvalho Chehab return 0; 23310c0d06caSMauro Carvalho Chehab } 23320c0d06caSMauro Carvalho Chehab 23330c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 23340c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23350c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23360c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2337d3829fadSDevin Heitmueller .read = vb2_fop_read, 2338d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2339d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 23400c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23410c0d06caSMauro Carvalho Chehab }; 23420c0d06caSMauro Carvalho Chehab 23430c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 23440c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 23450c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 23460c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 23470c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 23480c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 23490c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23502a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2351aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 23520c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 2353258c4304SMauro Carvalho Chehab .vidioc_enumaudio = vidioc_enumaudio, 23540c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 23550c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 23560c0d06caSMauro Carvalho Chehab 2357d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2358d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2359d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2360d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2361d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2362d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2363d3829fadSDevin Heitmueller 23640c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 23650c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 23660c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 23670c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 23680c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 23690c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 23700c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 23710c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2372d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2373d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 23740c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 23750c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 23760c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23770c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 237850fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 237950fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23800c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 238196b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 23820c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23830c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23840c0d06caSMauro Carvalho Chehab #endif 23850c0d06caSMauro Carvalho Chehab }; 23860c0d06caSMauro Carvalho Chehab 23870c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 23880c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 23890c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2390d4352f36SHans Verkuil .release = video_device_release_empty, 23910c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 23920c0d06caSMauro Carvalho Chehab }; 23930c0d06caSMauro Carvalho Chehab 23940c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 23950c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 23960c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 23970c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 23980c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 23990c0d06caSMauro Carvalho Chehab }; 24000c0d06caSMauro Carvalho Chehab 24010c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2402a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 24030c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 24040c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 24050c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 24060c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 240750fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 240850fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 24090c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2410430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 24110c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 24120c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 24130c0d06caSMauro Carvalho Chehab #endif 24140c0d06caSMauro Carvalho Chehab }; 24150c0d06caSMauro Carvalho Chehab 24160c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 24170c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 24180c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2419d4352f36SHans Verkuil .release = video_device_release_empty, 24200c0d06caSMauro Carvalho Chehab }; 24210c0d06caSMauro Carvalho Chehab 2422b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2423b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2424b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2425b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2426b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2427b64f8e9aSMauro Carvalho Chehab 2428b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2429b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2430b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2431b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2432b64f8e9aSMauro Carvalho Chehab }; 2433b64f8e9aSMauro Carvalho Chehab 2434b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2435b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2436b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2437b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2438b64f8e9aSMauro Carvalho Chehab }; 2439b64f8e9aSMauro Carvalho Chehab 24400c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 24410c0d06caSMauro Carvalho Chehab 2442d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2443d4352f36SHans Verkuil struct video_device *vfd, 24440c0d06caSMauro Carvalho Chehab const struct video_device *template, 24450c0d06caSMauro Carvalho Chehab const char *type_name) 24460c0d06caSMauro Carvalho Chehab { 24470c0d06caSMauro Carvalho Chehab *vfd = *template; 244895d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 24490c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2450aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 2451d8c95c08SHans Verkuil vfd->tvnorms = 0; 24520c0d06caSMauro Carvalho Chehab 24530c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 245429b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 24550c0d06caSMauro Carvalho Chehab 24560c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 24570c0d06caSMauro Carvalho Chehab } 24580c0d06caSMauro Carvalho Chehab 24593319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 24600560f337SMauro Carvalho Chehab { 24613854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 24623854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 24630560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 24640560f337SMauro Carvalho Chehab struct v4l2_frequency f; 24650560f337SMauro Carvalho Chehab 24660560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 24670560f337SMauro Carvalho Chehab 24680560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 24690560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 24700560f337SMauro Carvalho Chehab 24710560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 24720560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 24730560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 24740560f337SMauro Carvalho Chehab 247595d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 247695d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24770560f337SMauro Carvalho Chehab } 24780560f337SMauro Carvalho Chehab 2479f9fe90a4SMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT && dev->tuner_type) { 24800560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 24813319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 24820560f337SMauro Carvalho Chehab 248395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 248495d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 24850560f337SMauro Carvalho Chehab } 24860560f337SMauro Carvalho Chehab 24876867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 24880560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 24890560f337SMauro Carvalho Chehab 24900560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 24916867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 24920560f337SMauro Carvalho Chehab 249395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 249495d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 24950560f337SMauro Carvalho Chehab } 24960560f337SMauro Carvalho Chehab 24970560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 24980560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 24990560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 25000560f337SMauro Carvalho Chehab 25010560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 25020560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 25030560f337SMauro Carvalho Chehab 25040560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 25050560f337SMauro Carvalho Chehab 25060560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 25070560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 25080560f337SMauro Carvalho Chehab 250995d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 25100560f337SMauro Carvalho Chehab } 25110560f337SMauro Carvalho Chehab 25120560f337SMauro Carvalho Chehab /* configure tuner */ 25130560f337SMauro Carvalho Chehab f.tuner = 0; 25140560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 25150560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 25163854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 251795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 25180560f337SMauro Carvalho Chehab } 25190560f337SMauro Carvalho Chehab 252001c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 25210c0d06caSMauro Carvalho Chehab { 25220c0d06caSMauro Carvalho Chehab u8 val; 25230c0d06caSMauro Carvalho Chehab int ret; 25240c0d06caSMauro Carvalho Chehab unsigned int maxw; 2525abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 252695d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2527b64f8e9aSMauro Carvalho Chehab 2528822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2529822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2530822b8deaSMauro Carvalho Chehab return 0; 2531822b8deaSMauro Carvalho Chehab } 2532822b8deaSMauro Carvalho Chehab 253301c28193SMauro Carvalho Chehab if (!dev->has_video) { 2534b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2535b64f8e9aSMauro Carvalho Chehab return 0; 2536b64f8e9aSMauro Carvalho Chehab } 25370c0d06caSMauro Carvalho Chehab 253829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 25390c0d06caSMauro Carvalho Chehab 254001c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 254101c28193SMauro Carvalho Chehab 2542f9fe90a4SMauro Carvalho Chehab v4l2 = kzalloc(sizeof(*v4l2), GFP_KERNEL); 25438314d402SMauro Carvalho Chehab if (!v4l2) { 254495d2608bSFrank Schaefer mutex_unlock(&dev->lock); 254595d2608bSFrank Schaefer return -ENOMEM; 254695d2608bSFrank Schaefer } 254795d2608bSFrank Schaefer kref_init(&v4l2->ref); 2548abc1308fSFrank Schaefer v4l2->dev = dev; 254995d2608bSFrank Schaefer dev->v4l2 = v4l2; 255095d2608bSFrank Schaefer 255137ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 255237ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 255337ecc7b1SMauro Carvalho Chehab #endif 255429b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2555b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 255629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2557ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2558b64f8e9aSMauro Carvalho Chehab goto err; 2559b64f8e9aSMauro Carvalho Chehab } 2560b64f8e9aSMauro Carvalho Chehab 2561abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2562b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 256395d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2564b64f8e9aSMauro Carvalho Chehab 2565aa62980bSMauro Carvalho Chehab if (dev->is_webcam) 25667e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 256758159171SFrank Schaefer 2568b64f8e9aSMauro Carvalho Chehab /* 2569b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2570b64f8e9aSMauro Carvalho Chehab */ 2571a7b8e9a5SFrank Schaefer v4l2->vinmode = EM28XX_VINMODE_YUV422_CbYCrY; 25729297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2573b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2574b64f8e9aSMauro Carvalho Chehab 2575b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2576b64f8e9aSMauro Carvalho Chehab 2577aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) 257895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 257995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2580b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2581b64f8e9aSMauro Carvalho Chehab 2582b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 258395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 258495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2585b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2586b64f8e9aSMauro Carvalho Chehab 2587b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 258895d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 258995d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2590b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2591b64f8e9aSMauro Carvalho Chehab 2592b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 259395d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 259495d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2595b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2596b64f8e9aSMauro Carvalho Chehab 2597b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2598b64f8e9aSMauro Carvalho Chehab 2599b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 26003319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 26016867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2602b64f8e9aSMauro Carvalho Chehab 2603b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 260495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 260595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2606fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2607fdf1bc9fSMauro Carvalho Chehab NULL); 2608b64f8e9aSMauro Carvalho Chehab 2609b64f8e9aSMauro Carvalho Chehab if (has_demod) 261095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2611fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2612fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2613fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 26143319e6f8SFrank Schaefer if (tuner_addr == 0) { 2615b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2616b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2617b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2618b64f8e9aSMauro Carvalho Chehab 261995d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2620fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2621fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2622fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2623b64f8e9aSMauro Carvalho Chehab 2624b64f8e9aSMauro Carvalho Chehab if (sd) 26253319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2626b64f8e9aSMauro Carvalho Chehab } else { 262795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 262895d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 26293319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2630b64f8e9aSMauro Carvalho Chehab } 2631b64f8e9aSMauro Carvalho Chehab 26323319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 26333319e6f8SFrank Schaefer } 26343319e6f8SFrank Schaefer 2635d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2636b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2637b64f8e9aSMauro Carvalho Chehab 2638b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2639b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2640b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 264129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2642ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2643b64f8e9aSMauro Carvalho Chehab __func__, ret); 2644b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2645b64f8e9aSMauro Carvalho Chehab } 2646b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2647b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2648b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2649b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2650b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2651b64f8e9aSMauro Carvalho Chehab } else { 2652b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2653b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2654b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2655b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2656b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2657b64f8e9aSMauro Carvalho Chehab } 2658b64f8e9aSMauro Carvalho Chehab 2659b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2660b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2661b64f8e9aSMauro Carvalho Chehab 2662b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2663b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2664b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2665b64f8e9aSMauro Carvalho Chehab 2666aa62980bSMauro Carvalho Chehab if (dev->has_msp34xx) { 2667b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2668b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2669b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 267029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2671ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2672b64f8e9aSMauro Carvalho Chehab __func__, ret); 2673b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2674b64f8e9aSMauro Carvalho Chehab } 2675f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2676b64f8e9aSMauro Carvalho Chehab 2677b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2678b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 267929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2680ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2681b64f8e9aSMauro Carvalho Chehab __func__, ret); 2682b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2683b64f8e9aSMauro Carvalho Chehab } 2684f9fe90a4SMauro Carvalho Chehab usleep_range(10000, 11000); 2685b64f8e9aSMauro Carvalho Chehab } 2686b64f8e9aSMauro Carvalho Chehab 26870c0d06caSMauro Carvalho Chehab /* set default norm */ 268852faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 26898774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 269058159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 26910c0d06caSMauro Carvalho Chehab 26920c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 269306e20672SFrank Schaefer v4l2->format = &format[0]; 26940c0d06caSMauro Carvalho Chehab 26950c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 2696f9fe90a4SMauro Carvalho Chehab /* 2697f9fe90a4SMauro Carvalho Chehab * MaxPacketSize for em2800 is too small to capture at full resolution 2698f9fe90a4SMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% 2699f9fe90a4SMauro Carvalho Chehab */ 27000c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 27010c0d06caSMauro Carvalho Chehab maxw /= 2; 27020c0d06caSMauro Carvalho Chehab 27030c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 27040c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 27050c0d06caSMauro Carvalho Chehab 27060c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 27070c0d06caSMauro Carvalho Chehab 27080c0d06caSMauro Carvalho Chehab /* Audio defaults */ 27090c0d06caSMauro Carvalho Chehab dev->mute = 1; 27100c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 27110c0d06caSMauro Carvalho Chehab 27120c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 27130c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 27140c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 27150c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 27160c0d06caSMauro Carvalho Chehab 27170c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 27180c0d06caSMauro Carvalho Chehab 27198f8b113aSFrank Schaefer /* Add image controls */ 2720f9fe90a4SMauro Carvalho Chehab 2721f9fe90a4SMauro Carvalho Chehab /* 2722f9fe90a4SMauro Carvalho Chehab * NOTE: at this point, the subdevices are already registered, so 2723f9fe90a4SMauro Carvalho Chehab * bridge controls are only added/enabled when no subdevice provides 2724f9fe90a4SMauro Carvalho Chehab * them 2725f9fe90a4SMauro Carvalho Chehab */ 2726f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2727ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27288f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 27298f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2730f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2731ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27328f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 27338f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2734f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2735ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27368f8b113aSFrank Schaefer V4L2_CID_SATURATION, 27378f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2738f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2739ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27408f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 27418f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2742f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2743ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27448f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 27458f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2746f9fe90a4SMauro Carvalho Chehab if (!v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2747ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 27488f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 27498f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 27508f8b113aSFrank Schaefer 27518f8b113aSFrank Schaefer /* Reset image controls */ 27528f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2753ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2754ad298055SFrank Schaefer ret = hdl->error; 2755b64f8e9aSMauro Carvalho Chehab if (ret) 2756b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27578f8b113aSFrank Schaefer 27580c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2759d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 276027a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 276127a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2762d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2763d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 27648c3854d0SHans Verkuil v4l2->vdev.device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | 27658c3854d0SHans Verkuil V4L2_CAP_STREAMING; 27668c3854d0SHans Verkuil if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 27678c3854d0SHans Verkuil v4l2->vdev.device_caps |= V4L2_CAP_AUDIO; 27688c3854d0SHans Verkuil if (dev->tuner_type != TUNER_ABSENT) 27698c3854d0SHans Verkuil v4l2->vdev.device_caps |= V4L2_CAP_TUNER; 27708c3854d0SHans Verkuil 27710c0d06caSMauro Carvalho Chehab 27726e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 2773aa62980bSMauro Carvalho Chehab if (dev->is_webcam) { 2774d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2775d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2776d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 27773bc85cceSFrank Schaefer } else { 2778d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 27796e46dabaSFrank Schaefer } 278066df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2781d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2782d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2783d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2784d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 278566df67b7SFrank Schaefer } 2786920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2787d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2788d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2789c2dcef83SFrank Schaefer } 27906e46dabaSFrank Schaefer 27910c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 27927fbbbc78SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_VIDEO, 27930c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 27940c0d06caSMauro Carvalho Chehab if (ret) { 279529b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2796ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2797b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27980c0d06caSMauro Carvalho Chehab } 27990c0d06caSMauro Carvalho Chehab 28000c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 28010c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2802d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 28030c0d06caSMauro Carvalho Chehab "vbi"); 28040c0d06caSMauro Carvalho Chehab 2805d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2806d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 28078c3854d0SHans Verkuil v4l2->vbi_dev.device_caps = V4L2_CAP_STREAMING | 28088c3854d0SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 28098c3854d0SHans Verkuil if (dev->tuner_type != TUNER_ABSENT) 28108c3854d0SHans Verkuil v4l2->vbi_dev.device_caps |= V4L2_CAP_TUNER; 2811d3829fadSDevin Heitmueller 281266df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2813d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 281466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2815d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2816d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2817d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2818d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 281966df67b7SFrank Schaefer } 2820920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2821d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2822d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2823c2dcef83SFrank Schaefer } 282466df67b7SFrank Schaefer 28250c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2826d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 28270c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 28280c0d06caSMauro Carvalho Chehab if (ret < 0) { 282929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2830ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2831b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28320c0d06caSMauro Carvalho Chehab } 28330c0d06caSMauro Carvalho Chehab } 28340c0d06caSMauro Carvalho Chehab 28350c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2836d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 28370c0d06caSMauro Carvalho Chehab "radio"); 28388c3854d0SHans Verkuil v4l2->radio_dev.device_caps = V4L2_CAP_RADIO | V4L2_CAP_TUNER; 2839d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 28400c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 28410c0d06caSMauro Carvalho Chehab if (ret < 0) { 284229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2843ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2844b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 28450c0d06caSMauro Carvalho Chehab } 284629b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2847ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2848d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 28490c0d06caSMauro Carvalho Chehab } 28500c0d06caSMauro Carvalho Chehab 285137ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 285237ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 285337ecc7b1SMauro Carvalho Chehab 28540d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2855de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 285637ecc7b1SMauro Carvalho Chehab if (ret) { 285729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2858ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 285937ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 286037ecc7b1SMauro Carvalho Chehab goto unregister_dev; 286137ecc7b1SMauro Carvalho Chehab } 28620d37ba62SArnd Bergmann #endif 286337ecc7b1SMauro Carvalho Chehab 286429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2865ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2866d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 28670c0d06caSMauro Carvalho Chehab 2868d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 286929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2870ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2871d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 28720c0d06caSMauro Carvalho Chehab 2873b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 28743aab15afSHans Verkuil v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, standby); 2875b64f8e9aSMauro Carvalho Chehab 2876b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2877b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2878b64f8e9aSMauro Carvalho Chehab 287929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2880ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 28819634614fSMauro Carvalho Chehab 288247677e51SMauro Carvalho Chehab kref_get(&dev->ref); 288347677e51SMauro Carvalho Chehab 288401c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 28850c0d06caSMauro Carvalho Chehab return 0; 2886b64f8e9aSMauro Carvalho Chehab 2887b64f8e9aSMauro Carvalho Chehab unregister_dev: 288856a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 288929b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2890ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 289156a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 289256a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 289356a7f515SMauro Carvalho Chehab } 289456a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 289529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2896ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 289756a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 289856a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 289956a7f515SMauro Carvalho Chehab } 290056a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 290129b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2902ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 290356a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 290456a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 290556a7f515SMauro Carvalho Chehab } 290656a7f515SMauro Carvalho Chehab 2907abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 290895d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2909b64f8e9aSMauro Carvalho Chehab err: 291095d2608bSFrank Schaefer dev->v4l2 = NULL; 291195d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 291201c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2913b64f8e9aSMauro Carvalho Chehab return ret; 29140c0d06caSMauro Carvalho Chehab } 291501c28193SMauro Carvalho Chehab 291601c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 291701c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 291801c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 291901c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 292001c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2921a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2922a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 292301c28193SMauro Carvalho Chehab }; 292401c28193SMauro Carvalho Chehab 292501c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 292601c28193SMauro Carvalho Chehab { 292701c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 292801c28193SMauro Carvalho Chehab } 292901c28193SMauro Carvalho Chehab 293001c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 293101c28193SMauro Carvalho Chehab { 293201c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 293301c28193SMauro Carvalho Chehab } 293401c28193SMauro Carvalho Chehab 293501c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 293601c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2937