10c0d06caSMauro Carvalho Chehab /* 20c0d06caSMauro Carvalho Chehab em28xx-video.c - driver for Empia EM2800/EM2820/2840 USB 30c0d06caSMauro Carvalho Chehab video capture devices 40c0d06caSMauro Carvalho Chehab 50c0d06caSMauro Carvalho Chehab Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it> 60c0d06caSMauro Carvalho Chehab Markus Rechberger <mrechberger@gmail.com> 70c0d06caSMauro Carvalho Chehab Mauro Carvalho Chehab <mchehab@infradead.org> 80c0d06caSMauro Carvalho Chehab Sascha Sommer <saschasommer@freenet.de> 90fa4a402SFrank Schaefer Copyright (C) 2012 Frank Schäfer <fschaefer.oss@googlemail.com> 100c0d06caSMauro Carvalho Chehab 110c0d06caSMauro Carvalho Chehab Some parts based on SN9C10x PC Camera Controllers GPL driver made 120c0d06caSMauro Carvalho Chehab by Luca Risolia <luca.risolia@studio.unibo.it> 130c0d06caSMauro Carvalho Chehab 140c0d06caSMauro Carvalho Chehab This program is free software; you can redistribute it and/or modify 150c0d06caSMauro Carvalho Chehab it under the terms of the GNU General Public License as published by 160c0d06caSMauro Carvalho Chehab the Free Software Foundation; either version 2 of the License, or 170c0d06caSMauro Carvalho Chehab (at your option) any later version. 180c0d06caSMauro Carvalho Chehab 190c0d06caSMauro Carvalho Chehab This program is distributed in the hope that it will be useful, 200c0d06caSMauro Carvalho Chehab but WITHOUT ANY WARRANTY; without even the implied warranty of 210c0d06caSMauro Carvalho Chehab MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 220c0d06caSMauro Carvalho Chehab GNU General Public License for more details. 230c0d06caSMauro Carvalho Chehab 240c0d06caSMauro Carvalho Chehab You should have received a copy of the GNU General Public License 250c0d06caSMauro Carvalho Chehab along with this program; if not, write to the Free Software 260c0d06caSMauro Carvalho Chehab Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 270c0d06caSMauro Carvalho Chehab */ 280c0d06caSMauro Carvalho Chehab 298314d402SMauro Carvalho Chehab #include "em28xx.h" 308314d402SMauro Carvalho Chehab 310c0d06caSMauro Carvalho Chehab #include <linux/init.h> 320c0d06caSMauro Carvalho Chehab #include <linux/list.h> 330c0d06caSMauro Carvalho Chehab #include <linux/module.h> 340c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 350c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 360c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 370c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 380c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 390c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 400c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 410c0d06caSMauro Carvalho Chehab 4201c28193SMauro Carvalho Chehab #include "em28xx-v4l.h" 430c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 440c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4550fdf40fSHans Verkuil #include <media/v4l2-event.h> 4625dd1652SFrank Schaefer #include <media/v4l2-clk.h> 47d647f0b7SMauro Carvalho Chehab #include <media/drv-intf/msp3400.h> 480c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 490c0d06caSMauro Carvalho Chehab 500c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 510c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 520c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 530c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 540c0d06caSMauro Carvalho Chehab 550560f337SMauro Carvalho Chehab static unsigned int isoc_debug; 560560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 570560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 580560f337SMauro Carvalho Chehab 590560f337SMauro Carvalho Chehab static unsigned int disable_vbi; 600560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644); 610560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support"); 620560f337SMauro Carvalho Chehab 630560f337SMauro Carvalho Chehab static int alt; 640560f337SMauro Carvalho Chehab module_param(alt, int, 0644); 650560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 660560f337SMauro Carvalho Chehab 670c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do { \ 680c0d06caSMauro Carvalho Chehab if (video_debug) \ 6929b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \ 70ce8591ffSMauro Carvalho Chehab "video: %s: " fmt, __func__, ## arg); \ 71ce8591ffSMauro Carvalho Chehab } while (0) 720c0d06caSMauro Carvalho Chehab 732a96f60eSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) do {\ 742a96f60eSMauro Carvalho Chehab if (isoc_debug) \ 7529b05e22SMauro Carvalho Chehab dev_printk(KERN_DEBUG, &dev->intf->dev, \ 76ce8591ffSMauro Carvalho Chehab "isoc: %s: " fmt, __func__, ## arg); \ 77ce8591ffSMauro Carvalho Chehab } while (0) 780c0d06caSMauro Carvalho Chehab 790c0d06caSMauro Carvalho Chehab MODULE_AUTHOR(DRIVER_AUTHOR); 80d8992b09SMauro Carvalho Chehab MODULE_DESCRIPTION(DRIVER_DESC " - v4l2 interface"); 810c0d06caSMauro Carvalho Chehab MODULE_LICENSE("GPL"); 820c0d06caSMauro Carvalho Chehab MODULE_VERSION(EM28XX_VERSION); 830c0d06caSMauro Carvalho Chehab 84e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE1 0x02 85e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE 0x20 86e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_END 0x02 87e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_FRAME_ID 0x01 88e507e0e5SFrank Schaefer #define EM25XX_FRMDATAHDR_BYTE2_MASK (EM25XX_FRMDATAHDR_BYTE2_STILL_IMAGE | \ 89e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END | \ 90e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID) 91e507e0e5SFrank Schaefer 92d3829fadSDevin Heitmueller static unsigned int video_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 93d3829fadSDevin Heitmueller static unsigned int vbi_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 94d3829fadSDevin Heitmueller static unsigned int radio_nr[] = {[0 ... (EM28XX_MAXBOARDS - 1)] = -1U }; 950c0d06caSMauro Carvalho Chehab 960c0d06caSMauro Carvalho Chehab module_param_array(video_nr, int, NULL, 0444); 970c0d06caSMauro Carvalho Chehab module_param_array(vbi_nr, int, NULL, 0444); 980c0d06caSMauro Carvalho Chehab module_param_array(radio_nr, int, NULL, 0444); 990c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_nr, "video device numbers"); 1000c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(vbi_nr, "vbi device numbers"); 1010c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(radio_nr, "radio device numbers"); 1020c0d06caSMauro Carvalho Chehab 1030c0d06caSMauro Carvalho Chehab static unsigned int video_debug; 1040c0d06caSMauro Carvalho Chehab module_param(video_debug, int, 0644); 1050c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(video_debug, "enable debug messages [video]"); 1060c0d06caSMauro Carvalho Chehab 1070c0d06caSMauro Carvalho Chehab /* supported video standards */ 1080c0d06caSMauro Carvalho Chehab static struct em28xx_fmt format[] = { 1090c0d06caSMauro Carvalho Chehab { 1100c0d06caSMauro Carvalho Chehab .name = "16 bpp YUY2, 4:2:2, packed", 1110c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUYV, 1120c0d06caSMauro Carvalho Chehab .depth = 16, 1130c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV422_Y0UY1V, 1140c0d06caSMauro Carvalho Chehab }, { 1150c0d06caSMauro Carvalho Chehab .name = "16 bpp RGB 565, LE", 1160c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_RGB565, 1170c0d06caSMauro Carvalho Chehab .depth = 16, 1180c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_16_656, 1190c0d06caSMauro Carvalho Chehab }, { 1200c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer BGBG..GRGR", 1210c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SBGGR8, 1220c0d06caSMauro Carvalho Chehab .depth = 8, 1230c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_BGBG, 1240c0d06caSMauro Carvalho Chehab }, { 1250c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GRGR..BGBG", 1260c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGRBG8, 1270c0d06caSMauro Carvalho Chehab .depth = 8, 1280c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GRGR, 1290c0d06caSMauro Carvalho Chehab }, { 1300c0d06caSMauro Carvalho Chehab .name = "8 bpp Bayer GBGB..RGRG", 1310c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_SGBRG8, 1320c0d06caSMauro Carvalho Chehab .depth = 8, 1330c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_RGB_8_GBGB, 1340c0d06caSMauro Carvalho Chehab }, { 1350c0d06caSMauro Carvalho Chehab .name = "12 bpp YUV411", 1360c0d06caSMauro Carvalho Chehab .fourcc = V4L2_PIX_FMT_YUV411P, 1370c0d06caSMauro Carvalho Chehab .depth = 12, 1380c0d06caSMauro Carvalho Chehab .reg = EM28XX_OUTFMT_YUV411, 1390c0d06caSMauro Carvalho Chehab }, 1400c0d06caSMauro Carvalho Chehab }; 1410c0d06caSMauro Carvalho Chehab 14225c61e4cSFrank Schaefer /*FIXME: maxw should be dependent of alt mode */ 14325c61e4cSFrank Schaefer static inline unsigned int norm_maxw(struct em28xx *dev) 14425c61e4cSFrank Schaefer { 145d7dc18daSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 146d7dc18daSFrank Schaefer 14725c61e4cSFrank Schaefer if (dev->board.is_webcam) 148d7dc18daSFrank Schaefer return v4l2->sensor_xres; 14925c61e4cSFrank Schaefer 15025c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 15125c61e4cSFrank Schaefer return 640; 15225c61e4cSFrank Schaefer 15325c61e4cSFrank Schaefer return 720; 15425c61e4cSFrank Schaefer } 15525c61e4cSFrank Schaefer 15625c61e4cSFrank Schaefer static inline unsigned int norm_maxh(struct em28xx *dev) 15725c61e4cSFrank Schaefer { 15852faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15952faaf78SFrank Schaefer 16025c61e4cSFrank Schaefer if (dev->board.is_webcam) 161d7dc18daSFrank Schaefer return v4l2->sensor_yres; 16225c61e4cSFrank Schaefer 16325c61e4cSFrank Schaefer if (dev->board.max_range_640_480) 16425c61e4cSFrank Schaefer return 480; 16525c61e4cSFrank Schaefer 16652faaf78SFrank Schaefer return (v4l2->norm & V4L2_STD_625_50) ? 576 : 480; 16725c61e4cSFrank Schaefer } 16825c61e4cSFrank Schaefer 16901c28193SMauro Carvalho Chehab static int em28xx_vbi_supported(struct em28xx *dev) 1700560f337SMauro Carvalho Chehab { 1710560f337SMauro Carvalho Chehab /* Modprobe option to manually disable */ 1720560f337SMauro Carvalho Chehab if (disable_vbi == 1) 1730560f337SMauro Carvalho Chehab return 0; 1740560f337SMauro Carvalho Chehab 1750560f337SMauro Carvalho Chehab if (dev->board.is_webcam) 1760560f337SMauro Carvalho Chehab return 0; 1770560f337SMauro Carvalho Chehab 1780560f337SMauro Carvalho Chehab /* FIXME: check subdevices for VBI support */ 1790560f337SMauro Carvalho Chehab 1800560f337SMauro Carvalho Chehab if (dev->chip_id == CHIP_ID_EM2860 || 1810560f337SMauro Carvalho Chehab dev->chip_id == CHIP_ID_EM2883) 1820560f337SMauro Carvalho Chehab return 1; 1830560f337SMauro Carvalho Chehab 1840560f337SMauro Carvalho Chehab /* Version of em28xx that does not support VBI */ 1850560f337SMauro Carvalho Chehab return 0; 1860560f337SMauro Carvalho Chehab } 1870560f337SMauro Carvalho Chehab 1880560f337SMauro Carvalho Chehab /* 1890560f337SMauro Carvalho Chehab * em28xx_wake_i2c() 1900560f337SMauro Carvalho Chehab * configure i2c attached devices 1910560f337SMauro Carvalho Chehab */ 19201c28193SMauro Carvalho Chehab static void em28xx_wake_i2c(struct em28xx *dev) 1930560f337SMauro Carvalho Chehab { 19495d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 195fdf1bc9fSMauro Carvalho Chehab 19695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, core, reset, 0); 19795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 1980560f337SMauro Carvalho Chehab INPUT(dev->ctl_input)->vmux, 0, 0); 1990560f337SMauro Carvalho Chehab } 2000560f337SMauro Carvalho Chehab 20101c28193SMauro Carvalho Chehab static int em28xx_colorlevels_set_default(struct em28xx *dev) 2020560f337SMauro Carvalho Chehab { 2030560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R20_YGAIN, CONTRAST_DEFAULT); 2040560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R21_YOFFSET, BRIGHTNESS_DEFAULT); 2050560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R22_UVGAIN, SATURATION_DEFAULT); 2060560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R23_UOFFSET, BLUE_BALANCE_DEFAULT); 2070560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R24_VOFFSET, RED_BALANCE_DEFAULT); 2080560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, SHARPNESS_DEFAULT); 2090560f337SMauro Carvalho Chehab 2100560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R14_GAMMA, 0x20); 2110560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R15_RGAIN, 0x20); 2120560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R16_GGAIN, 0x20); 2130560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R17_BGAIN, 0x20); 2140560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R18_ROFFSET, 0x00); 2150560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R19_GOFFSET, 0x00); 2160560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R1A_BOFFSET, 0x00); 2170560f337SMauro Carvalho Chehab } 2180560f337SMauro Carvalho Chehab 21901c28193SMauro Carvalho Chehab static int em28xx_set_outfmt(struct em28xx *dev) 2200560f337SMauro Carvalho Chehab { 2210560f337SMauro Carvalho Chehab int ret; 2220560f337SMauro Carvalho Chehab u8 fmt, vinctrl; 223753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2240560f337SMauro Carvalho Chehab 22506e20672SFrank Schaefer fmt = v4l2->format->reg; 2260560f337SMauro Carvalho Chehab if (!dev->is_em25xx) 2270560f337SMauro Carvalho Chehab fmt |= 0x20; 2280560f337SMauro Carvalho Chehab /* 2290560f337SMauro Carvalho Chehab * NOTE: it's not clear if this is really needed ! 2300560f337SMauro Carvalho Chehab * The datasheets say bit 5 is a reserved bit and devices seem to work 2310560f337SMauro Carvalho Chehab * fine without it. But the Windows driver sets it for em2710/50+em28xx 2320560f337SMauro Carvalho Chehab * devices and we've always been setting it, too. 2330560f337SMauro Carvalho Chehab * 2340560f337SMauro Carvalho Chehab * em2765 (em25xx, em276x/7x/8x) devices do NOT work with this bit set, 2350560f337SMauro Carvalho Chehab * it's likely used for an additional (compressed ?) format there. 2360560f337SMauro Carvalho Chehab */ 2370560f337SMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM28XX_R27_OUTFMT, fmt); 2380560f337SMauro Carvalho Chehab if (ret < 0) 2390560f337SMauro Carvalho Chehab return ret; 2400560f337SMauro Carvalho Chehab 2419297285eSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R10_VINMODE, v4l2->vinmode); 2420560f337SMauro Carvalho Chehab if (ret < 0) 2430560f337SMauro Carvalho Chehab return ret; 2440560f337SMauro Carvalho Chehab 2459297285eSFrank Schaefer vinctrl = v4l2->vinctl; 2460560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2470560f337SMauro Carvalho Chehab vinctrl |= EM28XX_VINCTRL_VBI_RAW; 2480560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R34_VBI_START_H, 0x00); 249753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R36_VBI_WIDTH, v4l2->vbi_width/4); 250753aee77SFrank Schaefer em28xx_write_reg(dev, EM28XX_R37_VBI_HEIGHT, v4l2->vbi_height); 25152faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 2520560f337SMauro Carvalho Chehab /* NTSC */ 2530560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x09); 25452faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 2550560f337SMauro Carvalho Chehab /* PAL */ 2560560f337SMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R35_VBI_START_V, 0x07); 2570560f337SMauro Carvalho Chehab } 2580560f337SMauro Carvalho Chehab } 2590560f337SMauro Carvalho Chehab 2600560f337SMauro Carvalho Chehab return em28xx_write_reg(dev, EM28XX_R11_VINCTRL, vinctrl); 2610560f337SMauro Carvalho Chehab } 2620560f337SMauro Carvalho Chehab 2630560f337SMauro Carvalho Chehab static int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, 2640560f337SMauro Carvalho Chehab u8 ymin, u8 ymax) 2650560f337SMauro Carvalho Chehab { 2660560f337SMauro Carvalho Chehab em28xx_videodbg("em28xx Scale: (%d,%d)-(%d,%d)\n", 2670560f337SMauro Carvalho Chehab xmin, ymin, xmax, ymax); 2680560f337SMauro Carvalho Chehab 2690560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R28_XMIN, &xmin, 1); 2700560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R29_XMAX, &xmax, 1); 2710560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R2A_YMIN, &ymin, 1); 2720560f337SMauro Carvalho Chehab return em28xx_write_regs(dev, EM28XX_R2B_YMAX, &ymax, 1); 2730560f337SMauro Carvalho Chehab } 2740560f337SMauro Carvalho Chehab 2750560f337SMauro Carvalho Chehab static void em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart, 2760560f337SMauro Carvalho Chehab u16 width, u16 height) 2770560f337SMauro Carvalho Chehab { 2780560f337SMauro Carvalho Chehab u8 cwidth = width >> 2; 2790560f337SMauro Carvalho Chehab u8 cheight = height >> 2; 2800560f337SMauro Carvalho Chehab u8 overflow = (height >> 9 & 0x02) | (width >> 10 & 0x01); 2810560f337SMauro Carvalho Chehab /* NOTE: size limit: 2047x1023 = 2MPix */ 2820560f337SMauro Carvalho Chehab 2830560f337SMauro Carvalho Chehab em28xx_videodbg("capture area set to (%d,%d): %dx%d\n", 2840560f337SMauro Carvalho Chehab hstart, vstart, 2850560f337SMauro Carvalho Chehab ((overflow & 2) << 9 | cwidth << 2), 2860560f337SMauro Carvalho Chehab ((overflow & 1) << 10 | cheight << 2)); 2870560f337SMauro Carvalho Chehab 2880560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1C_HSTART, &hstart, 1); 2890560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1D_VSTART, &vstart, 1); 2900560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1E_CWIDTH, &cwidth, 1); 2910560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1F_CHEIGHT, &cheight, 1); 2920560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R1B_OFLOW, &overflow, 1); 2930560f337SMauro Carvalho Chehab 2940560f337SMauro Carvalho Chehab /* FIXME: function/meaning of these registers ? */ 2950560f337SMauro Carvalho Chehab /* FIXME: align width+height to multiples of 4 ?! */ 2960560f337SMauro Carvalho Chehab if (dev->is_em25xx) { 2970560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x34, width >> 4); 2980560f337SMauro Carvalho Chehab em28xx_write_reg(dev, 0x35, height >> 4); 2990560f337SMauro Carvalho Chehab } 3000560f337SMauro Carvalho Chehab } 3010560f337SMauro Carvalho Chehab 3020560f337SMauro Carvalho Chehab static int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v) 3030560f337SMauro Carvalho Chehab { 304cba8e9b3SFrank Schaefer u8 mode = 0x00; 3050560f337SMauro Carvalho Chehab /* the em2800 scaler only supports scaling down to 50% */ 3060560f337SMauro Carvalho Chehab 3070560f337SMauro Carvalho Chehab if (dev->board.is_em2800) { 3080560f337SMauro Carvalho Chehab mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00); 3090560f337SMauro Carvalho Chehab } else { 3100560f337SMauro Carvalho Chehab u8 buf[2]; 3110560f337SMauro Carvalho Chehab 3120560f337SMauro Carvalho Chehab buf[0] = h; 3130560f337SMauro Carvalho Chehab buf[1] = h >> 8; 3140560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R30_HSCALELOW, (char *)buf, 2); 3150560f337SMauro Carvalho Chehab 3160560f337SMauro Carvalho Chehab buf[0] = v; 3170560f337SMauro Carvalho Chehab buf[1] = v >> 8; 3180560f337SMauro Carvalho Chehab em28xx_write_regs(dev, EM28XX_R32_VSCALELOW, (char *)buf, 2); 3190560f337SMauro Carvalho Chehab /* it seems that both H and V scalers must be active 3200560f337SMauro Carvalho Chehab to work correctly */ 3210560f337SMauro Carvalho Chehab mode = (h || v) ? 0x30 : 0x00; 3220560f337SMauro Carvalho Chehab } 323cba8e9b3SFrank Schaefer return em28xx_write_reg(dev, EM28XX_R26_COMPR, mode); 3240560f337SMauro Carvalho Chehab } 3250560f337SMauro Carvalho Chehab 3260560f337SMauro Carvalho Chehab /* FIXME: this only function read values from dev */ 32701c28193SMauro Carvalho Chehab static int em28xx_resolution_set(struct em28xx *dev) 3280560f337SMauro Carvalho Chehab { 329753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 330753aee77SFrank Schaefer int width = norm_maxw(dev); 331753aee77SFrank Schaefer int height = norm_maxh(dev); 3320560f337SMauro Carvalho Chehab 3330560f337SMauro Carvalho Chehab /* Properly setup VBI */ 334753aee77SFrank Schaefer v4l2->vbi_width = 720; 33552faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) 336753aee77SFrank Schaefer v4l2->vbi_height = 12; 3370560f337SMauro Carvalho Chehab else 338753aee77SFrank Schaefer v4l2->vbi_height = 18; 3390560f337SMauro Carvalho Chehab 3400560f337SMauro Carvalho Chehab em28xx_set_outfmt(dev); 3410560f337SMauro Carvalho Chehab 3420560f337SMauro Carvalho Chehab em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2); 3430560f337SMauro Carvalho Chehab 3440560f337SMauro Carvalho Chehab /* If we don't set the start position to 2 in VBI mode, we end up 3450560f337SMauro Carvalho Chehab with line 20/21 being YUYV encoded instead of being in 8-bit 3460560f337SMauro Carvalho Chehab greyscale. The core of the issue is that line 21 (and line 23 for 3470560f337SMauro Carvalho Chehab PAL WSS) are inside of active video region, and as a result they 3480560f337SMauro Carvalho Chehab get the pixelformatting associated with that area. So by cropping 3490560f337SMauro Carvalho Chehab it out, we end up with the same format as the rest of the VBI 3500560f337SMauro Carvalho Chehab region */ 3510560f337SMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) 3520560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 2, width, height); 3530560f337SMauro Carvalho Chehab else 3540560f337SMauro Carvalho Chehab em28xx_capture_area_set(dev, 0, 0, width, height); 3550560f337SMauro Carvalho Chehab 356753aee77SFrank Schaefer return em28xx_scaler_set(dev, v4l2->hscale, v4l2->vscale); 3570560f337SMauro Carvalho Chehab } 3580560f337SMauro Carvalho Chehab 3590560f337SMauro Carvalho Chehab /* Set USB alternate setting for analog video */ 36001c28193SMauro Carvalho Chehab static int em28xx_set_alternate(struct em28xx *dev) 3610560f337SMauro Carvalho Chehab { 362753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 363c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 3640560f337SMauro Carvalho Chehab int errCode; 3650560f337SMauro Carvalho Chehab int i; 366753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3670560f337SMauro Carvalho Chehab 3680560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3690560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3700560f337SMauro Carvalho Chehab dev->alt = 0; 3710560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3720560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3730560f337SMauro Carvalho Chehab dev->alt = alt; 3740560f337SMauro Carvalho Chehab goto set_alt; 3750560f337SMauro Carvalho Chehab } 3760560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3770560f337SMauro Carvalho Chehab goto set_alt; 3780560f337SMauro Carvalho Chehab 3790560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3800560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3810560f337SMauro Carvalho Chehab green screen will be received. 3820560f337SMauro Carvalho Chehab */ 383753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3840560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3850560f337SMauro Carvalho Chehab 3860560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3870560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3880560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3890560f337SMauro Carvalho Chehab dev->alt = i; 3900560f337SMauro Carvalho Chehab break; 3910560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3920560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3930560f337SMauro Carvalho Chehab */ 3940560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3950560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3960560f337SMauro Carvalho Chehab dev->alt = i; 3970560f337SMauro Carvalho Chehab } 3980560f337SMauro Carvalho Chehab 3990560f337SMauro Carvalho Chehab set_alt: 4000560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4010560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4020560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4030560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4040560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4050560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4060560f337SMauro Carvalho Chehab } else { /* isoc */ 4070560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4080560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4090560f337SMauro Carvalho Chehab dev->max_pkt_size = 4100560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4110560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4120560f337SMauro Carvalho Chehab } 4130560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4140560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 415c6d48134SMauro Carvalho Chehab errCode = usb_set_interface(udev, dev->ifnum, dev->alt); 4160560f337SMauro Carvalho Chehab if (errCode < 0) { 41729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 418ce8591ffSMauro Carvalho Chehab "cannot change alternate number to %d (error=%i)\n", 4190560f337SMauro Carvalho Chehab dev->alt, errCode); 4200560f337SMauro Carvalho Chehab return errCode; 4210560f337SMauro Carvalho Chehab } 4220560f337SMauro Carvalho Chehab return 0; 4230560f337SMauro Carvalho Chehab } 4240560f337SMauro Carvalho Chehab 4250c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4260c0d06caSMauro Carvalho Chehab DMA and thread functions 4270c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4280c0d06caSMauro Carvalho Chehab 4290c0d06caSMauro Carvalho Chehab /* 430948a49aaSFrank Schaefer * Finish the current buffer 4310c0d06caSMauro Carvalho Chehab */ 432948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4330c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4340c0d06caSMauro Carvalho Chehab { 435d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 436d3829fadSDevin Heitmueller 4372d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++; 438662c97cfSFrank Schaefer if (dev->v4l2->progressive) 4392d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE; 440662c97cfSFrank Schaefer else 4412d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED; 442d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns(); 443d3829fadSDevin Heitmueller 4442d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 4450c0d06caSMauro Carvalho Chehab } 4460c0d06caSMauro Carvalho Chehab 4470c0d06caSMauro Carvalho Chehab /* 44836016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4490c0d06caSMauro Carvalho Chehab */ 4500c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4510c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 45236016a35SFrank Schaefer unsigned char *usb_buf, 4534078d625SFrank Schaefer unsigned long len) 4540c0d06caSMauro Carvalho Chehab { 45558159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4560c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4570c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 45858159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4590c0d06caSMauro Carvalho Chehab 460d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 461d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4620c0d06caSMauro Carvalho Chehab 46336016a35SFrank Schaefer startread = usb_buf; 4640c0d06caSMauro Carvalho Chehab remain = len; 4650c0d06caSMauro Carvalho Chehab 46658159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 46736016a35SFrank Schaefer fieldstart = buf->vb_buf; 468c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46936016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4700c0d06caSMauro Carvalho Chehab 4718732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4728732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4730c0d06caSMauro Carvalho Chehab 47458159171SFrank Schaefer if (v4l2->progressive) 4750c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4760c0d06caSMauro Carvalho Chehab else 4770c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4780c0d06caSMauro Carvalho Chehab 4790c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4800c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4810c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4820c0d06caSMauro Carvalho Chehab 483d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4847983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4850c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 486d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 487d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48836016a35SFrank Schaefer (char *)startwrite; 4890c0d06caSMauro Carvalho Chehab lencopy = remain; 4900c0d06caSMauro Carvalho Chehab } 4910c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4920c0d06caSMauro Carvalho Chehab return; 4930c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4940c0d06caSMauro Carvalho Chehab 4950c0d06caSMauro Carvalho Chehab remain -= lencopy; 4960c0d06caSMauro Carvalho Chehab 4970c0d06caSMauro Carvalho Chehab while (remain > 0) { 49858159171SFrank Schaefer if (v4l2->progressive) 499c02ec71bSFrank Schaefer startwrite += lencopy; 500c02ec71bSFrank Schaefer else 5010c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5020c0d06caSMauro Carvalho Chehab startread += lencopy; 5030c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5040c0d06caSMauro Carvalho Chehab lencopy = remain; 5050c0d06caSMauro Carvalho Chehab else 5060c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5070c0d06caSMauro Carvalho Chehab 50836016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 509d3829fadSDevin Heitmueller buf->length) { 5105ccb197dSMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end(2)\n", 5110c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 512d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 513d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5140c0d06caSMauro Carvalho Chehab (char *)startwrite; 5150c0d06caSMauro Carvalho Chehab } 5160c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5170c0d06caSMauro Carvalho Chehab break; 5180c0d06caSMauro Carvalho Chehab 5190c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5200c0d06caSMauro Carvalho Chehab 5210c0d06caSMauro Carvalho Chehab remain -= lencopy; 5220c0d06caSMauro Carvalho Chehab } 5230c0d06caSMauro Carvalho Chehab 5248732533bSFrank Schaefer buf->pos += len; 5250c0d06caSMauro Carvalho Chehab } 5260c0d06caSMauro Carvalho Chehab 52736016a35SFrank Schaefer /* 52836016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52936016a35SFrank Schaefer */ 5300c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5310c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53236016a35SFrank Schaefer unsigned char *usb_buf, 5334078d625SFrank Schaefer unsigned long len) 5340c0d06caSMauro Carvalho Chehab { 53536016a35SFrank Schaefer unsigned int offset; 5360c0d06caSMauro Carvalho Chehab 537d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 538d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5390c0d06caSMauro Carvalho Chehab 5408732533bSFrank Schaefer offset = buf->pos; 5410c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54236016a35SFrank Schaefer if (buf->top_field == 0) 543753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5440c0d06caSMauro Carvalho Chehab 54536016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5468732533bSFrank Schaefer buf->pos += len; 5470c0d06caSMauro Carvalho Chehab } 5480c0d06caSMauro Carvalho Chehab 5490c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5500c0d06caSMauro Carvalho Chehab int packet, int status) 5510c0d06caSMauro Carvalho Chehab { 5520c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5530c0d06caSMauro Carvalho Chehab 5540c0d06caSMauro Carvalho Chehab switch (status) { 5550c0d06caSMauro Carvalho Chehab case -ENOENT: 5560c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5570c0d06caSMauro Carvalho Chehab break; 5580c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5590c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5600c0d06caSMauro Carvalho Chehab break; 5610c0d06caSMauro Carvalho Chehab case -ENOSR: 5620c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5630c0d06caSMauro Carvalho Chehab break; 5640c0d06caSMauro Carvalho Chehab case -EPIPE: 5650c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5660c0d06caSMauro Carvalho Chehab break; 5670c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5680c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5690c0d06caSMauro Carvalho Chehab break; 5700c0d06caSMauro Carvalho Chehab case -EPROTO: 5710c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5720c0d06caSMauro Carvalho Chehab break; 5730c0d06caSMauro Carvalho Chehab case -EILSEQ: 5740c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5750c0d06caSMauro Carvalho Chehab break; 5760c0d06caSMauro Carvalho Chehab case -ETIME: 5770c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5780c0d06caSMauro Carvalho Chehab break; 5790c0d06caSMauro Carvalho Chehab } 5800c0d06caSMauro Carvalho Chehab if (packet < 0) { 5810c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5820c0d06caSMauro Carvalho Chehab } else { 5830c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5840c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5850c0d06caSMauro Carvalho Chehab } 5860c0d06caSMauro Carvalho Chehab } 5870c0d06caSMauro Carvalho Chehab 5880c0d06caSMauro Carvalho Chehab /* 58924a6d849SFrank Schaefer * get the next available buffer from dma queue 5900c0d06caSMauro Carvalho Chehab */ 59124a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59224a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5930c0d06caSMauro Carvalho Chehab { 59424a6d849SFrank Schaefer struct em28xx_buffer *buf; 5950c0d06caSMauro Carvalho Chehab 5960c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5970c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59824a6d849SFrank Schaefer return NULL; 5990c0d06caSMauro Carvalho Chehab } 6000c0d06caSMauro Carvalho Chehab 6010c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 602d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6030c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 604d3829fadSDevin Heitmueller list_del(&buf->list); 6058732533bSFrank Schaefer buf->pos = 0; 606d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6070c0d06caSMauro Carvalho Chehab 60824a6d849SFrank Schaefer return buf; 6090c0d06caSMauro Carvalho Chehab } 6100c0d06caSMauro Carvalho Chehab 611e04c00d9SFrank Schaefer /* 612e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 613e04c00d9SFrank Schaefer */ 614e04c00d9SFrank Schaefer static struct em28xx_buffer * 615e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 616e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 617e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 618e04c00d9SFrank Schaefer { 61958159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 62058159171SFrank Schaefer 621f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 622e04c00d9SFrank Schaefer if (buf != NULL) 623e04c00d9SFrank Schaefer finish_buffer(dev, buf); 624e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 625e04c00d9SFrank Schaefer } 626e04c00d9SFrank Schaefer if (buf != NULL) { 627f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 628e04c00d9SFrank Schaefer buf->pos = 0; 629e04c00d9SFrank Schaefer } 630e04c00d9SFrank Schaefer 631e04c00d9SFrank Schaefer return buf; 632e04c00d9SFrank Schaefer } 633e04c00d9SFrank Schaefer 634227b7c90SFrank Schaefer /* 635227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 636227b7c90SFrank Schaefer */ 637227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 638227b7c90SFrank Schaefer unsigned char *data_pkt, 639227b7c90SFrank Schaefer unsigned int data_len) 640227b7c90SFrank Schaefer { 641753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 642227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 643227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 644227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 645227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 646227b7c90SFrank Schaefer 647227b7c90SFrank Schaefer /* capture type 0 = vbi start 648227b7c90SFrank Schaefer capture type 1 = vbi in progress 649227b7c90SFrank Schaefer capture type 2 = video start 650227b7c90SFrank Schaefer capture type 3 = video in progress */ 651227b7c90SFrank Schaefer if (data_len >= 4) { 652227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 653227b7c90SFrank Schaefer * never split across packets */ 654227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 655227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 656227b7c90SFrank Schaefer /* Continuation */ 657227b7c90SFrank Schaefer data_pkt += 4; 658227b7c90SFrank Schaefer data_len -= 4; 659227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 660227b7c90SFrank Schaefer /* Field start (VBI mode) */ 661f0e38230SFrank Schaefer v4l2->capture_type = 0; 662f0e38230SFrank Schaefer v4l2->vbi_read = 0; 663227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 664f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 665227b7c90SFrank Schaefer data_pkt += 4; 666227b7c90SFrank Schaefer data_len -= 4; 667227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 668227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 669f0e38230SFrank Schaefer v4l2->capture_type = 2; 670227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 671f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 672227b7c90SFrank Schaefer data_pkt += 4; 673227b7c90SFrank Schaefer data_len -= 4; 674227b7c90SFrank Schaefer } 675227b7c90SFrank Schaefer } 676227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 677227b7c90SFrank Schaefer * have no continuation header */ 678227b7c90SFrank Schaefer 679f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 680227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 681227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 682f0e38230SFrank Schaefer v4l2->capture_type = 1; 683227b7c90SFrank Schaefer } 684227b7c90SFrank Schaefer 685f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 686753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 687f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 688f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 689227b7c90SFrank Schaefer 690227b7c90SFrank Schaefer /* Copy VBI data */ 691227b7c90SFrank Schaefer if (vbi_buf != NULL) 692227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 693f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 694227b7c90SFrank Schaefer 695227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 696227b7c90SFrank Schaefer /* Continue with copying video data */ 697f0e38230SFrank Schaefer v4l2->capture_type = 2; 698227b7c90SFrank Schaefer data_pkt += vbi_data_len; 699227b7c90SFrank Schaefer data_len -= vbi_data_len; 700227b7c90SFrank Schaefer } 701227b7c90SFrank Schaefer } 702227b7c90SFrank Schaefer 703f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 704227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 705227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 706f0e38230SFrank Schaefer v4l2->capture_type = 3; 707227b7c90SFrank Schaefer } 708227b7c90SFrank Schaefer 709f0e38230SFrank Schaefer if (v4l2->capture_type == 3 && buf != NULL && data_len > 0) 710227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 711227b7c90SFrank Schaefer } 712227b7c90SFrank Schaefer 713e507e0e5SFrank Schaefer /* 714e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 715e507e0e5SFrank Schaefer */ 716e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 717e507e0e5SFrank Schaefer unsigned char *data_pkt, 718e507e0e5SFrank Schaefer unsigned int data_len) 719e507e0e5SFrank Schaefer { 720e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 721e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 722f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7237e6c8c19SMauro Carvalho Chehab bool frame_end = false; 724e507e0e5SFrank Schaefer 725e507e0e5SFrank Schaefer /* Check for header */ 726e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 727e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 728e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 729e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 730e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 731f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 732e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 733e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 734e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 735e507e0e5SFrank Schaefer data_pkt += 2; 736e507e0e5SFrank Schaefer data_len -= 2; 737e507e0e5SFrank Schaefer } 738e507e0e5SFrank Schaefer 739e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 740e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 741e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 742e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 743e507e0e5SFrank Schaefer } 744e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 745e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 746e507e0e5SFrank Schaefer * first frame. 747e507e0e5SFrank Schaefer */ 748e507e0e5SFrank Schaefer } 749e507e0e5SFrank Schaefer 750e507e0e5SFrank Schaefer /* Copy data */ 751e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 752e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 753e507e0e5SFrank Schaefer 754e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 755e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 756e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 757e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 758e507e0e5SFrank Schaefer } 759e507e0e5SFrank Schaefer 760e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 761e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 762e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 763e507e0e5SFrank Schaefer * header like with the other em28xx devices. 764e507e0e5SFrank Schaefer */ 765e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 766e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 767e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 768e507e0e5SFrank Schaefer } 769e507e0e5SFrank Schaefer 770960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7710fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7720c0d06caSMauro Carvalho Chehab { 773227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 774227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 775227b7c90SFrank Schaefer unsigned int usb_data_len; 7760c0d06caSMauro Carvalho Chehab 7770c0d06caSMauro Carvalho Chehab if (!dev) 7780c0d06caSMauro Carvalho Chehab return 0; 7790c0d06caSMauro Carvalho Chehab 7802665c299SFrank Schaefer if (dev->disconnected) 7810c0d06caSMauro Carvalho Chehab return 0; 7820c0d06caSMauro Carvalho Chehab 7831653cb0cSFrank Schaefer if (urb->status < 0) 7840c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7850c0d06caSMauro Carvalho Chehab 7864601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7874601cc39SFrank Schaefer 7884601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7894601cc39SFrank Schaefer num_packets = 1; 7904601cc39SFrank Schaefer else /* isoc */ 7914601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7920c0d06caSMauro Carvalho Chehab 7934601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7944601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 795227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7964601cc39SFrank Schaefer 797227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7984601cc39SFrank Schaefer } else { /* isoc */ 7994601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 8004601cc39SFrank Schaefer print_err_status(dev, i, 8014601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8020c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8030c0d06caSMauro Carvalho Chehab continue; 8040c0d06caSMauro Carvalho Chehab } 8050c0d06caSMauro Carvalho Chehab 806227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 807227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8080c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8090c0d06caSMauro Carvalho Chehab continue; 8100c0d06caSMauro Carvalho Chehab } 8110c0d06caSMauro Carvalho Chehab 812227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8134601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8144601cc39SFrank Schaefer } 8154601cc39SFrank Schaefer 816227b7c90SFrank Schaefer if (usb_data_len == 0) { 8174601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8184601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8194601cc39SFrank Schaefer continue; 8204601cc39SFrank Schaefer } 8210c0d06caSMauro Carvalho Chehab 822e507e0e5SFrank Schaefer if (dev->is_em25xx) 823e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 824e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 825e507e0e5SFrank Schaefer else 826e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 827e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 828e507e0e5SFrank Schaefer 8290c0d06caSMauro Carvalho Chehab } 830227b7c90SFrank Schaefer return 1; 8310c0d06caSMauro Carvalho Chehab } 8320c0d06caSMauro Carvalho Chehab 833d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 834d3829fadSDevin Heitmueller { 835d3829fadSDevin Heitmueller switch (f_type) { 836d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 837d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 838d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 839d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 840d3829fadSDevin Heitmueller default: 841d3829fadSDevin Heitmueller BUG(); 842d3829fadSDevin Heitmueller } 843d3829fadSDevin Heitmueller } 844d3829fadSDevin Heitmueller 845d3829fadSDevin Heitmueller /* Usage lock check functions */ 846d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 847d3829fadSDevin Heitmueller { 848d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 849d3829fadSDevin Heitmueller 850d3829fadSDevin Heitmueller /* is it free? */ 851d3829fadSDevin Heitmueller if (dev->resources & res_type) { 852d3829fadSDevin Heitmueller /* no, someone else uses it */ 853d3829fadSDevin Heitmueller return -EBUSY; 854d3829fadSDevin Heitmueller } 855d3829fadSDevin Heitmueller 856d3829fadSDevin Heitmueller /* it's free, grab it */ 857d3829fadSDevin Heitmueller dev->resources |= res_type; 858d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 859d3829fadSDevin Heitmueller return 0; 860d3829fadSDevin Heitmueller } 861d3829fadSDevin Heitmueller 862d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 863d3829fadSDevin Heitmueller { 864d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 865d3829fadSDevin Heitmueller 866d3829fadSDevin Heitmueller dev->resources &= ~res_type; 867d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 868d3829fadSDevin Heitmueller } 869d3829fadSDevin Heitmueller 87037ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev) 87137ecc7b1SMauro Carvalho Chehab { 87237ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 87337ecc7b1SMauro Carvalho Chehab int i; 87437ecc7b1SMauro Carvalho Chehab 87537ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 87637ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 87737ecc7b1SMauro Carvalho Chehab return; 87837ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]); 87937ecc7b1SMauro Carvalho Chehab } 88037ecc7b1SMauro Carvalho Chehab #endif 88137ecc7b1SMauro Carvalho Chehab } 88237ecc7b1SMauro Carvalho Chehab 88337ecc7b1SMauro Carvalho Chehab /* 88437ecc7b1SMauro Carvalho Chehab * Media Controller helper functions 88537ecc7b1SMauro Carvalho Chehab */ 88637ecc7b1SMauro Carvalho Chehab 88737ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev) 88837ecc7b1SMauro Carvalho Chehab { 88937ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 89037ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev; 89137ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 89237ecc7b1SMauro Carvalho Chehab struct media_entity *source; 89337ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL; 89437ecc7b1SMauro Carvalho Chehab int ret, active_links = 0; 89537ecc7b1SMauro Carvalho Chehab 89637ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder) 89737ecc7b1SMauro Carvalho Chehab return 0; 89837ecc7b1SMauro Carvalho Chehab 89937ecc7b1SMauro Carvalho Chehab /* 90037ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder. 90137ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be 90237ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't 90337ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2, 90437ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs. 90537ecc7b1SMauro Carvalho Chehab */ 90637ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) { 90737ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) { 90837ecc7b1SMauro Carvalho Chehab found_link = link; 90937ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED) 91037ecc7b1SMauro Carvalho Chehab active_links++; 91137ecc7b1SMauro Carvalho Chehab break; 91237ecc7b1SMauro Carvalho Chehab } 91337ecc7b1SMauro Carvalho Chehab } 91437ecc7b1SMauro Carvalho Chehab 91537ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link) 91637ecc7b1SMauro Carvalho Chehab return 0; 91737ecc7b1SMauro Carvalho Chehab 91837ecc7b1SMauro Carvalho Chehab source = found_link->source->entity; 91937ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) { 92037ecc7b1SMauro Carvalho Chehab struct media_entity *sink; 92137ecc7b1SMauro Carvalho Chehab int flags = 0; 92237ecc7b1SMauro Carvalho Chehab 92337ecc7b1SMauro Carvalho Chehab sink = link->sink->entity; 92437ecc7b1SMauro Carvalho Chehab 92537ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder) 92637ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED; 92737ecc7b1SMauro Carvalho Chehab 92837ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags); 92937ecc7b1SMauro Carvalho Chehab if (ret) { 93029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 931ce8591ffSMauro Carvalho Chehab "Couldn't change link %s->%s to %s. Error %d\n", 93237ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93337ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled", 93437ecc7b1SMauro Carvalho Chehab ret); 93537ecc7b1SMauro Carvalho Chehab return ret; 93637ecc7b1SMauro Carvalho Chehab } else 93737ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n", 93837ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93937ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled"); 94037ecc7b1SMauro Carvalho Chehab } 94137ecc7b1SMauro Carvalho Chehab #endif 94237ecc7b1SMauro Carvalho Chehab return 0; 94337ecc7b1SMauro Carvalho Chehab } 94437ecc7b1SMauro Carvalho Chehab 94537ecc7b1SMauro Carvalho Chehab static const char * const iname[] = { 94637ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite", 94737ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 94837ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 94937ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio", 95037ecc7b1SMauro Carvalho Chehab }; 95137ecc7b1SMauro Carvalho Chehab 95237ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev) 95337ecc7b1SMauro Carvalho Chehab { 95437ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER) 95537ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 95637ecc7b1SMauro Carvalho Chehab int ret, i; 95737ecc7b1SMauro Carvalho Chehab 95837ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */ 95937ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK; 96037ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad); 96137ecc7b1SMauro Carvalho Chehab if (ret < 0) 96229b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 963ce8591ffSMauro Carvalho Chehab "failed to initialize video media entity!\n"); 96437ecc7b1SMauro Carvalho Chehab 96537ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) { 96637ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK; 96737ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1, 96837ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad); 96937ecc7b1SMauro Carvalho Chehab if (ret < 0) 97029b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 971ce8591ffSMauro Carvalho Chehab "failed to initialize vbi media entity!\n"); 97237ecc7b1SMauro Carvalho Chehab } 97337ecc7b1SMauro Carvalho Chehab 97437ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */ 97537ecc7b1SMauro Carvalho Chehab if (dev->board.is_webcam) 97637ecc7b1SMauro Carvalho Chehab return; 97737ecc7b1SMauro Carvalho Chehab 97837ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */ 97937ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 98037ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i]; 98137ecc7b1SMauro Carvalho Chehab 98237ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 98337ecc7b1SMauro Carvalho Chehab break; 98437ecc7b1SMauro Carvalho Chehab 98537ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type]; 98637ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR; 98737ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 98837ecc7b1SMauro Carvalho Chehab 98937ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) { 99037ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE: 99137ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 99237ecc7b1SMauro Carvalho Chehab break; 99337ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO: 99437ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO; 99537ecc7b1SMauro Carvalho Chehab break; 99637ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */ 997e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 99837ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF; 99937ecc7b1SMauro Carvalho Chehab break; 100037ecc7b1SMauro Carvalho Chehab } 100137ecc7b1SMauro Carvalho Chehab 100237ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 100337ecc7b1SMauro Carvalho Chehab if (ret < 0) 100429b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1005ce8591ffSMauro Carvalho Chehab "failed to initialize input pad[%d]!\n", i); 100637ecc7b1SMauro Carvalho Chehab 100737ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent); 100837ecc7b1SMauro Carvalho Chehab if (ret < 0) 100929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 1010ce8591ffSMauro Carvalho Chehab "failed to register input entity %d!\n", i); 101137ecc7b1SMauro Carvalho Chehab } 101237ecc7b1SMauro Carvalho Chehab #endif 101337ecc7b1SMauro Carvalho Chehab } 101437ecc7b1SMauro Carvalho Chehab 101537ecc7b1SMauro Carvalho Chehab 10160c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1017d3829fadSDevin Heitmueller Videobuf2 operations 10180c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 10190c0d06caSMauro Carvalho Chehab 1020df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq, 1021d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 102236c0f8b3SHans Verkuil unsigned int sizes[], struct device *alloc_devs[]) 10230c0d06caSMauro Carvalho Chehab { 1024d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1025753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1026df9ecb0cSHans Verkuil unsigned long size = 102706e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 10280c0d06caSMauro Carvalho Chehab 1029df9ecb0cSHans Verkuil if (*nplanes) 1030df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0; 1031d3829fadSDevin Heitmueller *nplanes = 1; 1032d3829fadSDevin Heitmueller sizes[0] = size; 103337ecc7b1SMauro Carvalho Chehab 103437ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev); 103537ecc7b1SMauro Carvalho Chehab 10360c0d06caSMauro Carvalho Chehab return 0; 10370c0d06caSMauro Carvalho Chehab } 10380c0d06caSMauro Carvalho Chehab 10390c0d06caSMauro Carvalho Chehab static int 1040d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 10410c0d06caSMauro Carvalho Chehab { 10422d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1043d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1044753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1045d3829fadSDevin Heitmueller unsigned long size; 10460c0d06caSMauro Carvalho Chehab 10472d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field); 10480c0d06caSMauro Carvalho Chehab 104906e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 1050d3829fadSDevin Heitmueller 1051d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 1052d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 1053d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 10540c0d06caSMauro Carvalho Chehab return -EINVAL; 1055d3829fadSDevin Heitmueller } 10562d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size); 10570c0d06caSMauro Carvalho Chehab 1058d3829fadSDevin Heitmueller return 0; 10590c0d06caSMauro Carvalho Chehab } 10600c0d06caSMauro Carvalho Chehab 1061d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 1062d3829fadSDevin Heitmueller { 1063d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1064f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1065d3829fadSDevin Heitmueller struct v4l2_frequency f; 10662d700715SJunghak Sung struct v4l2_fh *owner; 1067d3829fadSDevin Heitmueller int rc = 0; 10680c0d06caSMauro Carvalho Chehab 1069d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1070d3829fadSDevin Heitmueller 1071d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 1072d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 1073d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1074d3829fadSDevin Heitmueller if (rc) 1075d3829fadSDevin Heitmueller return rc; 1076d3829fadSDevin Heitmueller 10778139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1078d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1079d3829fadSDevin Heitmueller 1080d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1081d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1082d3829fadSDevin Heitmueller 1083d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 1084d3829fadSDevin Heitmueller some i2c device 1085d3829fadSDevin Heitmueller */ 1086d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1087d3829fadSDevin Heitmueller 1088f0e38230SFrank Schaefer v4l2->capture_type = -1; 1089c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1090c647a91aSFrank Schaefer dev->analog_xfer_bulk, 10910c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 10920c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1093c647a91aSFrank Schaefer dev->packet_multiplier, 10940fa4a402SFrank Schaefer em28xx_urb_data_copy); 10950c0d06caSMauro Carvalho Chehab if (rc < 0) 1096032f1ddfSFrank Schaefer return rc; 1097d3829fadSDevin Heitmueller 1098d3829fadSDevin Heitmueller /* 1099d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1100d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1101d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1102d3829fadSDevin Heitmueller */ 1103d3829fadSDevin Heitmueller 1104d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1105d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11063854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11072d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11082d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1109d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1110d3829fadSDevin Heitmueller else 1111d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1112f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 111395d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 111413d52fe4SMauro Carvalho Chehab 111513d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 111613d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11170c0d06caSMauro Carvalho Chehab } 11180c0d06caSMauro Carvalho Chehab 11198139a4d5SFrank Schaefer v4l2->streaming_users++; 1120032f1ddfSFrank Schaefer 11210c0d06caSMauro Carvalho Chehab return rc; 11220c0d06caSMauro Carvalho Chehab } 11230c0d06caSMauro Carvalho Chehab 1124e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11250c0d06caSMauro Carvalho Chehab { 1126d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11278139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11280c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1129d3829fadSDevin Heitmueller unsigned long flags = 0; 11300c0d06caSMauro Carvalho Chehab 1131d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11320c0d06caSMauro Carvalho Chehab 1133d3829fadSDevin Heitmueller res_free(dev, vq->type); 1134d3829fadSDevin Heitmueller 11358139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 113613d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 113713d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 113813d52fe4SMauro Carvalho Chehab 1139d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1140d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11410c0d06caSMauro Carvalho Chehab } 11420c0d06caSMauro Carvalho Chehab 1143d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1144627530c3SFrank Schaefer if (dev->usb_ctl.vid_buf != NULL) { 11452d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11462d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1147627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1148627530c3SFrank Schaefer } 1149d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1150d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1151fdf1bc9fSMauro Carvalho Chehab 1152d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1153d3829fadSDevin Heitmueller list_del(&buf->list); 11542d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1155d3829fadSDevin Heitmueller } 1156d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1157d3829fadSDevin Heitmueller } 1158d3829fadSDevin Heitmueller 1159e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11600c0d06caSMauro Carvalho Chehab { 1161d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11628139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1163d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1164d3829fadSDevin Heitmueller unsigned long flags = 0; 11650c0d06caSMauro Carvalho Chehab 1166d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11670c0d06caSMauro Carvalho Chehab 1168d3829fadSDevin Heitmueller res_free(dev, vq->type); 1169d3829fadSDevin Heitmueller 11708139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 117113d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 117213d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 117313d52fe4SMauro Carvalho Chehab 1174d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1175d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11760c0d06caSMauro Carvalho Chehab } 11770c0d06caSMauro Carvalho Chehab 1178d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1179627530c3SFrank Schaefer if (dev->usb_ctl.vbi_buf != NULL) { 11802d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 11812d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1182627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1183627530c3SFrank Schaefer } 1184d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1185d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1186fdf1bc9fSMauro Carvalho Chehab 1187d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1188d3829fadSDevin Heitmueller list_del(&buf->list); 11892d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1190d3829fadSDevin Heitmueller } 1191d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1192d3829fadSDevin Heitmueller } 1193d3829fadSDevin Heitmueller 1194d3829fadSDevin Heitmueller static void 1195d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1196d3829fadSDevin Heitmueller { 11972d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1198d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 11992d700715SJunghak Sung struct em28xx_buffer *buf = 12002d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1201d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1202d3829fadSDevin Heitmueller unsigned long flags = 0; 1203d3829fadSDevin Heitmueller 1204d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1205d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1206d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1207d3829fadSDevin Heitmueller 1208d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1209d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1210d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1211d3829fadSDevin Heitmueller } 1212d3829fadSDevin Heitmueller 12131bc17717SJulia Lawall static const struct vb2_ops em28xx_video_qops = { 1214d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12150c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12160c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1217d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1218d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1219d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1220d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12210c0d06caSMauro Carvalho Chehab }; 12220c0d06caSMauro Carvalho Chehab 122301c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1224d3829fadSDevin Heitmueller { 1225d3829fadSDevin Heitmueller int rc; 1226d3829fadSDevin Heitmueller struct vb2_queue *q; 122727a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1228d3829fadSDevin Heitmueller 1229d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 123027a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1231d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1232ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1233ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1234d3829fadSDevin Heitmueller q->drv_priv = dev; 1235d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1236d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1237d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1238d3829fadSDevin Heitmueller 1239d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1240d3829fadSDevin Heitmueller if (rc < 0) 1241d3829fadSDevin Heitmueller return rc; 1242d3829fadSDevin Heitmueller 1243d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 124427a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1245d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1246d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1247ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1248d3829fadSDevin Heitmueller q->drv_priv = dev; 1249d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1250d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1251d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1252d3829fadSDevin Heitmueller 1253d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1254d3829fadSDevin Heitmueller if (rc < 0) 1255d3829fadSDevin Heitmueller return rc; 1256d3829fadSDevin Heitmueller 1257d3829fadSDevin Heitmueller return 0; 1258d3829fadSDevin Heitmueller } 1259d3829fadSDevin Heitmueller 12600c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 12610c0d06caSMauro Carvalho Chehab 12620c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12630c0d06caSMauro Carvalho Chehab { 126495d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1265fdf1bc9fSMauro Carvalho Chehab 12660c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12670c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 12680c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 12690c0d06caSMauro Carvalho Chehab 12700c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 12710c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 12720c0d06caSMauro Carvalho Chehab 127395d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 12740c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 12750c0d06caSMauro Carvalho Chehab 12760c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 12770c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 127895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 12790c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 12800c0d06caSMauro Carvalho Chehab } 12810c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 128295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1283fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1284fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 12850c0d06caSMauro Carvalho Chehab } 12860c0d06caSMauro Carvalho Chehab 12870c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 128895d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 12890c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 12900c0d06caSMauro Carvalho Chehab } 12910c0d06caSMauro Carvalho Chehab 12920c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 12930c0d06caSMauro Carvalho Chehab } 12940c0d06caSMauro Carvalho Chehab 129501c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 12960c0d06caSMauro Carvalho Chehab { 1297081b945eSHans Verkuil struct em28xx *dev = priv; 12980c0d06caSMauro Carvalho Chehab 12990c0d06caSMauro Carvalho Chehab /* 1300081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1301081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1302081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1303081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 13040c0d06caSMauro Carvalho Chehab */ 13050c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13060c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1307081b945eSHans Verkuil dev->mute = ctrl->val; 1308081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13090c0d06caSMauro Carvalho Chehab break; 13100c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1311081b945eSHans Verkuil dev->volume = ctrl->val; 1312081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1313081b945eSHans Verkuil break; 1314081b945eSHans Verkuil } 1315081b945eSHans Verkuil } 1316081b945eSHans Verkuil 1317081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1318081b945eSHans Verkuil { 1319abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1320abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1321abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13228f8b113aSFrank Schaefer int ret = -EINVAL; 1323081b945eSHans Verkuil 1324081b945eSHans Verkuil switch (ctrl->id) { 1325081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1326081b945eSHans Verkuil dev->mute = ctrl->val; 13278f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1328081b945eSHans Verkuil break; 1329081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1330081b945eSHans Verkuil dev->volume = ctrl->val; 13318f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13328f8b113aSFrank Schaefer break; 13338f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13348f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13358f8b113aSFrank Schaefer break; 13368f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13378f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13388f8b113aSFrank Schaefer break; 13398f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13408f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13418f8b113aSFrank Schaefer break; 13428f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13438f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13448f8b113aSFrank Schaefer break; 13458f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13468f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13478f8b113aSFrank Schaefer break; 13488f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13498f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13500c0d06caSMauro Carvalho Chehab break; 13510c0d06caSMauro Carvalho Chehab } 13520c0d06caSMauro Carvalho Chehab 13538f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13540c0d06caSMauro Carvalho Chehab } 13550c0d06caSMauro Carvalho Chehab 13568068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1357081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1358081b945eSHans Verkuil }; 1359081b945eSHans Verkuil 13606b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13610c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13620c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13630c0d06caSMauro Carvalho Chehab { 13640c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13650c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13660c0d06caSMauro Carvalho Chehab 13670c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 136881685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 136981685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 13700c0d06caSMauro Carvalho Chehab 13710c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 137281685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 137381685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 13740c0d06caSMauro Carvalho Chehab } 13750c0d06caSMauro Carvalho Chehab 1376b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1377b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1378b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1379b8374138SFrank Schaefer { 1380b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1381b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1382b8374138SFrank Schaefer 1383b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1384b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 13850962a763SMauro Carvalho Chehab 13860962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 13870962a763SMauro Carvalho Chehab if (*width < 1) 13880962a763SMauro Carvalho Chehab *width = 1; 13890962a763SMauro Carvalho Chehab if (*height < 1) 13900962a763SMauro Carvalho Chehab *height = 1; 1391b8374138SFrank Schaefer } 1392b8374138SFrank Schaefer 13930c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 13940c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 13950c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 13960c0d06caSMauro Carvalho Chehab 13970c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 13980c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13990c0d06caSMauro Carvalho Chehab { 1400917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1401753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14020c0d06caSMauro Carvalho Chehab 1403753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1404753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 140506e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 140606e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1407753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14080c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14090c0d06caSMauro Carvalho Chehab 14100c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 141158159171SFrank Schaefer if (v4l2->progressive) 14120c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14130c0d06caSMauro Carvalho Chehab else 141458159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14150c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14160c0d06caSMauro Carvalho Chehab return 0; 14170c0d06caSMauro Carvalho Chehab } 14180c0d06caSMauro Carvalho Chehab 14190c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14200c0d06caSMauro Carvalho Chehab { 14210c0d06caSMauro Carvalho Chehab unsigned int i; 14220c0d06caSMauro Carvalho Chehab 14230c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14240c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14250c0d06caSMauro Carvalho Chehab return &format[i]; 14260c0d06caSMauro Carvalho Chehab 14270c0d06caSMauro Carvalho Chehab return NULL; 14280c0d06caSMauro Carvalho Chehab } 14290c0d06caSMauro Carvalho Chehab 14300c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14310c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14320c0d06caSMauro Carvalho Chehab { 1433917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 143458159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14350c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14360c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14370c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14380c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14390c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14400c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14410c0d06caSMauro Carvalho Chehab 14420c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14430c0d06caSMauro Carvalho Chehab if (!fmt) { 14440c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14450c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 14460c0d06caSMauro Carvalho Chehab return -EINVAL; 14470c0d06caSMauro Carvalho Chehab } 14480c0d06caSMauro Carvalho Chehab 14490c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14500c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14510c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14520c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1453d3829fadSDevin Heitmueller /* 1454d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1455d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1456d3829fadSDevin Heitmueller * to 50% 1457d3829fadSDevin Heitmueller */ 14580c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14590c0d06caSMauro Carvalho Chehab width /= 2; 14600c0d06caSMauro Carvalho Chehab } else { 14610c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 14620c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 14630c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14640c0d06caSMauro Carvalho Chehab 1, 0); 14650c0d06caSMauro Carvalho Chehab } 14660962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 14670962a763SMauro Carvalho Chehab if (width < 1) 14680962a763SMauro Carvalho Chehab width = 1; 14690962a763SMauro Carvalho Chehab if (height < 1) 14700962a763SMauro Carvalho Chehab height = 1; 14710c0d06caSMauro Carvalho Chehab 14726b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 147346f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 14740c0d06caSMauro Carvalho Chehab 14750c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 14760c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 14770c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1478e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 14790c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 14800c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 148158159171SFrank Schaefer if (v4l2->progressive) 14820c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14830c0d06caSMauro Carvalho Chehab else 148458159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14850c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 148651dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 14870c0d06caSMauro Carvalho Chehab 14880c0d06caSMauro Carvalho Chehab return 0; 14890c0d06caSMauro Carvalho Chehab } 14900c0d06caSMauro Carvalho Chehab 14910c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 14920c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 14930c0d06caSMauro Carvalho Chehab { 14940c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1495753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14960c0d06caSMauro Carvalho Chehab 14970c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 14980c0d06caSMauro Carvalho Chehab if (!fmt) 14990c0d06caSMauro Carvalho Chehab return -EINVAL; 15000c0d06caSMauro Carvalho Chehab 150106e20672SFrank Schaefer v4l2->format = fmt; 1502753aee77SFrank Schaefer v4l2->width = width; 1503753aee77SFrank Schaefer v4l2->height = height; 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab /* set new image size */ 1506753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1507753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15080c0d06caSMauro Carvalho Chehab 15090c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15100c0d06caSMauro Carvalho Chehab 15110c0d06caSMauro Carvalho Chehab return 0; 15120c0d06caSMauro Carvalho Chehab } 15130c0d06caSMauro Carvalho Chehab 15140c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15150c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15160c0d06caSMauro Carvalho Chehab { 1517d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15188139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15190c0d06caSMauro Carvalho Chehab 1520c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1521d3829fadSDevin Heitmueller return -EBUSY; 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15240c0d06caSMauro Carvalho Chehab 15250c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15260c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15270c0d06caSMauro Carvalho Chehab } 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15300c0d06caSMauro Carvalho Chehab { 1531917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15320c0d06caSMauro Carvalho Chehab 153352faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15340c0d06caSMauro Carvalho Chehab 15350c0d06caSMauro Carvalho Chehab return 0; 15360c0d06caSMauro Carvalho Chehab } 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15390c0d06caSMauro Carvalho Chehab { 1540917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15410c0d06caSMauro Carvalho Chehab 154295d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15430c0d06caSMauro Carvalho Chehab 15440c0d06caSMauro Carvalho Chehab return 0; 15450c0d06caSMauro Carvalho Chehab } 15460c0d06caSMauro Carvalho Chehab 1547314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15480c0d06caSMauro Carvalho Chehab { 1549917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1550753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15510c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15520c0d06caSMauro Carvalho Chehab 155352faaf78SFrank Schaefer if (norm == v4l2->norm) 1554d8c95c08SHans Verkuil return 0; 15550c0d06caSMauro Carvalho Chehab 15568139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1557d8c95c08SHans Verkuil return -EBUSY; 1558d8c95c08SHans Verkuil 155952faaf78SFrank Schaefer v4l2->norm = norm; 15600c0d06caSMauro Carvalho Chehab 15610c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1562d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1563314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15640c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15650c0d06caSMauro Carvalho Chehab 15660c0d06caSMauro Carvalho Chehab /* set new image size */ 1567753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1568753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1569753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1570753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15710c0d06caSMauro Carvalho Chehab 15720c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15738774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 15740c0d06caSMauro Carvalho Chehab 15750c0d06caSMauro Carvalho Chehab return 0; 15760c0d06caSMauro Carvalho Chehab } 15770c0d06caSMauro Carvalho Chehab 15780c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 15790c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 15800c0d06caSMauro Carvalho Chehab { 1581917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 158252faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15830c0d06caSMauro Carvalho Chehab int rc = 0; 15840c0d06caSMauro Carvalho Chehab 158586ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 15860c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 158752faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 15880c0d06caSMauro Carvalho Chehab video, g_parm, p); 15890c0d06caSMauro Carvalho Chehab else 159052faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 15910c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 15920c0d06caSMauro Carvalho Chehab 15930c0d06caSMauro Carvalho Chehab return rc; 15940c0d06caSMauro Carvalho Chehab } 15950c0d06caSMauro Carvalho Chehab 15960c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 15970c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 15980c0d06caSMauro Carvalho Chehab { 1599917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16000c0d06caSMauro Carvalho Chehab 160186ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 160295d2608bSFrank Schaefer return v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 160395d2608bSFrank Schaefer 0, video, s_parm, p); 16040c0d06caSMauro Carvalho Chehab } 16050c0d06caSMauro Carvalho Chehab 16060c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16070c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16080c0d06caSMauro Carvalho Chehab { 1609917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16100c0d06caSMauro Carvalho Chehab unsigned int n; 16110c0d06caSMauro Carvalho Chehab 16120c0d06caSMauro Carvalho Chehab n = i->index; 16130c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16140c0d06caSMauro Carvalho Chehab return -EINVAL; 16150c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 16160c0d06caSMauro Carvalho Chehab return -EINVAL; 16170c0d06caSMauro Carvalho Chehab 16180c0d06caSMauro Carvalho Chehab i->index = n; 16190c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16200c0d06caSMauro Carvalho Chehab 16210c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 16220c0d06caSMauro Carvalho Chehab 1623d83a96a5SMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type)) 16240c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16250c0d06caSMauro Carvalho Chehab 1626d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1627d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1628d8c95c08SHans Verkuil if (dev->board.is_webcam) 1629d8c95c08SHans Verkuil i->capabilities = 0; 16300c0d06caSMauro Carvalho Chehab 16310c0d06caSMauro Carvalho Chehab return 0; 16320c0d06caSMauro Carvalho Chehab } 16330c0d06caSMauro Carvalho Chehab 16340c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16350c0d06caSMauro Carvalho Chehab { 1636917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16370c0d06caSMauro Carvalho Chehab 16380c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 16390c0d06caSMauro Carvalho Chehab 16400c0d06caSMauro Carvalho Chehab return 0; 16410c0d06caSMauro Carvalho Chehab } 16420c0d06caSMauro Carvalho Chehab 16430c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 16440c0d06caSMauro Carvalho Chehab { 1645917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16460c0d06caSMauro Carvalho Chehab 16470c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 16480c0d06caSMauro Carvalho Chehab return -EINVAL; 16490c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 16500c0d06caSMauro Carvalho Chehab return -EINVAL; 16510c0d06caSMauro Carvalho Chehab 16520c0d06caSMauro Carvalho Chehab video_mux(dev, i); 16530c0d06caSMauro Carvalho Chehab return 0; 16540c0d06caSMauro Carvalho Chehab } 16550c0d06caSMauro Carvalho Chehab 16560c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 16570c0d06caSMauro Carvalho Chehab { 1658917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16590c0d06caSMauro Carvalho Chehab 16600c0d06caSMauro Carvalho Chehab switch (a->index) { 16610c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 16620c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 16630c0d06caSMauro Carvalho Chehab break; 16640c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 16650c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 16660c0d06caSMauro Carvalho Chehab break; 16670c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 16680c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 16690c0d06caSMauro Carvalho Chehab break; 16700c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 16710c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 16720c0d06caSMauro Carvalho Chehab break; 16730c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 16740c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 16750c0d06caSMauro Carvalho Chehab break; 16760c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 16770c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 16780c0d06caSMauro Carvalho Chehab break; 16790c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 16800c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 16810c0d06caSMauro Carvalho Chehab break; 16820c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 16830c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 16840c0d06caSMauro Carvalho Chehab break; 16850c0d06caSMauro Carvalho Chehab default: 16860c0d06caSMauro Carvalho Chehab return -EINVAL; 16870c0d06caSMauro Carvalho Chehab } 16880c0d06caSMauro Carvalho Chehab 16890c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 16900c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 16910c0d06caSMauro Carvalho Chehab 16920c0d06caSMauro Carvalho Chehab return 0; 16930c0d06caSMauro Carvalho Chehab } 16940c0d06caSMauro Carvalho Chehab 16950e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 16960c0d06caSMauro Carvalho Chehab { 1697917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16980c0d06caSMauro Carvalho Chehab 16990c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 17000c0d06caSMauro Carvalho Chehab return -EINVAL; 17010c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 17020c0d06caSMauro Carvalho Chehab return -EINVAL; 17030c0d06caSMauro Carvalho Chehab 17040c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 17050c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 17060c0d06caSMauro Carvalho Chehab 17070c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 17080c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 17090c0d06caSMauro Carvalho Chehab 17100c0d06caSMauro Carvalho Chehab return 0; 17110c0d06caSMauro Carvalho Chehab } 17120c0d06caSMauro Carvalho Chehab 17130c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 17140c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17150c0d06caSMauro Carvalho Chehab { 1716917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17170c0d06caSMauro Carvalho Chehab 17180c0d06caSMauro Carvalho Chehab if (0 != t->index) 17190c0d06caSMauro Carvalho Chehab return -EINVAL; 17200c0d06caSMauro Carvalho Chehab 17210c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 17220c0d06caSMauro Carvalho Chehab 172395d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 17240c0d06caSMauro Carvalho Chehab return 0; 17250c0d06caSMauro Carvalho Chehab } 17260c0d06caSMauro Carvalho Chehab 17270c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 17282f73c7c5SHans Verkuil const struct v4l2_tuner *t) 17290c0d06caSMauro Carvalho Chehab { 1730917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17310c0d06caSMauro Carvalho Chehab 17320c0d06caSMauro Carvalho Chehab if (0 != t->index) 17330c0d06caSMauro Carvalho Chehab return -EINVAL; 17340c0d06caSMauro Carvalho Chehab 173595d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 17360c0d06caSMauro Carvalho Chehab return 0; 17370c0d06caSMauro Carvalho Chehab } 17380c0d06caSMauro Carvalho Chehab 17390c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 17400c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 17410c0d06caSMauro Carvalho Chehab { 1742917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17433854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17440c0d06caSMauro Carvalho Chehab 174520deebfeSHans Verkuil if (0 != f->tuner) 174620deebfeSHans Verkuil return -EINVAL; 174720deebfeSHans Verkuil 17483854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 17490c0d06caSMauro Carvalho Chehab return 0; 17500c0d06caSMauro Carvalho Chehab } 17510c0d06caSMauro Carvalho Chehab 17520c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1753b530a447SHans Verkuil const struct v4l2_frequency *f) 17540c0d06caSMauro Carvalho Chehab { 1755b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1756917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 175795d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17580c0d06caSMauro Carvalho Chehab 17590c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 17600c0d06caSMauro Carvalho Chehab return -EINVAL; 17610c0d06caSMauro Carvalho Chehab 176295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 176395d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 17643854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 17650c0d06caSMauro Carvalho Chehab 17660c0d06caSMauro Carvalho Chehab return 0; 17670c0d06caSMauro Carvalho Chehab } 17680c0d06caSMauro Carvalho Chehab 1769cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 177096b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 177196b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 17723b2d17b4SHans Verkuil { 1773917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17743b2d17b4SHans Verkuil 17753b2d17b4SHans Verkuil if (chip->match.addr > 1) 17763b2d17b4SHans Verkuil return -EINVAL; 17773b2d17b4SHans Verkuil if (chip->match.addr == 1) 17783b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 17793b2d17b4SHans Verkuil else 178095d2608bSFrank Schaefer strlcpy(chip->name, 178195d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 17823b2d17b4SHans Verkuil return 0; 17833b2d17b4SHans Verkuil } 17843b2d17b4SHans Verkuil 178535deba32SFrank Schaefer static int em28xx_reg_len(int reg) 178635deba32SFrank Schaefer { 178735deba32SFrank Schaefer switch (reg) { 178835deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 178935deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 179035deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 179135deba32SFrank Schaefer return 2; 179235deba32SFrank Schaefer default: 179335deba32SFrank Schaefer return 1; 179435deba32SFrank Schaefer } 179535deba32SFrank Schaefer } 17960c0d06caSMauro Carvalho Chehab 17970c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 17980c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 17990c0d06caSMauro Carvalho Chehab { 1800917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18010c0d06caSMauro Carvalho Chehab int ret; 18020c0d06caSMauro Carvalho Chehab 18033b2d17b4SHans Verkuil if (reg->match.addr > 1) 18043b2d17b4SHans Verkuil return -EINVAL; 1805abca2056SHans Verkuil if (reg->match.addr) { 18060c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 18070c0d06caSMauro Carvalho Chehab if (ret < 0) 18080c0d06caSMauro Carvalho Chehab return ret; 18090c0d06caSMauro Carvalho Chehab 18100c0d06caSMauro Carvalho Chehab reg->val = ret; 18110c0d06caSMauro Carvalho Chehab reg->size = 1; 18120c0d06caSMauro Carvalho Chehab return 0; 18130c0d06caSMauro Carvalho Chehab } 18140c0d06caSMauro Carvalho Chehab 18150c0d06caSMauro Carvalho Chehab /* Match host */ 18160c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 18170c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 18180c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 18190c0d06caSMauro Carvalho Chehab 18200c0d06caSMauro Carvalho Chehab if (ret < 0) 18210c0d06caSMauro Carvalho Chehab return ret; 18220c0d06caSMauro Carvalho Chehab 18230c0d06caSMauro Carvalho Chehab reg->val = ret; 18240c0d06caSMauro Carvalho Chehab } else { 18250c0d06caSMauro Carvalho Chehab __le16 val = 0; 1826fdf1bc9fSMauro Carvalho Chehab 182701c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 18280c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 18290c0d06caSMauro Carvalho Chehab if (ret < 0) 18300c0d06caSMauro Carvalho Chehab return ret; 18310c0d06caSMauro Carvalho Chehab 18320c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 18330c0d06caSMauro Carvalho Chehab } 18340c0d06caSMauro Carvalho Chehab 18350c0d06caSMauro Carvalho Chehab return 0; 18360c0d06caSMauro Carvalho Chehab } 18370c0d06caSMauro Carvalho Chehab 18380c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1839977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 18400c0d06caSMauro Carvalho Chehab { 1841917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18420c0d06caSMauro Carvalho Chehab __le16 buf; 18430c0d06caSMauro Carvalho Chehab 18443b2d17b4SHans Verkuil if (reg->match.addr > 1) 18453b2d17b4SHans Verkuil return -EINVAL; 1846abca2056SHans Verkuil if (reg->match.addr) 18470c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 18480c0d06caSMauro Carvalho Chehab 18490c0d06caSMauro Carvalho Chehab /* Match host */ 18500c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 18510c0d06caSMauro Carvalho Chehab 18520c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 18530c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 18540c0d06caSMauro Carvalho Chehab } 18550c0d06caSMauro Carvalho Chehab #endif 18560c0d06caSMauro Carvalho Chehab 18570c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 18580c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 18590c0d06caSMauro Carvalho Chehab { 1860a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1861917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1862ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1863c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 18640c0d06caSMauro Carvalho Chehab 18650c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 18660c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 1867c6d48134SMauro Carvalho Chehab usb_make_path(udev, cap->bus_info, sizeof(cap->bus_info)); 18680c0d06caSMauro Carvalho Chehab 1869a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1870a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1871a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1872a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1873a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1874a9d79fe5SHans Verkuil else 18751d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 18760c0d06caSMauro Carvalho Chehab 1877920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 1878a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 18790c0d06caSMauro Carvalho Chehab 18800c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1881a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 18820c0d06caSMauro Carvalho Chehab 1883a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1884a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1885d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 18861d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1887d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 1888a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 18890c0d06caSMauro Carvalho Chehab return 0; 18900c0d06caSMauro Carvalho Chehab } 18910c0d06caSMauro Carvalho Chehab 18920c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 18930c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 18940c0d06caSMauro Carvalho Chehab { 18950c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 18960c0d06caSMauro Carvalho Chehab return -EINVAL; 18970c0d06caSMauro Carvalho Chehab 18980c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 18990c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 19000c0d06caSMauro Carvalho Chehab 19010c0d06caSMauro Carvalho Chehab return 0; 19020c0d06caSMauro Carvalho Chehab } 19030c0d06caSMauro Carvalho Chehab 19040c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 19050c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 19060c0d06caSMauro Carvalho Chehab { 1907917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19080c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 19090c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 19100c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 19110c0d06caSMauro Carvalho Chehab 19120c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 19130c0d06caSMauro Carvalho Chehab if (!fmt) { 19140c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 19150c0d06caSMauro Carvalho Chehab fsize->pixel_format); 19160c0d06caSMauro Carvalho Chehab return -EINVAL; 19170c0d06caSMauro Carvalho Chehab } 19180c0d06caSMauro Carvalho Chehab 19190c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 19200c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 19210c0d06caSMauro Carvalho Chehab return -EINVAL; 19220c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 19230c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 19240c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 19250c0d06caSMauro Carvalho Chehab return 0; 19260c0d06caSMauro Carvalho Chehab } 19270c0d06caSMauro Carvalho Chehab 19280c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 19290c0d06caSMauro Carvalho Chehab return -EINVAL; 19300c0d06caSMauro Carvalho Chehab 19310c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 19320c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 19336c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 19346c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 19356c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 19360c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 19376c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 19386c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 19390c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 19400c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 19410c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 19420c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 19430c0d06caSMauro Carvalho Chehab return 0; 19440c0d06caSMauro Carvalho Chehab } 19450c0d06caSMauro Carvalho Chehab 19460c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 19470c0d06caSMauro Carvalho Chehab 19480c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 19490c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 19500c0d06caSMauro Carvalho Chehab { 1951917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1952753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 19530c0d06caSMauro Carvalho Chehab 1954753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 19550c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 19560c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 19570c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 19580c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1959753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1960753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 19612a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 19620c0d06caSMauro Carvalho Chehab 19630c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 196452faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 19650c0d06caSMauro Carvalho Chehab /* NTSC */ 19660c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 19670c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 196852faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 19690c0d06caSMauro Carvalho Chehab /* PAL */ 19700c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 19710c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 19720c0d06caSMauro Carvalho Chehab } 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab return 0; 19750c0d06caSMauro Carvalho Chehab } 19760c0d06caSMauro Carvalho Chehab 19770c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 19780c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 19790c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 19800c0d06caSMauro Carvalho Chehab 19810c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 19820c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 19830c0d06caSMauro Carvalho Chehab { 1984917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19850c0d06caSMauro Carvalho Chehab 19860c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 19870c0d06caSMauro Carvalho Chehab return -EINVAL; 19880c0d06caSMauro Carvalho Chehab 19890c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 19900c0d06caSMauro Carvalho Chehab 199195d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 19920c0d06caSMauro Carvalho Chehab 19930c0d06caSMauro Carvalho Chehab return 0; 19940c0d06caSMauro Carvalho Chehab } 19950c0d06caSMauro Carvalho Chehab 19960c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 19972f73c7c5SHans Verkuil const struct v4l2_tuner *t) 19980c0d06caSMauro Carvalho Chehab { 1999917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 20000c0d06caSMauro Carvalho Chehab 20010c0d06caSMauro Carvalho Chehab if (0 != t->index) 20020c0d06caSMauro Carvalho Chehab return -EINVAL; 20030c0d06caSMauro Carvalho Chehab 200495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 20050c0d06caSMauro Carvalho Chehab 20060c0d06caSMauro Carvalho Chehab return 0; 20070c0d06caSMauro Carvalho Chehab } 20080c0d06caSMauro Carvalho Chehab 20090c0d06caSMauro Carvalho Chehab /* 201095d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 201195d2608bSFrank Schaefer * 201295d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 201395d2608bSFrank Schaefer * 201495d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 201595d2608bSFrank Schaefer */ 2016f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 201795d2608bSFrank Schaefer { 201895d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 201995d2608bSFrank Schaefer 2020abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 202195d2608bSFrank Schaefer kfree(v4l2); 202295d2608bSFrank Schaefer } 202395d2608bSFrank Schaefer 202495d2608bSFrank Schaefer /* 20250c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 20260c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 20270c0d06caSMauro Carvalho Chehab */ 20280c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 20290c0d06caSMauro Carvalho Chehab { 20300c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 20310c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 203295d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20330c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 20343c0f90e1SFrank Schaefer int ret; 20350c0d06caSMauro Carvalho Chehab 20360c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 20370c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 20380c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 20390c0d06caSMauro Carvalho Chehab break; 20400c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 20410c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 20420c0d06caSMauro Carvalho Chehab break; 20434e170240SFrank Schaefer case VFL_TYPE_RADIO: 20444e170240SFrank Schaefer break; 20454e170240SFrank Schaefer default: 20464e170240SFrank Schaefer return -EINVAL; 20470c0d06caSMauro Carvalho Chehab } 20480c0d06caSMauro Carvalho Chehab 20498e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 20508e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 20518e2c8717SFrank Schaefer v4l2->users); 20520c0d06caSMauro Carvalho Chehab 20530c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 20540c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 20553c0f90e1SFrank Schaefer 20563c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 20573c0f90e1SFrank Schaefer if (ret) { 205829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2059ce8591ffSMauro Carvalho Chehab "%s: v4l2_fh_open() returned error %d\n", 20603c0f90e1SFrank Schaefer __func__, ret); 20610c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20623c0f90e1SFrank Schaefer return ret; 20630c0d06caSMauro Carvalho Chehab } 20640c0d06caSMauro Carvalho Chehab 20658e2c8717SFrank Schaefer if (v4l2->users == 0) { 20660c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 20674e170240SFrank Schaefer 20684e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 20690c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 20700c0d06caSMauro Carvalho Chehab 20714e170240SFrank Schaefer /* 20724e170240SFrank Schaefer * Needed, since GPIO might have disabled power 20734e170240SFrank Schaefer * of some i2c devices 20740c0d06caSMauro Carvalho Chehab */ 20750c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 20760c0d06caSMauro Carvalho Chehab } 2077d3829fadSDevin Heitmueller 2078d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 20790c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 208095d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 20810c0d06caSMauro Carvalho Chehab } 20820c0d06caSMauro Carvalho Chehab 208347677e51SMauro Carvalho Chehab kref_get(&dev->ref); 208495d2608bSFrank Schaefer kref_get(&v4l2->ref); 20858e2c8717SFrank Schaefer v4l2->users++; 20860c0d06caSMauro Carvalho Chehab 20870c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20880c0d06caSMauro Carvalho Chehab 2089d3829fadSDevin Heitmueller return 0; 20900c0d06caSMauro Carvalho Chehab } 20910c0d06caSMauro Carvalho Chehab 20920c0d06caSMauro Carvalho Chehab /* 209301c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 20940c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 20950c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 20960c0d06caSMauro Carvalho Chehab */ 209701c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 20980c0d06caSMauro Carvalho Chehab { 209995d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 210095d2608bSFrank Schaefer 2101822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2102822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2103822b8deaSMauro Carvalho Chehab return 0; 2104822b8deaSMauro Carvalho Chehab } 2105822b8deaSMauro Carvalho Chehab 210601c28193SMauro Carvalho Chehab if (!dev->has_video) { 210701c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 210801c28193SMauro Carvalho Chehab return 0; 210901c28193SMauro Carvalho Chehab } 21100c0d06caSMauro Carvalho Chehab 211195d2608bSFrank Schaefer if (v4l2 == NULL) 211295d2608bSFrank Schaefer return 0; 211395d2608bSFrank Schaefer 211429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Closing video extension\n"); 2115aa929ad7SMauro Carvalho Chehab 2116ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2117ebbfbc20SMauro Carvalho Chehab 211895d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 21195ad10de6SFrank Schaefer 212023e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 212123e8642cSFrank Schaefer 212237ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 212337ecc7b1SMauro Carvalho Chehab 2124d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 212529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2126d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2127d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 21280c0d06caSMauro Carvalho Chehab } 2129d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 213029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2131d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2132d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 21330c0d06caSMauro Carvalho Chehab } 2134d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 213529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "V4L2 device %s deregistered\n", 2136d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2137d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 21380c0d06caSMauro Carvalho Chehab } 213901c28193SMauro Carvalho Chehab 2140abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 214195d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2142103f18a2SFrank Schaefer 21432c52a2fcSFrank Schaefer if (v4l2->clk) { 21442c52a2fcSFrank Schaefer v4l2_clk_unregister_fixed(v4l2->clk); 21452c52a2fcSFrank Schaefer v4l2->clk = NULL; 214625dd1652SFrank Schaefer } 214725dd1652SFrank Schaefer 214895d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 214995d2608bSFrank Schaefer 2150ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 215195d2608bSFrank Schaefer 215247677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 21535ad10de6SFrank Schaefer 215401c28193SMauro Carvalho Chehab return 0; 21550c0d06caSMauro Carvalho Chehab } 21560c0d06caSMauro Carvalho Chehab 2157a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2158a61f6811SShuah Khan { 2159a61f6811SShuah Khan if (dev->is_audio_only) 2160a61f6811SShuah Khan return 0; 2161a61f6811SShuah Khan 2162a61f6811SShuah Khan if (!dev->has_video) 2163a61f6811SShuah Khan return 0; 2164a61f6811SShuah Khan 216529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Suspending video extension\n"); 2166a61f6811SShuah Khan em28xx_stop_urbs(dev); 2167a61f6811SShuah Khan return 0; 2168a61f6811SShuah Khan } 2169a61f6811SShuah Khan 2170a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2171a61f6811SShuah Khan { 2172a61f6811SShuah Khan if (dev->is_audio_only) 2173a61f6811SShuah Khan return 0; 2174a61f6811SShuah Khan 2175a61f6811SShuah Khan if (!dev->has_video) 2176a61f6811SShuah Khan return 0; 2177a61f6811SShuah Khan 217829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Resuming video extension\n"); 2179a61f6811SShuah Khan /* what do we do here */ 2180a61f6811SShuah Khan return 0; 2181a61f6811SShuah Khan } 2182a61f6811SShuah Khan 21830c0d06caSMauro Carvalho Chehab /* 21840c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 21850c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 21860c0d06caSMauro Carvalho Chehab * calls and ioctls 21870c0d06caSMauro Carvalho Chehab */ 21880c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 21890c0d06caSMauro Carvalho Chehab { 2190917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 219195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 2192c6d48134SMauro Carvalho Chehab struct usb_device *udev = interface_to_usbdev(dev->intf); 21930c0d06caSMauro Carvalho Chehab int errCode; 21940c0d06caSMauro Carvalho Chehab 21958e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 21968e2c8717SFrank Schaefer 21978e2c8717SFrank Schaefer vb2_fop_release(filp); 219898c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 21990c0d06caSMauro Carvalho Chehab 22008e2c8717SFrank Schaefer if (v4l2->users == 1) { 220147677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 220247677e51SMauro Carvalho Chehab if (dev->disconnected) 220301c28193SMauro Carvalho Chehab goto exit; 22040c0d06caSMauro Carvalho Chehab 22050c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 220695d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 22070c0d06caSMauro Carvalho Chehab 22080c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 22090c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 22100c0d06caSMauro Carvalho Chehab 22110c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 22120c0d06caSMauro Carvalho Chehab dev->alt = 0; 22130c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 2214c6d48134SMauro Carvalho Chehab errCode = usb_set_interface(udev, 0, 0); 22150c0d06caSMauro Carvalho Chehab if (errCode < 0) { 221629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2217ce8591ffSMauro Carvalho Chehab "cannot change alternate number to 0 (error=%i)\n", 22188314d402SMauro Carvalho Chehab errCode); 22190c0d06caSMauro Carvalho Chehab } 22200c0d06caSMauro Carvalho Chehab } 22210c0d06caSMauro Carvalho Chehab 222201c28193SMauro Carvalho Chehab exit: 22238e2c8717SFrank Schaefer v4l2->users--; 222495d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 22250c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 222647677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 222747677e51SMauro Carvalho Chehab 22280c0d06caSMauro Carvalho Chehab return 0; 22290c0d06caSMauro Carvalho Chehab } 22300c0d06caSMauro Carvalho Chehab 22310c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 22320c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22330c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22340c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2235d3829fadSDevin Heitmueller .read = vb2_fop_read, 2236d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2237d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 22380c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22390c0d06caSMauro Carvalho Chehab }; 22400c0d06caSMauro Carvalho Chehab 22410c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 22420c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 22430c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 22440c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 22450c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 22460c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 22470c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22482a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2249aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22500c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 22510c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 22520c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 22530c0d06caSMauro Carvalho Chehab 2254d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2255d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2256d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2257d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2258d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2259d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2260d3829fadSDevin Heitmueller 22610c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 22620c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 22630c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 22640c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 22650c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 22660c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 22670c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 22680c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2269d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2270d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 22710c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 22720c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 22730c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22740c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 227550fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 227650fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 22770c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 227896b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 22790c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 22800c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 22810c0d06caSMauro Carvalho Chehab #endif 22820c0d06caSMauro Carvalho Chehab }; 22830c0d06caSMauro Carvalho Chehab 22840c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 22850c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 22860c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2287d4352f36SHans Verkuil .release = video_device_release_empty, 22880c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 22890c0d06caSMauro Carvalho Chehab }; 22900c0d06caSMauro Carvalho Chehab 22910c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 22920c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22930c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22940c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 22950c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22960c0d06caSMauro Carvalho Chehab }; 22970c0d06caSMauro Carvalho Chehab 22980c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2299a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 23000c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 23010c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 23020c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 23030c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 230450fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 230550fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 23060c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2307430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 23080c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 23090c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23100c0d06caSMauro Carvalho Chehab #endif 23110c0d06caSMauro Carvalho Chehab }; 23120c0d06caSMauro Carvalho Chehab 23130c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 23140c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 23150c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2316d4352f36SHans Verkuil .release = video_device_release_empty, 23170c0d06caSMauro Carvalho Chehab }; 23180c0d06caSMauro Carvalho Chehab 2319b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2320b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2321b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2322b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2323b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2324b64f8e9aSMauro Carvalho Chehab 2325b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2326b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2327b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2328b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2329b64f8e9aSMauro Carvalho Chehab }; 2330b64f8e9aSMauro Carvalho Chehab 2331b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2332b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2333b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2334b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2335b64f8e9aSMauro Carvalho Chehab }; 2336b64f8e9aSMauro Carvalho Chehab 23370c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 23380c0d06caSMauro Carvalho Chehab 2339d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2340d4352f36SHans Verkuil struct video_device *vfd, 23410c0d06caSMauro Carvalho Chehab const struct video_device *template, 23420c0d06caSMauro Carvalho Chehab const char *type_name) 23430c0d06caSMauro Carvalho Chehab { 23440c0d06caSMauro Carvalho Chehab *vfd = *template; 234595d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 23460c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2347d8c95c08SHans Verkuil if (dev->board.is_webcam) 2348d8c95c08SHans Verkuil vfd->tvnorms = 0; 23490c0d06caSMauro Carvalho Chehab 23500c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 235129b05e22SMauro Carvalho Chehab dev_name(&dev->intf->dev), type_name); 23520c0d06caSMauro Carvalho Chehab 23530c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 23540c0d06caSMauro Carvalho Chehab } 23550c0d06caSMauro Carvalho Chehab 23563319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 23570560f337SMauro Carvalho Chehab { 23583854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 23593854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 23600560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 23610560f337SMauro Carvalho Chehab struct v4l2_frequency f; 23620560f337SMauro Carvalho Chehab 23630560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 23640560f337SMauro Carvalho Chehab 23650560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 23660560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 23670560f337SMauro Carvalho Chehab 23680560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 23690560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 23700560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 23710560f337SMauro Carvalho Chehab 237295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 237395d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 23740560f337SMauro Carvalho Chehab } 23750560f337SMauro Carvalho Chehab 23760560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 23770560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 23783319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 23790560f337SMauro Carvalho Chehab 238095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 238195d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 23820560f337SMauro Carvalho Chehab } 23830560f337SMauro Carvalho Chehab 23846867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 23850560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 23860560f337SMauro Carvalho Chehab 23870560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 23886867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 23890560f337SMauro Carvalho Chehab 239095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 239195d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 23920560f337SMauro Carvalho Chehab } 23930560f337SMauro Carvalho Chehab 23940560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 23950560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 23960560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 23970560f337SMauro Carvalho Chehab 23980560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 23990560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 24000560f337SMauro Carvalho Chehab 24010560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 24020560f337SMauro Carvalho Chehab 24030560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 24040560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 24050560f337SMauro Carvalho Chehab 240695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 24070560f337SMauro Carvalho Chehab } 24080560f337SMauro Carvalho Chehab 24090560f337SMauro Carvalho Chehab /* configure tuner */ 24100560f337SMauro Carvalho Chehab f.tuner = 0; 24110560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 24120560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 24133854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 241495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 24150560f337SMauro Carvalho Chehab } 24160560f337SMauro Carvalho Chehab 241701c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 24180c0d06caSMauro Carvalho Chehab { 24190c0d06caSMauro Carvalho Chehab u8 val; 24200c0d06caSMauro Carvalho Chehab int ret; 24210c0d06caSMauro Carvalho Chehab unsigned int maxw; 2422abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 242395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2424b64f8e9aSMauro Carvalho Chehab 2425822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2426822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2427822b8deaSMauro Carvalho Chehab return 0; 2428822b8deaSMauro Carvalho Chehab } 2429822b8deaSMauro Carvalho Chehab 243001c28193SMauro Carvalho Chehab if (!dev->has_video) { 2431b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2432b64f8e9aSMauro Carvalho Chehab return 0; 2433b64f8e9aSMauro Carvalho Chehab } 24340c0d06caSMauro Carvalho Chehab 243529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, "Registering V4L2 extension\n"); 24360c0d06caSMauro Carvalho Chehab 243701c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 243801c28193SMauro Carvalho Chehab 243995d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 24408314d402SMauro Carvalho Chehab if (!v4l2) { 244195d2608bSFrank Schaefer mutex_unlock(&dev->lock); 244295d2608bSFrank Schaefer return -ENOMEM; 244395d2608bSFrank Schaefer } 244495d2608bSFrank Schaefer kref_init(&v4l2->ref); 2445abc1308fSFrank Schaefer v4l2->dev = dev; 244695d2608bSFrank Schaefer dev->v4l2 = v4l2; 244795d2608bSFrank Schaefer 244837ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 244937ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 245037ecc7b1SMauro Carvalho Chehab #endif 245129b05e22SMauro Carvalho Chehab ret = v4l2_device_register(&dev->intf->dev, &v4l2->v4l2_dev); 2452b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 245329b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2454ce8591ffSMauro Carvalho Chehab "Call to v4l2_device_register() failed!\n"); 2455b64f8e9aSMauro Carvalho Chehab goto err; 2456b64f8e9aSMauro Carvalho Chehab } 2457b64f8e9aSMauro Carvalho Chehab 2458abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2459b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 246095d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2461b64f8e9aSMauro Carvalho Chehab 246258159171SFrank Schaefer if (dev->board.is_webcam) 24637e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 246458159171SFrank Schaefer 2465b64f8e9aSMauro Carvalho Chehab /* 2466b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2467b64f8e9aSMauro Carvalho Chehab */ 24689297285eSFrank Schaefer v4l2->vinmode = 0x10; 24699297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2470b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2471b64f8e9aSMauro Carvalho Chehab 2472b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2473b64f8e9aSMauro Carvalho Chehab 2474b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) 247595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 247695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2477b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2478b64f8e9aSMauro Carvalho Chehab 2479b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 248095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 248195d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2482b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2483b64f8e9aSMauro Carvalho Chehab 2484b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 248595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 248695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2487b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2488b64f8e9aSMauro Carvalho Chehab 2489b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 249095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 249195d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2492b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2493b64f8e9aSMauro Carvalho Chehab 2494b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2495b64f8e9aSMauro Carvalho Chehab 2496b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 24973319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 24986867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2499b64f8e9aSMauro Carvalho Chehab 2500b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 250195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 250295d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2503fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2504fdf1bc9fSMauro Carvalho Chehab NULL); 2505b64f8e9aSMauro Carvalho Chehab 2506b64f8e9aSMauro Carvalho Chehab if (has_demod) 250795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2508fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2509fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2510fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 25113319e6f8SFrank Schaefer if (tuner_addr == 0) { 2512b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2513b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2514b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2515b64f8e9aSMauro Carvalho Chehab 251695d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2517fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2518fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2519fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2520b64f8e9aSMauro Carvalho Chehab 2521b64f8e9aSMauro Carvalho Chehab if (sd) 25223319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2523b64f8e9aSMauro Carvalho Chehab } else { 252495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 252595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 25263319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2527b64f8e9aSMauro Carvalho Chehab } 2528b64f8e9aSMauro Carvalho Chehab 25293319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 25303319e6f8SFrank Schaefer } 25313319e6f8SFrank Schaefer 2532d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2533b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2534b64f8e9aSMauro Carvalho Chehab 2535b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2536b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2537b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 253829b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2539ce8591ffSMauro Carvalho Chehab "%s: Error while setting audio - error [%d]!\n", 2540b64f8e9aSMauro Carvalho Chehab __func__, ret); 2541b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2542b64f8e9aSMauro Carvalho Chehab } 2543b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2544b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2545b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2546b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2547b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2548b64f8e9aSMauro Carvalho Chehab } else { 2549b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2550b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2551b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2552b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2553b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2554b64f8e9aSMauro Carvalho Chehab } 2555b64f8e9aSMauro Carvalho Chehab 2556b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2557b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2558b64f8e9aSMauro Carvalho Chehab 2559b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2560b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2561b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2562b64f8e9aSMauro Carvalho Chehab 2563b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2564b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2565b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2566b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 256729b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2568ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2569b64f8e9aSMauro Carvalho Chehab __func__, ret); 2570b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2571b64f8e9aSMauro Carvalho Chehab } 2572b64f8e9aSMauro Carvalho Chehab msleep(3); 2573b64f8e9aSMauro Carvalho Chehab 2574b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2575b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 257629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2577ce8591ffSMauro Carvalho Chehab "%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2578b64f8e9aSMauro Carvalho Chehab __func__, ret); 2579b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2580b64f8e9aSMauro Carvalho Chehab } 2581b64f8e9aSMauro Carvalho Chehab msleep(3); 2582b64f8e9aSMauro Carvalho Chehab } 2583b64f8e9aSMauro Carvalho Chehab 25840c0d06caSMauro Carvalho Chehab /* set default norm */ 258552faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 25868774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 258758159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 25880c0d06caSMauro Carvalho Chehab 25890c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 259006e20672SFrank Schaefer v4l2->format = &format[0]; 25910c0d06caSMauro Carvalho Chehab 25920c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 25930c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 25940c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 25950c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 25960c0d06caSMauro Carvalho Chehab maxw /= 2; 25970c0d06caSMauro Carvalho Chehab 25980c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 25990c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 26000c0d06caSMauro Carvalho Chehab 26010c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 26020c0d06caSMauro Carvalho Chehab 26030c0d06caSMauro Carvalho Chehab /* Audio defaults */ 26040c0d06caSMauro Carvalho Chehab dev->mute = 1; 26050c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 26060c0d06caSMauro Carvalho Chehab 26070c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 26080c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 26090c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 26100c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 26110c0d06caSMauro Carvalho Chehab 26120c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 26130c0d06caSMauro Carvalho Chehab 26148f8b113aSFrank Schaefer /* Add image controls */ 26158f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 26168f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2617ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2618ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26198f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 26208f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2621ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2622ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26238f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 26248f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2625ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2626ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26278f8b113aSFrank Schaefer V4L2_CID_SATURATION, 26288f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2629ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2630ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26318f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 26328f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2633ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2634ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26358f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 26368f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2637ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2638ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26398f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 26408f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 26418f8b113aSFrank Schaefer 26428f8b113aSFrank Schaefer /* Reset image controls */ 26438f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2644ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2645ad298055SFrank Schaefer ret = hdl->error; 2646b64f8e9aSMauro Carvalho Chehab if (ret) 2647b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26488f8b113aSFrank Schaefer 26490c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2650d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 265127a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 265227a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2653d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2654d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 26550c0d06caSMauro Carvalho Chehab 26566e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 26576e46dabaSFrank Schaefer if (dev->board.is_webcam) { 2658d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2659d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2660d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 26613bc85cceSFrank Schaefer } else { 2662d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 26636e46dabaSFrank Schaefer } 266466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2665d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2666d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2667d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2668d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 266966df67b7SFrank Schaefer } 2670920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2671d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2672d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2673c2dcef83SFrank Schaefer } 26746e46dabaSFrank Schaefer 26750c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2676d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 26770c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 26780c0d06caSMauro Carvalho Chehab if (ret) { 267929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2680ce8591ffSMauro Carvalho Chehab "unable to register video device (error=%i).\n", ret); 2681b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26820c0d06caSMauro Carvalho Chehab } 26830c0d06caSMauro Carvalho Chehab 26840c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 26850c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2686d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 26870c0d06caSMauro Carvalho Chehab "vbi"); 26880c0d06caSMauro Carvalho Chehab 2689d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2690d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2691d3829fadSDevin Heitmueller 269266df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2693d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 269466df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2695d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2696d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2697d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2698d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 269966df67b7SFrank Schaefer } 2700920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2701d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2702d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2703c2dcef83SFrank Schaefer } 270466df67b7SFrank Schaefer 27050c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2706d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 27070c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 27080c0d06caSMauro Carvalho Chehab if (ret < 0) { 270929b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2710ce8591ffSMauro Carvalho Chehab "unable to register vbi device\n"); 2711b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27120c0d06caSMauro Carvalho Chehab } 27130c0d06caSMauro Carvalho Chehab } 27140c0d06caSMauro Carvalho Chehab 27150c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2716d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 27170c0d06caSMauro Carvalho Chehab "radio"); 2718d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 27190c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 27200c0d06caSMauro Carvalho Chehab if (ret < 0) { 272129b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2722ce8591ffSMauro Carvalho Chehab "can't register radio device\n"); 2723b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27240c0d06caSMauro Carvalho Chehab } 272529b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2726ce8591ffSMauro Carvalho Chehab "Registered radio device as %s\n", 2727d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 27280c0d06caSMauro Carvalho Chehab } 27290c0d06caSMauro Carvalho Chehab 273037ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 273137ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 273237ecc7b1SMauro Carvalho Chehab 27330d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2734de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 273537ecc7b1SMauro Carvalho Chehab if (ret) { 273629b05e22SMauro Carvalho Chehab dev_err(&dev->intf->dev, 2737ce8591ffSMauro Carvalho Chehab "failed to create media graph\n"); 273837ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 273937ecc7b1SMauro Carvalho Chehab goto unregister_dev; 274037ecc7b1SMauro Carvalho Chehab } 27410d37ba62SArnd Bergmann #endif 274237ecc7b1SMauro Carvalho Chehab 274329b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2744ce8591ffSMauro Carvalho Chehab "V4L2 video device registered as %s\n", 2745d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 27460c0d06caSMauro Carvalho Chehab 2747d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 274829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2749ce8591ffSMauro Carvalho Chehab "V4L2 VBI device registered as %s\n", 2750d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 27510c0d06caSMauro Carvalho Chehab 2752b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 275395d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2754b64f8e9aSMauro Carvalho Chehab 2755b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2756b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2757b64f8e9aSMauro Carvalho Chehab 275829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2759ce8591ffSMauro Carvalho Chehab "V4L2 extension successfully initialized\n"); 27609634614fSMauro Carvalho Chehab 276147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 276247677e51SMauro Carvalho Chehab 276301c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 27640c0d06caSMauro Carvalho Chehab return 0; 2765b64f8e9aSMauro Carvalho Chehab 2766b64f8e9aSMauro Carvalho Chehab unregister_dev: 276756a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 276829b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2769ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 277056a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 277156a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 277256a7f515SMauro Carvalho Chehab } 277356a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 277429b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2775ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 277656a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 277756a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 277856a7f515SMauro Carvalho Chehab } 277956a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 278029b05e22SMauro Carvalho Chehab dev_info(&dev->intf->dev, 2781ce8591ffSMauro Carvalho Chehab "V4L2 device %s deregistered\n", 278256a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 278356a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 278456a7f515SMauro Carvalho Chehab } 278556a7f515SMauro Carvalho Chehab 2786abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 278795d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2788b64f8e9aSMauro Carvalho Chehab err: 278995d2608bSFrank Schaefer dev->v4l2 = NULL; 279095d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 279101c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2792b64f8e9aSMauro Carvalho Chehab return ret; 27930c0d06caSMauro Carvalho Chehab } 279401c28193SMauro Carvalho Chehab 279501c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 279601c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 279701c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 279801c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 279901c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2800a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2801a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 280201c28193SMauro Carvalho Chehab }; 280301c28193SMauro Carvalho Chehab 280401c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 280501c28193SMauro Carvalho Chehab { 280601c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 280701c28193SMauro Carvalho Chehab } 280801c28193SMauro Carvalho Chehab 280901c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 281001c28193SMauro Carvalho Chehab { 281101c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 281201c28193SMauro Carvalho Chehab } 281301c28193SMauro Carvalho Chehab 281401c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 281501c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2816