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 290c0d06caSMauro Carvalho Chehab #include <linux/init.h> 300c0d06caSMauro Carvalho Chehab #include <linux/list.h> 310c0d06caSMauro Carvalho Chehab #include <linux/module.h> 320c0d06caSMauro Carvalho Chehab #include <linux/kernel.h> 330c0d06caSMauro Carvalho Chehab #include <linux/bitmap.h> 340c0d06caSMauro Carvalho Chehab #include <linux/usb.h> 350c0d06caSMauro Carvalho Chehab #include <linux/i2c.h> 360c0d06caSMauro Carvalho Chehab #include <linux/mm.h> 370c0d06caSMauro Carvalho Chehab #include <linux/mutex.h> 380c0d06caSMauro Carvalho Chehab #include <linux/slab.h> 390c0d06caSMauro Carvalho Chehab 400c0d06caSMauro Carvalho Chehab #include "em28xx.h" 4101c28193SMauro Carvalho Chehab #include "em28xx-v4l.h" 420c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h> 430c0d06caSMauro Carvalho Chehab #include <media/v4l2-ioctl.h> 4450fdf40fSHans Verkuil #include <media/v4l2-event.h> 4525dd1652SFrank Schaefer #include <media/v4l2-clk.h> 46d647f0b7SMauro Carvalho Chehab #include <media/drv-intf/msp3400.h> 470c0d06caSMauro Carvalho Chehab #include <media/tuner.h> 480c0d06caSMauro Carvalho Chehab 490c0d06caSMauro Carvalho Chehab #define DRIVER_AUTHOR "Ludovico Cavedon <cavedon@sssup.it>, " \ 500c0d06caSMauro Carvalho Chehab "Markus Rechberger <mrechberger@gmail.com>, " \ 510c0d06caSMauro Carvalho Chehab "Mauro Carvalho Chehab <mchehab@infradead.org>, " \ 520c0d06caSMauro Carvalho Chehab "Sascha Sommer <saschasommer@freenet.de>" 530c0d06caSMauro Carvalho Chehab 540560f337SMauro Carvalho Chehab static unsigned int isoc_debug; 550560f337SMauro Carvalho Chehab module_param(isoc_debug, int, 0644); 560560f337SMauro Carvalho Chehab MODULE_PARM_DESC(isoc_debug, "enable debug messages [isoc transfers]"); 570560f337SMauro Carvalho Chehab 580560f337SMauro Carvalho Chehab static unsigned int disable_vbi; 590560f337SMauro Carvalho Chehab module_param(disable_vbi, int, 0644); 600560f337SMauro Carvalho Chehab MODULE_PARM_DESC(disable_vbi, "disable vbi support"); 610560f337SMauro Carvalho Chehab 620560f337SMauro Carvalho Chehab static int alt; 630560f337SMauro Carvalho Chehab module_param(alt, int, 0644); 640560f337SMauro Carvalho Chehab MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint"); 650560f337SMauro Carvalho Chehab 660c0d06caSMauro Carvalho Chehab #define em28xx_videodbg(fmt, arg...) do {\ 670c0d06caSMauro Carvalho Chehab if (video_debug) \ 680c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 690c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); } while (0) 700c0d06caSMauro Carvalho Chehab 710c0d06caSMauro Carvalho Chehab #define em28xx_isocdbg(fmt, arg...) \ 720c0d06caSMauro Carvalho Chehab do {\ 730c0d06caSMauro Carvalho Chehab if (isoc_debug) { \ 740c0d06caSMauro Carvalho Chehab printk(KERN_INFO "%s %s :"fmt, \ 750c0d06caSMauro Carvalho Chehab dev->name, __func__ , ##arg); \ 760c0d06caSMauro Carvalho Chehab } \ 770c0d06caSMauro 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; 3630560f337SMauro Carvalho Chehab int errCode; 3640560f337SMauro Carvalho Chehab int i; 365753aee77SFrank Schaefer unsigned int min_pkt_size = v4l2->width * 2 + 4; 3660560f337SMauro Carvalho Chehab 3670560f337SMauro Carvalho Chehab /* NOTE: for isoc transfers, only alt settings > 0 are allowed 3680560f337SMauro Carvalho Chehab bulk transfers seem to work only with alt=0 ! */ 3690560f337SMauro Carvalho Chehab dev->alt = 0; 3700560f337SMauro Carvalho Chehab if ((alt > 0) && (alt < dev->num_alt)) { 3710560f337SMauro Carvalho Chehab em28xx_videodbg("alternate forced to %d\n", dev->alt); 3720560f337SMauro Carvalho Chehab dev->alt = alt; 3730560f337SMauro Carvalho Chehab goto set_alt; 3740560f337SMauro Carvalho Chehab } 3750560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) 3760560f337SMauro Carvalho Chehab goto set_alt; 3770560f337SMauro Carvalho Chehab 3780560f337SMauro Carvalho Chehab /* When image size is bigger than a certain value, 3790560f337SMauro Carvalho Chehab the frame size should be increased, otherwise, only 3800560f337SMauro Carvalho Chehab green screen will be received. 3810560f337SMauro Carvalho Chehab */ 382753aee77SFrank Schaefer if (v4l2->width * 2 * v4l2->height > 720 * 240 * 2) 3830560f337SMauro Carvalho Chehab min_pkt_size *= 2; 3840560f337SMauro Carvalho Chehab 3850560f337SMauro Carvalho Chehab for (i = 0; i < dev->num_alt; i++) { 3860560f337SMauro Carvalho Chehab /* stop when the selected alt setting offers enough bandwidth */ 3870560f337SMauro Carvalho Chehab if (dev->alt_max_pkt_size_isoc[i] >= min_pkt_size) { 3880560f337SMauro Carvalho Chehab dev->alt = i; 3890560f337SMauro Carvalho Chehab break; 3900560f337SMauro Carvalho Chehab /* otherwise make sure that we end up with the maximum bandwidth 3910560f337SMauro Carvalho Chehab because the min_pkt_size equation might be wrong... 3920560f337SMauro Carvalho Chehab */ 3930560f337SMauro Carvalho Chehab } else if (dev->alt_max_pkt_size_isoc[i] > 3940560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]) 3950560f337SMauro Carvalho Chehab dev->alt = i; 3960560f337SMauro Carvalho Chehab } 3970560f337SMauro Carvalho Chehab 3980560f337SMauro Carvalho Chehab set_alt: 3990560f337SMauro Carvalho Chehab /* NOTE: for bulk transfers, we need to call usb_set_interface() 4000560f337SMauro Carvalho Chehab * even if the previous settings were the same. Otherwise streaming 4010560f337SMauro Carvalho Chehab * fails with all urbs having status = -EOVERFLOW ! */ 4020560f337SMauro Carvalho Chehab if (dev->analog_xfer_bulk) { 4030560f337SMauro Carvalho Chehab dev->max_pkt_size = 512; /* USB 2.0 spec */ 4040560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_BULK_PACKET_MULTIPLIER; 4050560f337SMauro Carvalho Chehab } else { /* isoc */ 4060560f337SMauro Carvalho Chehab em28xx_videodbg("minimum isoc packet size: %u (alt=%d)\n", 4070560f337SMauro Carvalho Chehab min_pkt_size, dev->alt); 4080560f337SMauro Carvalho Chehab dev->max_pkt_size = 4090560f337SMauro Carvalho Chehab dev->alt_max_pkt_size_isoc[dev->alt]; 4100560f337SMauro Carvalho Chehab dev->packet_multiplier = EM28XX_NUM_ISOC_PACKETS; 4110560f337SMauro Carvalho Chehab } 4120560f337SMauro Carvalho Chehab em28xx_videodbg("setting alternate %d with wMaxPacketSize=%u\n", 4130560f337SMauro Carvalho Chehab dev->alt, dev->max_pkt_size); 414961717b4SFrank Schaefer errCode = usb_set_interface(dev->udev, dev->ifnum, dev->alt); 4150560f337SMauro Carvalho Chehab if (errCode < 0) { 4160560f337SMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to %d (error=%i)\n", 4170560f337SMauro Carvalho Chehab dev->alt, errCode); 4180560f337SMauro Carvalho Chehab return errCode; 4190560f337SMauro Carvalho Chehab } 4200560f337SMauro Carvalho Chehab return 0; 4210560f337SMauro Carvalho Chehab } 4220560f337SMauro Carvalho Chehab 4230c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 4240c0d06caSMauro Carvalho Chehab DMA and thread functions 4250c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 4260c0d06caSMauro Carvalho Chehab 4270c0d06caSMauro Carvalho Chehab /* 428948a49aaSFrank Schaefer * Finish the current buffer 4290c0d06caSMauro Carvalho Chehab */ 430948a49aaSFrank Schaefer static inline void finish_buffer(struct em28xx *dev, 4310c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf) 4320c0d06caSMauro Carvalho Chehab { 433d3829fadSDevin Heitmueller em28xx_isocdbg("[%p/%d] wakeup\n", buf, buf->top_field); 434d3829fadSDevin Heitmueller 4352d700715SJunghak Sung buf->vb.sequence = dev->v4l2->field_count++; 436662c97cfSFrank Schaefer if (dev->v4l2->progressive) 4372d700715SJunghak Sung buf->vb.field = V4L2_FIELD_NONE; 438662c97cfSFrank Schaefer else 4392d700715SJunghak Sung buf->vb.field = V4L2_FIELD_INTERLACED; 440d6dd645eSJunghak Sung buf->vb.vb2_buf.timestamp = ktime_get_ns(); 441d3829fadSDevin Heitmueller 4422d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_DONE); 4430c0d06caSMauro Carvalho Chehab } 4440c0d06caSMauro Carvalho Chehab 4450c0d06caSMauro Carvalho Chehab /* 44636016a35SFrank Schaefer * Copy picture data from USB buffer to videobuf buffer 4470c0d06caSMauro Carvalho Chehab */ 4480c0d06caSMauro Carvalho Chehab static void em28xx_copy_video(struct em28xx *dev, 4490c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 45036016a35SFrank Schaefer unsigned char *usb_buf, 4514078d625SFrank Schaefer unsigned long len) 4520c0d06caSMauro Carvalho Chehab { 45358159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 4540c0d06caSMauro Carvalho Chehab void *fieldstart, *startwrite, *startread; 4550c0d06caSMauro Carvalho Chehab int linesdone, currlinedone, offset, lencopy, remain; 45658159171SFrank Schaefer int bytesperline = v4l2->width << 1; 4570c0d06caSMauro Carvalho Chehab 458d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 459d3829fadSDevin Heitmueller len = buf->length - buf->pos; 4600c0d06caSMauro Carvalho Chehab 46136016a35SFrank Schaefer startread = usb_buf; 4620c0d06caSMauro Carvalho Chehab remain = len; 4630c0d06caSMauro Carvalho Chehab 46458159171SFrank Schaefer if (v4l2->progressive || buf->top_field) 46536016a35SFrank Schaefer fieldstart = buf->vb_buf; 466c02ec71bSFrank Schaefer else /* interlaced mode, even nr. of lines */ 46736016a35SFrank Schaefer fieldstart = buf->vb_buf + bytesperline; 4680c0d06caSMauro Carvalho Chehab 4698732533bSFrank Schaefer linesdone = buf->pos / bytesperline; 4708732533bSFrank Schaefer currlinedone = buf->pos % bytesperline; 4710c0d06caSMauro Carvalho Chehab 47258159171SFrank Schaefer if (v4l2->progressive) 4730c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline + currlinedone; 4740c0d06caSMauro Carvalho Chehab else 4750c0d06caSMauro Carvalho Chehab offset = linesdone * bytesperline * 2 + currlinedone; 4760c0d06caSMauro Carvalho Chehab 4770c0d06caSMauro Carvalho Chehab startwrite = fieldstart + offset; 4780c0d06caSMauro Carvalho Chehab lencopy = bytesperline - currlinedone; 4790c0d06caSMauro Carvalho Chehab lencopy = lencopy > remain ? remain : lencopy; 4800c0d06caSMauro Carvalho Chehab 481d3829fadSDevin Heitmueller if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->length) { 4827983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end (1)\n", 4830c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 484d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 485d3829fadSDevin Heitmueller remain = (char *)buf->vb_buf + buf->length - 48636016a35SFrank Schaefer (char *)startwrite; 4870c0d06caSMauro Carvalho Chehab lencopy = remain; 4880c0d06caSMauro Carvalho Chehab } 4890c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 4900c0d06caSMauro Carvalho Chehab return; 4910c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 4920c0d06caSMauro Carvalho Chehab 4930c0d06caSMauro Carvalho Chehab remain -= lencopy; 4940c0d06caSMauro Carvalho Chehab 4950c0d06caSMauro Carvalho Chehab while (remain > 0) { 49658159171SFrank Schaefer if (v4l2->progressive) 497c02ec71bSFrank Schaefer startwrite += lencopy; 498c02ec71bSFrank Schaefer else 4990c0d06caSMauro Carvalho Chehab startwrite += lencopy + bytesperline; 5000c0d06caSMauro Carvalho Chehab startread += lencopy; 5010c0d06caSMauro Carvalho Chehab if (bytesperline > remain) 5020c0d06caSMauro Carvalho Chehab lencopy = remain; 5030c0d06caSMauro Carvalho Chehab else 5040c0d06caSMauro Carvalho Chehab lencopy = bytesperline; 5050c0d06caSMauro Carvalho Chehab 50636016a35SFrank Schaefer if ((char *)startwrite + lencopy > (char *)buf->vb_buf + 507d3829fadSDevin Heitmueller buf->length) { 5087983b773SMauro Carvalho Chehab em28xx_isocdbg("Overflow of %zu bytes past buffer end" 5090c0d06caSMauro Carvalho Chehab "(2)\n", 5100c0d06caSMauro Carvalho Chehab ((char *)startwrite + lencopy) - 511d3829fadSDevin Heitmueller ((char *)buf->vb_buf + buf->length)); 512d3829fadSDevin Heitmueller lencopy = remain = (char *)buf->vb_buf + buf->length - 5130c0d06caSMauro Carvalho Chehab (char *)startwrite; 5140c0d06caSMauro Carvalho Chehab } 5150c0d06caSMauro Carvalho Chehab if (lencopy <= 0) 5160c0d06caSMauro Carvalho Chehab break; 5170c0d06caSMauro Carvalho Chehab 5180c0d06caSMauro Carvalho Chehab memcpy(startwrite, startread, lencopy); 5190c0d06caSMauro Carvalho Chehab 5200c0d06caSMauro Carvalho Chehab remain -= lencopy; 5210c0d06caSMauro Carvalho Chehab } 5220c0d06caSMauro Carvalho Chehab 5238732533bSFrank Schaefer buf->pos += len; 5240c0d06caSMauro Carvalho Chehab } 5250c0d06caSMauro Carvalho Chehab 52636016a35SFrank Schaefer /* 52736016a35SFrank Schaefer * Copy VBI data from USB buffer to videobuf buffer 52836016a35SFrank Schaefer */ 5290c0d06caSMauro Carvalho Chehab static void em28xx_copy_vbi(struct em28xx *dev, 5300c0d06caSMauro Carvalho Chehab struct em28xx_buffer *buf, 53136016a35SFrank Schaefer unsigned char *usb_buf, 5324078d625SFrank Schaefer unsigned long len) 5330c0d06caSMauro Carvalho Chehab { 53436016a35SFrank Schaefer unsigned int offset; 5350c0d06caSMauro Carvalho Chehab 536d3829fadSDevin Heitmueller if (buf->pos + len > buf->length) 537d3829fadSDevin Heitmueller len = buf->length - buf->pos; 5380c0d06caSMauro Carvalho Chehab 5398732533bSFrank Schaefer offset = buf->pos; 5400c0d06caSMauro Carvalho Chehab /* Make sure the bottom field populates the second half of the frame */ 54136016a35SFrank Schaefer if (buf->top_field == 0) 542753aee77SFrank Schaefer offset += dev->v4l2->vbi_width * dev->v4l2->vbi_height; 5430c0d06caSMauro Carvalho Chehab 54436016a35SFrank Schaefer memcpy(buf->vb_buf + offset, usb_buf, len); 5458732533bSFrank Schaefer buf->pos += len; 5460c0d06caSMauro Carvalho Chehab } 5470c0d06caSMauro Carvalho Chehab 5480c0d06caSMauro Carvalho Chehab static inline void print_err_status(struct em28xx *dev, 5490c0d06caSMauro Carvalho Chehab int packet, int status) 5500c0d06caSMauro Carvalho Chehab { 5510c0d06caSMauro Carvalho Chehab char *errmsg = "Unknown"; 5520c0d06caSMauro Carvalho Chehab 5530c0d06caSMauro Carvalho Chehab switch (status) { 5540c0d06caSMauro Carvalho Chehab case -ENOENT: 5550c0d06caSMauro Carvalho Chehab errmsg = "unlinked synchronuously"; 5560c0d06caSMauro Carvalho Chehab break; 5570c0d06caSMauro Carvalho Chehab case -ECONNRESET: 5580c0d06caSMauro Carvalho Chehab errmsg = "unlinked asynchronuously"; 5590c0d06caSMauro Carvalho Chehab break; 5600c0d06caSMauro Carvalho Chehab case -ENOSR: 5610c0d06caSMauro Carvalho Chehab errmsg = "Buffer error (overrun)"; 5620c0d06caSMauro Carvalho Chehab break; 5630c0d06caSMauro Carvalho Chehab case -EPIPE: 5640c0d06caSMauro Carvalho Chehab errmsg = "Stalled (device not responding)"; 5650c0d06caSMauro Carvalho Chehab break; 5660c0d06caSMauro Carvalho Chehab case -EOVERFLOW: 5670c0d06caSMauro Carvalho Chehab errmsg = "Babble (bad cable?)"; 5680c0d06caSMauro Carvalho Chehab break; 5690c0d06caSMauro Carvalho Chehab case -EPROTO: 5700c0d06caSMauro Carvalho Chehab errmsg = "Bit-stuff error (bad cable?)"; 5710c0d06caSMauro Carvalho Chehab break; 5720c0d06caSMauro Carvalho Chehab case -EILSEQ: 5730c0d06caSMauro Carvalho Chehab errmsg = "CRC/Timeout (could be anything)"; 5740c0d06caSMauro Carvalho Chehab break; 5750c0d06caSMauro Carvalho Chehab case -ETIME: 5760c0d06caSMauro Carvalho Chehab errmsg = "Device does not respond"; 5770c0d06caSMauro Carvalho Chehab break; 5780c0d06caSMauro Carvalho Chehab } 5790c0d06caSMauro Carvalho Chehab if (packet < 0) { 5800c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB status %d [%s].\n", status, errmsg); 5810c0d06caSMauro Carvalho Chehab } else { 5820c0d06caSMauro Carvalho Chehab em28xx_isocdbg("URB packet %d, status %d [%s].\n", 5830c0d06caSMauro Carvalho Chehab packet, status, errmsg); 5840c0d06caSMauro Carvalho Chehab } 5850c0d06caSMauro Carvalho Chehab } 5860c0d06caSMauro Carvalho Chehab 5870c0d06caSMauro Carvalho Chehab /* 58824a6d849SFrank Schaefer * get the next available buffer from dma queue 5890c0d06caSMauro Carvalho Chehab */ 59024a6d849SFrank Schaefer static inline struct em28xx_buffer *get_next_buf(struct em28xx *dev, 59124a6d849SFrank Schaefer struct em28xx_dmaqueue *dma_q) 5920c0d06caSMauro Carvalho Chehab { 59324a6d849SFrank Schaefer struct em28xx_buffer *buf; 5940c0d06caSMauro Carvalho Chehab 5950c0d06caSMauro Carvalho Chehab if (list_empty(&dma_q->active)) { 5960c0d06caSMauro Carvalho Chehab em28xx_isocdbg("No active queue to serve\n"); 59724a6d849SFrank Schaefer return NULL; 5980c0d06caSMauro Carvalho Chehab } 5990c0d06caSMauro Carvalho Chehab 6000c0d06caSMauro Carvalho Chehab /* Get the next buffer */ 601d3829fadSDevin Heitmueller buf = list_entry(dma_q->active.next, struct em28xx_buffer, list); 6020c0d06caSMauro Carvalho Chehab /* Cleans up buffer - Useful for testing for frame/URB loss */ 603d3829fadSDevin Heitmueller list_del(&buf->list); 6048732533bSFrank Schaefer buf->pos = 0; 605d3829fadSDevin Heitmueller buf->vb_buf = buf->mem; 6060c0d06caSMauro Carvalho Chehab 60724a6d849SFrank Schaefer return buf; 6080c0d06caSMauro Carvalho Chehab } 6090c0d06caSMauro Carvalho Chehab 610e04c00d9SFrank Schaefer /* 611e04c00d9SFrank Schaefer * Finish the current buffer if completed and prepare for the next field 612e04c00d9SFrank Schaefer */ 613e04c00d9SFrank Schaefer static struct em28xx_buffer * 614e04c00d9SFrank Schaefer finish_field_prepare_next(struct em28xx *dev, 615e04c00d9SFrank Schaefer struct em28xx_buffer *buf, 616e04c00d9SFrank Schaefer struct em28xx_dmaqueue *dma_q) 617e04c00d9SFrank Schaefer { 61858159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 61958159171SFrank Schaefer 620f0e38230SFrank Schaefer if (v4l2->progressive || v4l2->top_field) { /* Brand new frame */ 621e04c00d9SFrank Schaefer if (buf != NULL) 622e04c00d9SFrank Schaefer finish_buffer(dev, buf); 623e04c00d9SFrank Schaefer buf = get_next_buf(dev, dma_q); 624e04c00d9SFrank Schaefer } 625e04c00d9SFrank Schaefer if (buf != NULL) { 626f0e38230SFrank Schaefer buf->top_field = v4l2->top_field; 627e04c00d9SFrank Schaefer buf->pos = 0; 628e04c00d9SFrank Schaefer } 629e04c00d9SFrank Schaefer 630e04c00d9SFrank Schaefer return buf; 631e04c00d9SFrank Schaefer } 632e04c00d9SFrank Schaefer 633227b7c90SFrank Schaefer /* 634227b7c90SFrank Schaefer * Process data packet according to the em2710/em2750/em28xx frame data format 635227b7c90SFrank Schaefer */ 636227b7c90SFrank Schaefer static inline void process_frame_data_em28xx(struct em28xx *dev, 637227b7c90SFrank Schaefer unsigned char *data_pkt, 638227b7c90SFrank Schaefer unsigned int data_len) 639227b7c90SFrank Schaefer { 640753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 641227b7c90SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 642227b7c90SFrank Schaefer struct em28xx_buffer *vbi_buf = dev->usb_ctl.vbi_buf; 643227b7c90SFrank Schaefer struct em28xx_dmaqueue *dma_q = &dev->vidq; 644227b7c90SFrank Schaefer struct em28xx_dmaqueue *vbi_dma_q = &dev->vbiq; 645227b7c90SFrank Schaefer 646227b7c90SFrank Schaefer /* capture type 0 = vbi start 647227b7c90SFrank Schaefer capture type 1 = vbi in progress 648227b7c90SFrank Schaefer capture type 2 = video start 649227b7c90SFrank Schaefer capture type 3 = video in progress */ 650227b7c90SFrank Schaefer if (data_len >= 4) { 651227b7c90SFrank Schaefer /* NOTE: Headers are always 4 bytes and 652227b7c90SFrank Schaefer * never split across packets */ 653227b7c90SFrank Schaefer if (data_pkt[0] == 0x88 && data_pkt[1] == 0x88 && 654227b7c90SFrank Schaefer data_pkt[2] == 0x88 && data_pkt[3] == 0x88) { 655227b7c90SFrank Schaefer /* Continuation */ 656227b7c90SFrank Schaefer data_pkt += 4; 657227b7c90SFrank Schaefer data_len -= 4; 658227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x33 && data_pkt[1] == 0x95) { 659227b7c90SFrank Schaefer /* Field start (VBI mode) */ 660f0e38230SFrank Schaefer v4l2->capture_type = 0; 661f0e38230SFrank Schaefer v4l2->vbi_read = 0; 662227b7c90SFrank Schaefer em28xx_isocdbg("VBI START HEADER !!!\n"); 663f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 664227b7c90SFrank Schaefer data_pkt += 4; 665227b7c90SFrank Schaefer data_len -= 4; 666227b7c90SFrank Schaefer } else if (data_pkt[0] == 0x22 && data_pkt[1] == 0x5a) { 667227b7c90SFrank Schaefer /* Field start (VBI disabled) */ 668f0e38230SFrank Schaefer v4l2->capture_type = 2; 669227b7c90SFrank Schaefer em28xx_isocdbg("VIDEO START HEADER !!!\n"); 670f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[2] & 1); 671227b7c90SFrank Schaefer data_pkt += 4; 672227b7c90SFrank Schaefer data_len -= 4; 673227b7c90SFrank Schaefer } 674227b7c90SFrank Schaefer } 675227b7c90SFrank Schaefer /* NOTE: With bulk transfers, intermediate data packets 676227b7c90SFrank Schaefer * have no continuation header */ 677227b7c90SFrank Schaefer 678f0e38230SFrank Schaefer if (v4l2->capture_type == 0) { 679227b7c90SFrank Schaefer vbi_buf = finish_field_prepare_next(dev, vbi_buf, vbi_dma_q); 680227b7c90SFrank Schaefer dev->usb_ctl.vbi_buf = vbi_buf; 681f0e38230SFrank Schaefer v4l2->capture_type = 1; 682227b7c90SFrank Schaefer } 683227b7c90SFrank Schaefer 684f0e38230SFrank Schaefer if (v4l2->capture_type == 1) { 685753aee77SFrank Schaefer int vbi_size = v4l2->vbi_width * v4l2->vbi_height; 686f0e38230SFrank Schaefer int vbi_data_len = ((v4l2->vbi_read + data_len) > vbi_size) ? 687f0e38230SFrank Schaefer (vbi_size - v4l2->vbi_read) : data_len; 688227b7c90SFrank Schaefer 689227b7c90SFrank Schaefer /* Copy VBI data */ 690227b7c90SFrank Schaefer if (vbi_buf != NULL) 691227b7c90SFrank Schaefer em28xx_copy_vbi(dev, vbi_buf, data_pkt, vbi_data_len); 692f0e38230SFrank Schaefer v4l2->vbi_read += vbi_data_len; 693227b7c90SFrank Schaefer 694227b7c90SFrank Schaefer if (vbi_data_len < data_len) { 695227b7c90SFrank Schaefer /* Continue with copying video data */ 696f0e38230SFrank Schaefer v4l2->capture_type = 2; 697227b7c90SFrank Schaefer data_pkt += vbi_data_len; 698227b7c90SFrank Schaefer data_len -= vbi_data_len; 699227b7c90SFrank Schaefer } 700227b7c90SFrank Schaefer } 701227b7c90SFrank Schaefer 702f0e38230SFrank Schaefer if (v4l2->capture_type == 2) { 703227b7c90SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dma_q); 704227b7c90SFrank Schaefer dev->usb_ctl.vid_buf = buf; 705f0e38230SFrank Schaefer v4l2->capture_type = 3; 706227b7c90SFrank Schaefer } 707227b7c90SFrank Schaefer 708f0e38230SFrank Schaefer if (v4l2->capture_type == 3 && buf != NULL && data_len > 0) 709227b7c90SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 710227b7c90SFrank Schaefer } 711227b7c90SFrank Schaefer 712e507e0e5SFrank Schaefer /* 713e507e0e5SFrank Schaefer * Process data packet according to the em25xx/em276x/7x/8x frame data format 714e507e0e5SFrank Schaefer */ 715e507e0e5SFrank Schaefer static inline void process_frame_data_em25xx(struct em28xx *dev, 716e507e0e5SFrank Schaefer unsigned char *data_pkt, 717e507e0e5SFrank Schaefer unsigned int data_len) 718e507e0e5SFrank Schaefer { 719e507e0e5SFrank Schaefer struct em28xx_buffer *buf = dev->usb_ctl.vid_buf; 720e507e0e5SFrank Schaefer struct em28xx_dmaqueue *dmaq = &dev->vidq; 721f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 7227e6c8c19SMauro Carvalho Chehab bool frame_end = false; 723e507e0e5SFrank Schaefer 724e507e0e5SFrank Schaefer /* Check for header */ 725e507e0e5SFrank Schaefer /* NOTE: at least with bulk transfers, only the first packet 726e507e0e5SFrank Schaefer * has a header and has always set the FRAME_END bit */ 727e507e0e5SFrank Schaefer if (data_len >= 2) { /* em25xx header is only 2 bytes long */ 728e507e0e5SFrank Schaefer if ((data_pkt[0] == EM25XX_FRMDATAHDR_BYTE1) && 729e507e0e5SFrank Schaefer ((data_pkt[1] & ~EM25XX_FRMDATAHDR_BYTE2_MASK) == 0x00)) { 730f0e38230SFrank Schaefer v4l2->top_field = !(data_pkt[1] & 731e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_ID); 732e507e0e5SFrank Schaefer frame_end = data_pkt[1] & 733e507e0e5SFrank Schaefer EM25XX_FRMDATAHDR_BYTE2_FRAME_END; 734e507e0e5SFrank Schaefer data_pkt += 2; 735e507e0e5SFrank Schaefer data_len -= 2; 736e507e0e5SFrank Schaefer } 737e507e0e5SFrank Schaefer 738e507e0e5SFrank Schaefer /* Finish field and prepare next (BULK only) */ 739e507e0e5SFrank Schaefer if (dev->analog_xfer_bulk && frame_end) { 740e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 741e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 742e507e0e5SFrank Schaefer } 743e507e0e5SFrank Schaefer /* NOTE: in ISOC mode when a new frame starts and buf==NULL, 744e507e0e5SFrank Schaefer * we COULD already prepare a buffer here to avoid skipping the 745e507e0e5SFrank Schaefer * first frame. 746e507e0e5SFrank Schaefer */ 747e507e0e5SFrank Schaefer } 748e507e0e5SFrank Schaefer 749e507e0e5SFrank Schaefer /* Copy data */ 750e507e0e5SFrank Schaefer if (buf != NULL && data_len > 0) 751e507e0e5SFrank Schaefer em28xx_copy_video(dev, buf, data_pkt, data_len); 752e507e0e5SFrank Schaefer 753e507e0e5SFrank Schaefer /* Finish frame (ISOC only) => avoids lag of 1 frame */ 754e507e0e5SFrank Schaefer if (!dev->analog_xfer_bulk && frame_end) { 755e507e0e5SFrank Schaefer buf = finish_field_prepare_next(dev, buf, dmaq); 756e507e0e5SFrank Schaefer dev->usb_ctl.vid_buf = buf; 757e507e0e5SFrank Schaefer } 758e507e0e5SFrank Schaefer 759e507e0e5SFrank Schaefer /* NOTE: Tested with USB bulk transfers only ! 760e507e0e5SFrank Schaefer * The wording in the datasheet suggests that isoc might work different. 761e507e0e5SFrank Schaefer * The current code assumes that with isoc transfers each packet has a 762e507e0e5SFrank Schaefer * header like with the other em28xx devices. 763e507e0e5SFrank Schaefer */ 764e507e0e5SFrank Schaefer /* NOTE: Support for interlaced mode is pure theory. It has not been 765e507e0e5SFrank Schaefer * tested and it is unknown if these devices actually support it. */ 766e507e0e5SFrank Schaefer /* NOTE: No VBI support yet (these chips likely do not support VBI). */ 767e507e0e5SFrank Schaefer } 768e507e0e5SFrank Schaefer 769960da93bSFrank Schaefer /* Processes and copies the URB data content (video and VBI data) */ 7700fa4a402SFrank Schaefer static inline int em28xx_urb_data_copy(struct em28xx *dev, struct urb *urb) 7710c0d06caSMauro Carvalho Chehab { 772227b7c90SFrank Schaefer int xfer_bulk, num_packets, i; 773227b7c90SFrank Schaefer unsigned char *usb_data_pkt; 774227b7c90SFrank Schaefer unsigned int usb_data_len; 7750c0d06caSMauro Carvalho Chehab 7760c0d06caSMauro Carvalho Chehab if (!dev) 7770c0d06caSMauro Carvalho Chehab return 0; 7780c0d06caSMauro Carvalho Chehab 7792665c299SFrank Schaefer if (dev->disconnected) 7800c0d06caSMauro Carvalho Chehab return 0; 7810c0d06caSMauro Carvalho Chehab 7821653cb0cSFrank Schaefer if (urb->status < 0) 7830c0d06caSMauro Carvalho Chehab print_err_status(dev, -1, urb->status); 7840c0d06caSMauro Carvalho Chehab 7854601cc39SFrank Schaefer xfer_bulk = usb_pipebulk(urb->pipe); 7864601cc39SFrank Schaefer 7874601cc39SFrank Schaefer if (xfer_bulk) /* bulk */ 7884601cc39SFrank Schaefer num_packets = 1; 7894601cc39SFrank Schaefer else /* isoc */ 7904601cc39SFrank Schaefer num_packets = urb->number_of_packets; 7910c0d06caSMauro Carvalho Chehab 7924601cc39SFrank Schaefer for (i = 0; i < num_packets; i++) { 7934601cc39SFrank Schaefer if (xfer_bulk) { /* bulk */ 794227b7c90SFrank Schaefer usb_data_len = urb->actual_length; 7954601cc39SFrank Schaefer 796227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer; 7974601cc39SFrank Schaefer } else { /* isoc */ 7984601cc39SFrank Schaefer if (urb->iso_frame_desc[i].status < 0) { 7994601cc39SFrank Schaefer print_err_status(dev, i, 8004601cc39SFrank Schaefer urb->iso_frame_desc[i].status); 8010c0d06caSMauro Carvalho Chehab if (urb->iso_frame_desc[i].status != -EPROTO) 8020c0d06caSMauro Carvalho Chehab continue; 8030c0d06caSMauro Carvalho Chehab } 8040c0d06caSMauro Carvalho Chehab 805227b7c90SFrank Schaefer usb_data_len = urb->iso_frame_desc[i].actual_length; 806227b7c90SFrank Schaefer if (usb_data_len > dev->max_pkt_size) { 8070c0d06caSMauro Carvalho Chehab em28xx_isocdbg("packet bigger than packet size"); 8080c0d06caSMauro Carvalho Chehab continue; 8090c0d06caSMauro Carvalho Chehab } 8100c0d06caSMauro Carvalho Chehab 811227b7c90SFrank Schaefer usb_data_pkt = urb->transfer_buffer + 8124601cc39SFrank Schaefer urb->iso_frame_desc[i].offset; 8134601cc39SFrank Schaefer } 8144601cc39SFrank Schaefer 815227b7c90SFrank Schaefer if (usb_data_len == 0) { 8164601cc39SFrank Schaefer /* NOTE: happens very often with isoc transfers */ 8174601cc39SFrank Schaefer /* em28xx_usbdbg("packet %d is empty",i); - spammy */ 8184601cc39SFrank Schaefer continue; 8194601cc39SFrank Schaefer } 8200c0d06caSMauro Carvalho Chehab 821e507e0e5SFrank Schaefer if (dev->is_em25xx) 822e507e0e5SFrank Schaefer process_frame_data_em25xx(dev, 823e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 824e507e0e5SFrank Schaefer else 825e507e0e5SFrank Schaefer process_frame_data_em28xx(dev, 826e507e0e5SFrank Schaefer usb_data_pkt, usb_data_len); 827e507e0e5SFrank Schaefer 8280c0d06caSMauro Carvalho Chehab } 829227b7c90SFrank Schaefer return 1; 8300c0d06caSMauro Carvalho Chehab } 8310c0d06caSMauro Carvalho Chehab 832d3829fadSDevin Heitmueller static int get_ressource(enum v4l2_buf_type f_type) 833d3829fadSDevin Heitmueller { 834d3829fadSDevin Heitmueller switch (f_type) { 835d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VIDEO_CAPTURE: 836d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VIDEO; 837d3829fadSDevin Heitmueller case V4L2_BUF_TYPE_VBI_CAPTURE: 838d3829fadSDevin Heitmueller return EM28XX_RESOURCE_VBI; 839d3829fadSDevin Heitmueller default: 840d3829fadSDevin Heitmueller BUG(); 841d3829fadSDevin Heitmueller } 842d3829fadSDevin Heitmueller } 843d3829fadSDevin Heitmueller 844d3829fadSDevin Heitmueller /* Usage lock check functions */ 845d3829fadSDevin Heitmueller static int res_get(struct em28xx *dev, enum v4l2_buf_type f_type) 846d3829fadSDevin Heitmueller { 847d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 848d3829fadSDevin Heitmueller 849d3829fadSDevin Heitmueller /* is it free? */ 850d3829fadSDevin Heitmueller if (dev->resources & res_type) { 851d3829fadSDevin Heitmueller /* no, someone else uses it */ 852d3829fadSDevin Heitmueller return -EBUSY; 853d3829fadSDevin Heitmueller } 854d3829fadSDevin Heitmueller 855d3829fadSDevin Heitmueller /* it's free, grab it */ 856d3829fadSDevin Heitmueller dev->resources |= res_type; 857d3829fadSDevin Heitmueller em28xx_videodbg("res: get %d\n", res_type); 858d3829fadSDevin Heitmueller return 0; 859d3829fadSDevin Heitmueller } 860d3829fadSDevin Heitmueller 861d3829fadSDevin Heitmueller static void res_free(struct em28xx *dev, enum v4l2_buf_type f_type) 862d3829fadSDevin Heitmueller { 863d3829fadSDevin Heitmueller int res_type = get_ressource(f_type); 864d3829fadSDevin Heitmueller 865d3829fadSDevin Heitmueller dev->resources &= ~res_type; 866d3829fadSDevin Heitmueller em28xx_videodbg("res: put %d\n", res_type); 867d3829fadSDevin Heitmueller } 868d3829fadSDevin Heitmueller 86937ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_media_release(struct em28xx *dev) 87037ecc7b1SMauro Carvalho Chehab { 87137ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 87237ecc7b1SMauro Carvalho Chehab int i; 87337ecc7b1SMauro Carvalho Chehab 87437ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 87537ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 87637ecc7b1SMauro Carvalho Chehab return; 87737ecc7b1SMauro Carvalho Chehab media_device_unregister_entity(&dev->input_ent[i]); 87837ecc7b1SMauro Carvalho Chehab } 87937ecc7b1SMauro Carvalho Chehab #endif 88037ecc7b1SMauro Carvalho Chehab } 88137ecc7b1SMauro Carvalho Chehab 88237ecc7b1SMauro Carvalho Chehab /* 88337ecc7b1SMauro Carvalho Chehab * Media Controller helper functions 88437ecc7b1SMauro Carvalho Chehab */ 88537ecc7b1SMauro Carvalho Chehab 88637ecc7b1SMauro Carvalho Chehab static int em28xx_enable_analog_tuner(struct em28xx *dev) 88737ecc7b1SMauro Carvalho Chehab { 88837ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 88937ecc7b1SMauro Carvalho Chehab struct media_device *mdev = dev->media_dev; 89037ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 89137ecc7b1SMauro Carvalho Chehab struct media_entity *source; 89237ecc7b1SMauro Carvalho Chehab struct media_link *link, *found_link = NULL; 89337ecc7b1SMauro Carvalho Chehab int ret, active_links = 0; 89437ecc7b1SMauro Carvalho Chehab 89537ecc7b1SMauro Carvalho Chehab if (!mdev || !v4l2->decoder) 89637ecc7b1SMauro Carvalho Chehab return 0; 89737ecc7b1SMauro Carvalho Chehab 89837ecc7b1SMauro Carvalho Chehab /* 89937ecc7b1SMauro Carvalho Chehab * This will find the tuner that is connected into the decoder. 90037ecc7b1SMauro Carvalho Chehab * Technically, this is not 100% correct, as the device may be 90137ecc7b1SMauro Carvalho Chehab * using an analog input instead of the tuner. However, as we can't 90237ecc7b1SMauro Carvalho Chehab * do DVB streaming while the DMA engine is being used for V4L2, 90337ecc7b1SMauro Carvalho Chehab * this should be enough for the actual needs. 90437ecc7b1SMauro Carvalho Chehab */ 90537ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &v4l2->decoder->links, list) { 90637ecc7b1SMauro Carvalho Chehab if (link->sink->entity == v4l2->decoder) { 90737ecc7b1SMauro Carvalho Chehab found_link = link; 90837ecc7b1SMauro Carvalho Chehab if (link->flags & MEDIA_LNK_FL_ENABLED) 90937ecc7b1SMauro Carvalho Chehab active_links++; 91037ecc7b1SMauro Carvalho Chehab break; 91137ecc7b1SMauro Carvalho Chehab } 91237ecc7b1SMauro Carvalho Chehab } 91337ecc7b1SMauro Carvalho Chehab 91437ecc7b1SMauro Carvalho Chehab if (active_links == 1 || !found_link) 91537ecc7b1SMauro Carvalho Chehab return 0; 91637ecc7b1SMauro Carvalho Chehab 91737ecc7b1SMauro Carvalho Chehab source = found_link->source->entity; 91837ecc7b1SMauro Carvalho Chehab list_for_each_entry(link, &source->links, list) { 91937ecc7b1SMauro Carvalho Chehab struct media_entity *sink; 92037ecc7b1SMauro Carvalho Chehab int flags = 0; 92137ecc7b1SMauro Carvalho Chehab 92237ecc7b1SMauro Carvalho Chehab sink = link->sink->entity; 92337ecc7b1SMauro Carvalho Chehab 92437ecc7b1SMauro Carvalho Chehab if (sink == v4l2->decoder) 92537ecc7b1SMauro Carvalho Chehab flags = MEDIA_LNK_FL_ENABLED; 92637ecc7b1SMauro Carvalho Chehab 92737ecc7b1SMauro Carvalho Chehab ret = media_entity_setup_link(link, flags); 92837ecc7b1SMauro Carvalho Chehab if (ret) { 92937ecc7b1SMauro Carvalho Chehab pr_err("Couldn't change link %s->%s to %s. Error %d\n", 93037ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93137ecc7b1SMauro Carvalho Chehab flags ? "enabled" : "disabled", 93237ecc7b1SMauro Carvalho Chehab ret); 93337ecc7b1SMauro Carvalho Chehab return ret; 93437ecc7b1SMauro Carvalho Chehab } else 93537ecc7b1SMauro Carvalho Chehab em28xx_videodbg("link %s->%s was %s\n", 93637ecc7b1SMauro Carvalho Chehab source->name, sink->name, 93737ecc7b1SMauro Carvalho Chehab flags ? "ENABLED" : "disabled"); 93837ecc7b1SMauro Carvalho Chehab } 93937ecc7b1SMauro Carvalho Chehab #endif 94037ecc7b1SMauro Carvalho Chehab return 0; 94137ecc7b1SMauro Carvalho Chehab } 94237ecc7b1SMauro Carvalho Chehab 94337ecc7b1SMauro Carvalho Chehab static const char * const iname[] = { 94437ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_COMPOSITE] = "Composite", 94537ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_SVIDEO] = "S-Video", 94637ecc7b1SMauro Carvalho Chehab [EM28XX_VMUX_TELEVISION] = "Television", 94737ecc7b1SMauro Carvalho Chehab [EM28XX_RADIO] = "Radio", 94837ecc7b1SMauro Carvalho Chehab }; 94937ecc7b1SMauro Carvalho Chehab 95037ecc7b1SMauro Carvalho Chehab static void em28xx_v4l2_create_entities(struct em28xx *dev) 95137ecc7b1SMauro Carvalho Chehab { 95237ecc7b1SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER) 95337ecc7b1SMauro Carvalho Chehab struct em28xx_v4l2 *v4l2 = dev->v4l2; 95437ecc7b1SMauro Carvalho Chehab int ret, i; 95537ecc7b1SMauro Carvalho Chehab 95637ecc7b1SMauro Carvalho Chehab /* Initialize Video, VBI and Radio pads */ 95737ecc7b1SMauro Carvalho Chehab v4l2->video_pad.flags = MEDIA_PAD_FL_SINK; 95837ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vdev.entity, 1, &v4l2->video_pad); 95937ecc7b1SMauro Carvalho Chehab if (ret < 0) 96037ecc7b1SMauro Carvalho Chehab pr_err("failed to initialize video media entity!\n"); 96137ecc7b1SMauro Carvalho Chehab 96237ecc7b1SMauro Carvalho Chehab if (em28xx_vbi_supported(dev)) { 96337ecc7b1SMauro Carvalho Chehab v4l2->vbi_pad.flags = MEDIA_PAD_FL_SINK; 96437ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(&v4l2->vbi_dev.entity, 1, 96537ecc7b1SMauro Carvalho Chehab &v4l2->vbi_pad); 96637ecc7b1SMauro Carvalho Chehab if (ret < 0) 96737ecc7b1SMauro Carvalho Chehab pr_err("failed to initialize vbi media entity!\n"); 96837ecc7b1SMauro Carvalho Chehab } 96937ecc7b1SMauro Carvalho Chehab 97037ecc7b1SMauro Carvalho Chehab /* Webcams don't have input connectors */ 97137ecc7b1SMauro Carvalho Chehab if (dev->board.is_webcam) 97237ecc7b1SMauro Carvalho Chehab return; 97337ecc7b1SMauro Carvalho Chehab 97437ecc7b1SMauro Carvalho Chehab /* Create entities for each input connector */ 97537ecc7b1SMauro Carvalho Chehab for (i = 0; i < MAX_EM28XX_INPUT; i++) { 97637ecc7b1SMauro Carvalho Chehab struct media_entity *ent = &dev->input_ent[i]; 97737ecc7b1SMauro Carvalho Chehab 97837ecc7b1SMauro Carvalho Chehab if (!INPUT(i)->type) 97937ecc7b1SMauro Carvalho Chehab break; 98037ecc7b1SMauro Carvalho Chehab 98137ecc7b1SMauro Carvalho Chehab ent->name = iname[INPUT(i)->type]; 98237ecc7b1SMauro Carvalho Chehab ent->flags = MEDIA_ENT_FL_CONNECTOR; 98337ecc7b1SMauro Carvalho Chehab dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 98437ecc7b1SMauro Carvalho Chehab 98537ecc7b1SMauro Carvalho Chehab switch (INPUT(i)->type) { 98637ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_COMPOSITE: 98737ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 98837ecc7b1SMauro Carvalho Chehab break; 98937ecc7b1SMauro Carvalho Chehab case EM28XX_VMUX_SVIDEO: 99037ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_SVIDEO; 99137ecc7b1SMauro Carvalho Chehab break; 99237ecc7b1SMauro Carvalho Chehab default: /* EM28XX_VMUX_TELEVISION or EM28XX_RADIO */ 993e9ef88bdSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 99437ecc7b1SMauro Carvalho Chehab ent->function = MEDIA_ENT_F_CONN_RF; 99537ecc7b1SMauro Carvalho Chehab break; 99637ecc7b1SMauro Carvalho Chehab } 99737ecc7b1SMauro Carvalho Chehab 99837ecc7b1SMauro Carvalho Chehab ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 99937ecc7b1SMauro Carvalho Chehab if (ret < 0) 100037ecc7b1SMauro Carvalho Chehab pr_err("failed to initialize input pad[%d]!\n", i); 100137ecc7b1SMauro Carvalho Chehab 100237ecc7b1SMauro Carvalho Chehab ret = media_device_register_entity(dev->media_dev, ent); 100337ecc7b1SMauro Carvalho Chehab if (ret < 0) 100437ecc7b1SMauro Carvalho Chehab pr_err("failed to register input entity %d!\n", i); 100537ecc7b1SMauro Carvalho Chehab } 100637ecc7b1SMauro Carvalho Chehab #endif 100737ecc7b1SMauro Carvalho Chehab } 100837ecc7b1SMauro Carvalho Chehab 100937ecc7b1SMauro Carvalho Chehab 10100c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 1011d3829fadSDevin Heitmueller Videobuf2 operations 10120c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 10130c0d06caSMauro Carvalho Chehab 1014df9ecb0cSHans Verkuil static int queue_setup(struct vb2_queue *vq, 1015d3829fadSDevin Heitmueller unsigned int *nbuffers, unsigned int *nplanes, 1016d3829fadSDevin Heitmueller unsigned int sizes[], void *alloc_ctxs[]) 10170c0d06caSMauro Carvalho Chehab { 1018d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1019753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1020df9ecb0cSHans Verkuil unsigned long size = 102106e20672SFrank Schaefer (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 10220c0d06caSMauro Carvalho Chehab 1023df9ecb0cSHans Verkuil if (*nplanes) 1024df9ecb0cSHans Verkuil return sizes[0] < size ? -EINVAL : 0; 1025d3829fadSDevin Heitmueller *nplanes = 1; 1026d3829fadSDevin Heitmueller sizes[0] = size; 102737ecc7b1SMauro Carvalho Chehab 102837ecc7b1SMauro Carvalho Chehab em28xx_enable_analog_tuner(dev); 102937ecc7b1SMauro Carvalho Chehab 10300c0d06caSMauro Carvalho Chehab return 0; 10310c0d06caSMauro Carvalho Chehab } 10320c0d06caSMauro Carvalho Chehab 10330c0d06caSMauro Carvalho Chehab static int 1034d3829fadSDevin Heitmueller buffer_prepare(struct vb2_buffer *vb) 10350c0d06caSMauro Carvalho Chehab { 10362d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1037d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 1038753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1039d3829fadSDevin Heitmueller unsigned long size; 10400c0d06caSMauro Carvalho Chehab 10412d700715SJunghak Sung em28xx_videodbg("%s, field=%d\n", __func__, vbuf->field); 10420c0d06caSMauro Carvalho Chehab 104306e20672SFrank Schaefer size = (v4l2->width * v4l2->height * v4l2->format->depth + 7) >> 3; 1044d3829fadSDevin Heitmueller 1045d3829fadSDevin Heitmueller if (vb2_plane_size(vb, 0) < size) { 1046d3829fadSDevin Heitmueller em28xx_videodbg("%s data will not fit into plane (%lu < %lu)\n", 1047d3829fadSDevin Heitmueller __func__, vb2_plane_size(vb, 0), size); 10480c0d06caSMauro Carvalho Chehab return -EINVAL; 1049d3829fadSDevin Heitmueller } 10502d700715SJunghak Sung vb2_set_plane_payload(vb, 0, size); 10510c0d06caSMauro Carvalho Chehab 1052d3829fadSDevin Heitmueller return 0; 10530c0d06caSMauro Carvalho Chehab } 10540c0d06caSMauro Carvalho Chehab 1055d3829fadSDevin Heitmueller int em28xx_start_analog_streaming(struct vb2_queue *vq, unsigned int count) 1056d3829fadSDevin Heitmueller { 1057d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 1058f0e38230SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1059d3829fadSDevin Heitmueller struct v4l2_frequency f; 10602d700715SJunghak Sung struct v4l2_fh *owner; 1061d3829fadSDevin Heitmueller int rc = 0; 10620c0d06caSMauro Carvalho Chehab 1063d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1064d3829fadSDevin Heitmueller 1065d3829fadSDevin Heitmueller /* Make sure streaming is not already in progress for this type 1066d3829fadSDevin Heitmueller of filehandle (e.g. video, vbi) */ 1067d3829fadSDevin Heitmueller rc = res_get(dev, vq->type); 1068d3829fadSDevin Heitmueller if (rc) 1069d3829fadSDevin Heitmueller return rc; 1070d3829fadSDevin Heitmueller 10718139a4d5SFrank Schaefer if (v4l2->streaming_users == 0) { 1072d3829fadSDevin Heitmueller /* First active streaming user, so allocate all the URBs */ 1073d3829fadSDevin Heitmueller 1074d3829fadSDevin Heitmueller /* Allocate the USB bandwidth */ 1075d3829fadSDevin Heitmueller em28xx_set_alternate(dev); 1076d3829fadSDevin Heitmueller 1077d3829fadSDevin Heitmueller /* Needed, since GPIO might have disabled power of 1078d3829fadSDevin Heitmueller some i2c device 1079d3829fadSDevin Heitmueller */ 1080d3829fadSDevin Heitmueller em28xx_wake_i2c(dev); 1081d3829fadSDevin Heitmueller 1082f0e38230SFrank Schaefer v4l2->capture_type = -1; 1083c647a91aSFrank Schaefer rc = em28xx_init_usb_xfer(dev, EM28XX_ANALOG_MODE, 1084c647a91aSFrank Schaefer dev->analog_xfer_bulk, 10850c0d06caSMauro Carvalho Chehab EM28XX_NUM_BUFS, 10860c0d06caSMauro Carvalho Chehab dev->max_pkt_size, 1087c647a91aSFrank Schaefer dev->packet_multiplier, 10880fa4a402SFrank Schaefer em28xx_urb_data_copy); 10890c0d06caSMauro Carvalho Chehab if (rc < 0) 1090032f1ddfSFrank Schaefer return rc; 1091d3829fadSDevin Heitmueller 1092d3829fadSDevin Heitmueller /* 1093d3829fadSDevin Heitmueller * djh: it's not clear whether this code is still needed. I'm 1094d3829fadSDevin Heitmueller * leaving it in here for now entirely out of concern for 1095d3829fadSDevin Heitmueller * backward compatibility (the old code did it) 1096d3829fadSDevin Heitmueller */ 1097d3829fadSDevin Heitmueller 1098d3829fadSDevin Heitmueller /* Ask tuner to go to analog or radio mode */ 1099d3829fadSDevin Heitmueller memset(&f, 0, sizeof(f)); 11003854b0d8SFrank Schaefer f.frequency = v4l2->frequency; 11012d700715SJunghak Sung owner = (struct v4l2_fh *)vq->owner; 11022d700715SJunghak Sung if (owner && owner->vdev->vfl_type == VFL_TYPE_RADIO) 1103d3829fadSDevin Heitmueller f.type = V4L2_TUNER_RADIO; 1104d3829fadSDevin Heitmueller else 1105d3829fadSDevin Heitmueller f.type = V4L2_TUNER_ANALOG_TV; 1106f0e38230SFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 110795d2608bSFrank Schaefer 0, tuner, s_frequency, &f); 110813d52fe4SMauro Carvalho Chehab 110913d52fe4SMauro Carvalho Chehab /* Enable video stream at TV decoder */ 111013d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 1); 11110c0d06caSMauro Carvalho Chehab } 11120c0d06caSMauro Carvalho Chehab 11138139a4d5SFrank Schaefer v4l2->streaming_users++; 1114032f1ddfSFrank Schaefer 11150c0d06caSMauro Carvalho Chehab return rc; 11160c0d06caSMauro Carvalho Chehab } 11170c0d06caSMauro Carvalho Chehab 1118e37559b2SHans Verkuil static void em28xx_stop_streaming(struct vb2_queue *vq) 11190c0d06caSMauro Carvalho Chehab { 1120d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11218139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 11220c0d06caSMauro Carvalho Chehab struct em28xx_dmaqueue *vidq = &dev->vidq; 1123d3829fadSDevin Heitmueller unsigned long flags = 0; 11240c0d06caSMauro Carvalho Chehab 1125d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11260c0d06caSMauro Carvalho Chehab 1127d3829fadSDevin Heitmueller res_free(dev, vq->type); 1128d3829fadSDevin Heitmueller 11298139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 113013d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 113113d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 113213d52fe4SMauro Carvalho Chehab 1133d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1134d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11350c0d06caSMauro Carvalho Chehab } 11360c0d06caSMauro Carvalho Chehab 1137d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1138627530c3SFrank Schaefer if (dev->usb_ctl.vid_buf != NULL) { 11392d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vid_buf->vb.vb2_buf, 11402d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1141627530c3SFrank Schaefer dev->usb_ctl.vid_buf = NULL; 1142627530c3SFrank Schaefer } 1143d3829fadSDevin Heitmueller while (!list_empty(&vidq->active)) { 1144d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1145fdf1bc9fSMauro Carvalho Chehab 1146d3829fadSDevin Heitmueller buf = list_entry(vidq->active.next, struct em28xx_buffer, list); 1147d3829fadSDevin Heitmueller list_del(&buf->list); 11482d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1149d3829fadSDevin Heitmueller } 1150d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1151d3829fadSDevin Heitmueller } 1152d3829fadSDevin Heitmueller 1153e37559b2SHans Verkuil void em28xx_stop_vbi_streaming(struct vb2_queue *vq) 11540c0d06caSMauro Carvalho Chehab { 1155d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vq); 11568139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1157d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vbiq = &dev->vbiq; 1158d3829fadSDevin Heitmueller unsigned long flags = 0; 11590c0d06caSMauro Carvalho Chehab 1160d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 11610c0d06caSMauro Carvalho Chehab 1162d3829fadSDevin Heitmueller res_free(dev, vq->type); 1163d3829fadSDevin Heitmueller 11648139a4d5SFrank Schaefer if (v4l2->streaming_users-- == 1) { 116513d52fe4SMauro Carvalho Chehab /* Disable video stream at TV decoder */ 116613d52fe4SMauro Carvalho Chehab v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_stream, 0); 116713d52fe4SMauro Carvalho Chehab 1168d3829fadSDevin Heitmueller /* Last active user, so shutdown all the URBS */ 1169d3829fadSDevin Heitmueller em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 11700c0d06caSMauro Carvalho Chehab } 11710c0d06caSMauro Carvalho Chehab 1172d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1173627530c3SFrank Schaefer if (dev->usb_ctl.vbi_buf != NULL) { 11742d700715SJunghak Sung vb2_buffer_done(&dev->usb_ctl.vbi_buf->vb.vb2_buf, 11752d700715SJunghak Sung VB2_BUF_STATE_ERROR); 1176627530c3SFrank Schaefer dev->usb_ctl.vbi_buf = NULL; 1177627530c3SFrank Schaefer } 1178d3829fadSDevin Heitmueller while (!list_empty(&vbiq->active)) { 1179d3829fadSDevin Heitmueller struct em28xx_buffer *buf; 1180fdf1bc9fSMauro Carvalho Chehab 1181d3829fadSDevin Heitmueller buf = list_entry(vbiq->active.next, struct em28xx_buffer, list); 1182d3829fadSDevin Heitmueller list_del(&buf->list); 11832d700715SJunghak Sung vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); 1184d3829fadSDevin Heitmueller } 1185d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1186d3829fadSDevin Heitmueller } 1187d3829fadSDevin Heitmueller 1188d3829fadSDevin Heitmueller static void 1189d3829fadSDevin Heitmueller buffer_queue(struct vb2_buffer *vb) 1190d3829fadSDevin Heitmueller { 11912d700715SJunghak Sung struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb); 1192d3829fadSDevin Heitmueller struct em28xx *dev = vb2_get_drv_priv(vb->vb2_queue); 11932d700715SJunghak Sung struct em28xx_buffer *buf = 11942d700715SJunghak Sung container_of(vbuf, struct em28xx_buffer, vb); 1195d3829fadSDevin Heitmueller struct em28xx_dmaqueue *vidq = &dev->vidq; 1196d3829fadSDevin Heitmueller unsigned long flags = 0; 1197d3829fadSDevin Heitmueller 1198d3829fadSDevin Heitmueller em28xx_videodbg("%s\n", __func__); 1199d3829fadSDevin Heitmueller buf->mem = vb2_plane_vaddr(vb, 0); 1200d3829fadSDevin Heitmueller buf->length = vb2_plane_size(vb, 0); 1201d3829fadSDevin Heitmueller 1202d3829fadSDevin Heitmueller spin_lock_irqsave(&dev->slock, flags); 1203d3829fadSDevin Heitmueller list_add_tail(&buf->list, &vidq->active); 1204d3829fadSDevin Heitmueller spin_unlock_irqrestore(&dev->slock, flags); 1205d3829fadSDevin Heitmueller } 1206d3829fadSDevin Heitmueller 1207d3829fadSDevin Heitmueller static struct vb2_ops em28xx_video_qops = { 1208d3829fadSDevin Heitmueller .queue_setup = queue_setup, 12090c0d06caSMauro Carvalho Chehab .buf_prepare = buffer_prepare, 12100c0d06caSMauro Carvalho Chehab .buf_queue = buffer_queue, 1211d3829fadSDevin Heitmueller .start_streaming = em28xx_start_analog_streaming, 1212d3829fadSDevin Heitmueller .stop_streaming = em28xx_stop_streaming, 1213d3829fadSDevin Heitmueller .wait_prepare = vb2_ops_wait_prepare, 1214d3829fadSDevin Heitmueller .wait_finish = vb2_ops_wait_finish, 12150c0d06caSMauro Carvalho Chehab }; 12160c0d06caSMauro Carvalho Chehab 121701c28193SMauro Carvalho Chehab static int em28xx_vb2_setup(struct em28xx *dev) 1218d3829fadSDevin Heitmueller { 1219d3829fadSDevin Heitmueller int rc; 1220d3829fadSDevin Heitmueller struct vb2_queue *q; 122127a36df6SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 1222d3829fadSDevin Heitmueller 1223d3829fadSDevin Heitmueller /* Setup Videobuf2 for Video capture */ 122427a36df6SFrank Schaefer q = &v4l2->vb_vidq; 1225d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 1226ef85cd9cSMauro Carvalho Chehab q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR | VB2_DMABUF; 1227ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1228d3829fadSDevin Heitmueller q->drv_priv = dev; 1229d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1230d3829fadSDevin Heitmueller q->ops = &em28xx_video_qops; 1231d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1232d3829fadSDevin Heitmueller 1233d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1234d3829fadSDevin Heitmueller if (rc < 0) 1235d3829fadSDevin Heitmueller return rc; 1236d3829fadSDevin Heitmueller 1237d3829fadSDevin Heitmueller /* Setup Videobuf2 for VBI capture */ 123827a36df6SFrank Schaefer q = &v4l2->vb_vbiq; 1239d3829fadSDevin Heitmueller q->type = V4L2_BUF_TYPE_VBI_CAPTURE; 1240d3829fadSDevin Heitmueller q->io_modes = VB2_READ | VB2_MMAP | VB2_USERPTR; 1241ade48681SSakari Ailus q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; 1242d3829fadSDevin Heitmueller q->drv_priv = dev; 1243d3829fadSDevin Heitmueller q->buf_struct_size = sizeof(struct em28xx_buffer); 1244d3829fadSDevin Heitmueller q->ops = &em28xx_vbi_qops; 1245d3829fadSDevin Heitmueller q->mem_ops = &vb2_vmalloc_memops; 1246d3829fadSDevin Heitmueller 1247d3829fadSDevin Heitmueller rc = vb2_queue_init(q); 1248d3829fadSDevin Heitmueller if (rc < 0) 1249d3829fadSDevin Heitmueller return rc; 1250d3829fadSDevin Heitmueller 1251d3829fadSDevin Heitmueller return 0; 1252d3829fadSDevin Heitmueller } 1253d3829fadSDevin Heitmueller 12540c0d06caSMauro Carvalho Chehab /********************* v4l2 interface **************************************/ 12550c0d06caSMauro Carvalho Chehab 12560c0d06caSMauro Carvalho Chehab static void video_mux(struct em28xx *dev, int index) 12570c0d06caSMauro Carvalho Chehab { 125895d2608bSFrank Schaefer struct v4l2_device *v4l2_dev = &dev->v4l2->v4l2_dev; 1259fdf1bc9fSMauro Carvalho Chehab 12600c0d06caSMauro Carvalho Chehab dev->ctl_input = index; 12610c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(index)->amux; 12620c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(index)->aout; 12630c0d06caSMauro Carvalho Chehab 12640c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 12650c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 12660c0d06caSMauro Carvalho Chehab 126795d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, video, s_routing, 12680c0d06caSMauro Carvalho Chehab INPUT(index)->vmux, 0, 0); 12690c0d06caSMauro Carvalho Chehab 12700c0d06caSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 12710c0d06caSMauro Carvalho Chehab if (dev->i2s_speed) { 127295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, 12730c0d06caSMauro Carvalho Chehab s_i2s_clock_freq, dev->i2s_speed); 12740c0d06caSMauro Carvalho Chehab } 12750c0d06caSMauro Carvalho Chehab /* Note: this is msp3400 specific */ 127695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 1277fdf1bc9fSMauro Carvalho Chehab dev->ctl_ainput, 1278fdf1bc9fSMauro Carvalho Chehab MSP_OUTPUT(MSP_SC_IN_DSP_SCART1), 0); 12790c0d06caSMauro Carvalho Chehab } 12800c0d06caSMauro Carvalho Chehab 12810c0d06caSMauro Carvalho Chehab if (dev->board.adecoder != EM28XX_NOADECODER) { 128295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, audio, s_routing, 12830c0d06caSMauro Carvalho Chehab dev->ctl_ainput, dev->ctl_aoutput, 0); 12840c0d06caSMauro Carvalho Chehab } 12850c0d06caSMauro Carvalho Chehab 12860c0d06caSMauro Carvalho Chehab em28xx_audio_analog_set(dev); 12870c0d06caSMauro Carvalho Chehab } 12880c0d06caSMauro Carvalho Chehab 128901c28193SMauro Carvalho Chehab static void em28xx_ctrl_notify(struct v4l2_ctrl *ctrl, void *priv) 12900c0d06caSMauro Carvalho Chehab { 1291081b945eSHans Verkuil struct em28xx *dev = priv; 12920c0d06caSMauro Carvalho Chehab 12930c0d06caSMauro Carvalho Chehab /* 1294081b945eSHans Verkuil * In the case of non-AC97 volume controls, we still need 1295081b945eSHans Verkuil * to do some setups at em28xx, in order to mute/unmute 1296081b945eSHans Verkuil * and to adjust audio volume. However, the value ranges 1297081b945eSHans Verkuil * should be checked by the corresponding V4L subdriver. 12980c0d06caSMauro Carvalho Chehab */ 12990c0d06caSMauro Carvalho Chehab switch (ctrl->id) { 13000c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_MUTE: 1301081b945eSHans Verkuil dev->mute = ctrl->val; 1302081b945eSHans Verkuil em28xx_audio_analog_set(dev); 13030c0d06caSMauro Carvalho Chehab break; 13040c0d06caSMauro Carvalho Chehab case V4L2_CID_AUDIO_VOLUME: 1305081b945eSHans Verkuil dev->volume = ctrl->val; 1306081b945eSHans Verkuil em28xx_audio_analog_set(dev); 1307081b945eSHans Verkuil break; 1308081b945eSHans Verkuil } 1309081b945eSHans Verkuil } 1310081b945eSHans Verkuil 1311081b945eSHans Verkuil static int em28xx_s_ctrl(struct v4l2_ctrl *ctrl) 1312081b945eSHans Verkuil { 1313abc1308fSFrank Schaefer struct em28xx_v4l2 *v4l2 = 1314abc1308fSFrank Schaefer container_of(ctrl->handler, struct em28xx_v4l2, ctrl_handler); 1315abc1308fSFrank Schaefer struct em28xx *dev = v4l2->dev; 13168f8b113aSFrank Schaefer int ret = -EINVAL; 1317081b945eSHans Verkuil 1318081b945eSHans Verkuil switch (ctrl->id) { 1319081b945eSHans Verkuil case V4L2_CID_AUDIO_MUTE: 1320081b945eSHans Verkuil dev->mute = ctrl->val; 13218f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 1322081b945eSHans Verkuil break; 1323081b945eSHans Verkuil case V4L2_CID_AUDIO_VOLUME: 1324081b945eSHans Verkuil dev->volume = ctrl->val; 13258f8b113aSFrank Schaefer ret = em28xx_audio_analog_set(dev); 13268f8b113aSFrank Schaefer break; 13278f8b113aSFrank Schaefer case V4L2_CID_CONTRAST: 13288f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R20_YGAIN, ctrl->val); 13298f8b113aSFrank Schaefer break; 13308f8b113aSFrank Schaefer case V4L2_CID_BRIGHTNESS: 13318f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R21_YOFFSET, ctrl->val); 13328f8b113aSFrank Schaefer break; 13338f8b113aSFrank Schaefer case V4L2_CID_SATURATION: 13348f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R22_UVGAIN, ctrl->val); 13358f8b113aSFrank Schaefer break; 13368f8b113aSFrank Schaefer case V4L2_CID_BLUE_BALANCE: 13378f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R23_UOFFSET, ctrl->val); 13388f8b113aSFrank Schaefer break; 13398f8b113aSFrank Schaefer case V4L2_CID_RED_BALANCE: 13408f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R24_VOFFSET, ctrl->val); 13418f8b113aSFrank Schaefer break; 13428f8b113aSFrank Schaefer case V4L2_CID_SHARPNESS: 13438f8b113aSFrank Schaefer ret = em28xx_write_reg(dev, EM28XX_R25_SHARPNESS, ctrl->val); 13440c0d06caSMauro Carvalho Chehab break; 13450c0d06caSMauro Carvalho Chehab } 13460c0d06caSMauro Carvalho Chehab 13478f8b113aSFrank Schaefer return (ret < 0) ? ret : 0; 13480c0d06caSMauro Carvalho Chehab } 13490c0d06caSMauro Carvalho Chehab 13508068eb88SFengguang Wu static const struct v4l2_ctrl_ops em28xx_ctrl_ops = { 1351081b945eSHans Verkuil .s_ctrl = em28xx_s_ctrl, 1352081b945eSHans Verkuil }; 1353081b945eSHans Verkuil 13546b09a21cSFrank Schaefer static void size_to_scale(struct em28xx *dev, 13550c0d06caSMauro Carvalho Chehab unsigned int width, unsigned int height, 13560c0d06caSMauro Carvalho Chehab unsigned int *hscale, unsigned int *vscale) 13570c0d06caSMauro Carvalho Chehab { 13580c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 13590c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 13600c0d06caSMauro Carvalho Chehab 13610c0d06caSMauro Carvalho Chehab *hscale = (((unsigned long)maxw) << 12) / width - 4096L; 136281685327SFrank Schaefer if (*hscale > EM28XX_HVSCALE_MAX) 136381685327SFrank Schaefer *hscale = EM28XX_HVSCALE_MAX; 13640c0d06caSMauro Carvalho Chehab 13650c0d06caSMauro Carvalho Chehab *vscale = (((unsigned long)maxh) << 12) / height - 4096L; 136681685327SFrank Schaefer if (*vscale > EM28XX_HVSCALE_MAX) 136781685327SFrank Schaefer *vscale = EM28XX_HVSCALE_MAX; 13680c0d06caSMauro Carvalho Chehab } 13690c0d06caSMauro Carvalho Chehab 1370b8374138SFrank Schaefer static void scale_to_size(struct em28xx *dev, 1371b8374138SFrank Schaefer unsigned int hscale, unsigned int vscale, 1372b8374138SFrank Schaefer unsigned int *width, unsigned int *height) 1373b8374138SFrank Schaefer { 1374b8374138SFrank Schaefer unsigned int maxw = norm_maxw(dev); 1375b8374138SFrank Schaefer unsigned int maxh = norm_maxh(dev); 1376b8374138SFrank Schaefer 1377b8374138SFrank Schaefer *width = (((unsigned long)maxw) << 12) / (hscale + 4096L); 1378b8374138SFrank Schaefer *height = (((unsigned long)maxh) << 12) / (vscale + 4096L); 13790962a763SMauro Carvalho Chehab 13800962a763SMauro Carvalho Chehab /* Don't let width or height to be zero */ 13810962a763SMauro Carvalho Chehab if (*width < 1) 13820962a763SMauro Carvalho Chehab *width = 1; 13830962a763SMauro Carvalho Chehab if (*height < 1) 13840962a763SMauro Carvalho Chehab *height = 1; 1385b8374138SFrank Schaefer } 1386b8374138SFrank Schaefer 13870c0d06caSMauro Carvalho Chehab /* ------------------------------------------------------------------ 13880c0d06caSMauro Carvalho Chehab IOCTL vidioc handling 13890c0d06caSMauro Carvalho Chehab ------------------------------------------------------------------*/ 13900c0d06caSMauro Carvalho Chehab 13910c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vid_cap(struct file *file, void *priv, 13920c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 13930c0d06caSMauro Carvalho Chehab { 1394917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1395753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 13960c0d06caSMauro Carvalho Chehab 1397753aee77SFrank Schaefer f->fmt.pix.width = v4l2->width; 1398753aee77SFrank Schaefer f->fmt.pix.height = v4l2->height; 139906e20672SFrank Schaefer f->fmt.pix.pixelformat = v4l2->format->fourcc; 140006e20672SFrank Schaefer f->fmt.pix.bytesperline = (v4l2->width * v4l2->format->depth + 7) >> 3; 1401753aee77SFrank Schaefer f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * v4l2->height; 14020c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 14030c0d06caSMauro Carvalho Chehab 14040c0d06caSMauro Carvalho Chehab /* FIXME: TOP? NONE? BOTTOM? ALTENATE? */ 140558159171SFrank Schaefer if (v4l2->progressive) 14060c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14070c0d06caSMauro Carvalho Chehab else 140858159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14090c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 14100c0d06caSMauro Carvalho Chehab return 0; 14110c0d06caSMauro Carvalho Chehab } 14120c0d06caSMauro Carvalho Chehab 14130c0d06caSMauro Carvalho Chehab static struct em28xx_fmt *format_by_fourcc(unsigned int fourcc) 14140c0d06caSMauro Carvalho Chehab { 14150c0d06caSMauro Carvalho Chehab unsigned int i; 14160c0d06caSMauro Carvalho Chehab 14170c0d06caSMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(format); i++) 14180c0d06caSMauro Carvalho Chehab if (format[i].fourcc == fourcc) 14190c0d06caSMauro Carvalho Chehab return &format[i]; 14200c0d06caSMauro Carvalho Chehab 14210c0d06caSMauro Carvalho Chehab return NULL; 14220c0d06caSMauro Carvalho Chehab } 14230c0d06caSMauro Carvalho Chehab 14240c0d06caSMauro Carvalho Chehab static int vidioc_try_fmt_vid_cap(struct file *file, void *priv, 14250c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 14260c0d06caSMauro Carvalho Chehab { 1427917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 142858159171SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14290c0d06caSMauro Carvalho Chehab unsigned int width = f->fmt.pix.width; 14300c0d06caSMauro Carvalho Chehab unsigned int height = f->fmt.pix.height; 14310c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 14320c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 14330c0d06caSMauro Carvalho Chehab unsigned int hscale, vscale; 14340c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 14350c0d06caSMauro Carvalho Chehab 14360c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(f->fmt.pix.pixelformat); 14370c0d06caSMauro Carvalho Chehab if (!fmt) { 14380c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 14390c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat); 14400c0d06caSMauro Carvalho Chehab return -EINVAL; 14410c0d06caSMauro Carvalho Chehab } 14420c0d06caSMauro Carvalho Chehab 14430c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 14440c0d06caSMauro Carvalho Chehab /* the em2800 can only scale down to 50% */ 14450c0d06caSMauro Carvalho Chehab height = height > (3 * maxh / 4) ? maxh : maxh / 2; 14460c0d06caSMauro Carvalho Chehab width = width > (3 * maxw / 4) ? maxw : maxw / 2; 1447d3829fadSDevin Heitmueller /* 1448d3829fadSDevin Heitmueller * MaxPacketSize for em2800 is too small to capture at full 1449d3829fadSDevin Heitmueller * resolution use half of maxw as the scaler can only scale 1450d3829fadSDevin Heitmueller * to 50% 1451d3829fadSDevin Heitmueller */ 14520c0d06caSMauro Carvalho Chehab if (width == maxw && height == maxh) 14530c0d06caSMauro Carvalho Chehab width /= 2; 14540c0d06caSMauro Carvalho Chehab } else { 14550c0d06caSMauro Carvalho Chehab /* width must even because of the YUYV format 14560c0d06caSMauro Carvalho Chehab height must be even because of interlacing */ 14570c0d06caSMauro Carvalho Chehab v4l_bound_align_image(&width, 48, maxw, 1, &height, 32, maxh, 14580c0d06caSMauro Carvalho Chehab 1, 0); 14590c0d06caSMauro Carvalho Chehab } 14600962a763SMauro Carvalho Chehab /* Avoid division by zero at size_to_scale */ 14610962a763SMauro Carvalho Chehab if (width < 1) 14620962a763SMauro Carvalho Chehab width = 1; 14630962a763SMauro Carvalho Chehab if (height < 1) 14640962a763SMauro Carvalho Chehab height = 1; 14650c0d06caSMauro Carvalho Chehab 14666b09a21cSFrank Schaefer size_to_scale(dev, width, height, &hscale, &vscale); 146746f85978SHans Verkuil scale_to_size(dev, hscale, vscale, &width, &height); 14680c0d06caSMauro Carvalho Chehab 14690c0d06caSMauro Carvalho Chehab f->fmt.pix.width = width; 14700c0d06caSMauro Carvalho Chehab f->fmt.pix.height = height; 14710c0d06caSMauro Carvalho Chehab f->fmt.pix.pixelformat = fmt->fourcc; 1472e6066dbaSHans Verkuil f->fmt.pix.bytesperline = (width * fmt->depth + 7) >> 3; 14730c0d06caSMauro Carvalho Chehab f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * height; 14740c0d06caSMauro Carvalho Chehab f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; 147558159171SFrank Schaefer if (v4l2->progressive) 14760c0d06caSMauro Carvalho Chehab f->fmt.pix.field = V4L2_FIELD_NONE; 14770c0d06caSMauro Carvalho Chehab else 147858159171SFrank Schaefer f->fmt.pix.field = v4l2->interlaced_fieldmode ? 14790c0d06caSMauro Carvalho Chehab V4L2_FIELD_INTERLACED : V4L2_FIELD_TOP; 148051dd4d70SAlban Browaeys f->fmt.pix.priv = 0; 14810c0d06caSMauro Carvalho Chehab 14820c0d06caSMauro Carvalho Chehab return 0; 14830c0d06caSMauro Carvalho Chehab } 14840c0d06caSMauro Carvalho Chehab 14850c0d06caSMauro Carvalho Chehab static int em28xx_set_video_format(struct em28xx *dev, unsigned int fourcc, 14860c0d06caSMauro Carvalho Chehab unsigned width, unsigned height) 14870c0d06caSMauro Carvalho Chehab { 14880c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 1489753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 14900c0d06caSMauro Carvalho Chehab 14910c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fourcc); 14920c0d06caSMauro Carvalho Chehab if (!fmt) 14930c0d06caSMauro Carvalho Chehab return -EINVAL; 14940c0d06caSMauro Carvalho Chehab 149506e20672SFrank Schaefer v4l2->format = fmt; 1496753aee77SFrank Schaefer v4l2->width = width; 1497753aee77SFrank Schaefer v4l2->height = height; 14980c0d06caSMauro Carvalho Chehab 14990c0d06caSMauro Carvalho Chehab /* set new image size */ 1500753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1501753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15020c0d06caSMauro Carvalho Chehab 15030c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15040c0d06caSMauro Carvalho Chehab 15050c0d06caSMauro Carvalho Chehab return 0; 15060c0d06caSMauro Carvalho Chehab } 15070c0d06caSMauro Carvalho Chehab 15080c0d06caSMauro Carvalho Chehab static int vidioc_s_fmt_vid_cap(struct file *file, void *priv, 15090c0d06caSMauro Carvalho Chehab struct v4l2_format *f) 15100c0d06caSMauro Carvalho Chehab { 1511d3829fadSDevin Heitmueller struct em28xx *dev = video_drvdata(file); 15128139a4d5SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15130c0d06caSMauro Carvalho Chehab 1514c7854c2cSMauro Carvalho Chehab if (vb2_is_busy(&v4l2->vb_vidq)) 1515d3829fadSDevin Heitmueller return -EBUSY; 15160c0d06caSMauro Carvalho Chehab 15170c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, f); 15180c0d06caSMauro Carvalho Chehab 15190c0d06caSMauro Carvalho Chehab return em28xx_set_video_format(dev, f->fmt.pix.pixelformat, 15200c0d06caSMauro Carvalho Chehab f->fmt.pix.width, f->fmt.pix.height); 15210c0d06caSMauro Carvalho Chehab } 15220c0d06caSMauro Carvalho Chehab 15230c0d06caSMauro Carvalho Chehab static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *norm) 15240c0d06caSMauro Carvalho Chehab { 1525917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15260c0d06caSMauro Carvalho Chehab 152752faaf78SFrank Schaefer *norm = dev->v4l2->norm; 15280c0d06caSMauro Carvalho Chehab 15290c0d06caSMauro Carvalho Chehab return 0; 15300c0d06caSMauro Carvalho Chehab } 15310c0d06caSMauro Carvalho Chehab 15320c0d06caSMauro Carvalho Chehab static int vidioc_querystd(struct file *file, void *priv, v4l2_std_id *norm) 15330c0d06caSMauro Carvalho Chehab { 1534917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15350c0d06caSMauro Carvalho Chehab 153695d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, video, querystd, norm); 15370c0d06caSMauro Carvalho Chehab 15380c0d06caSMauro Carvalho Chehab return 0; 15390c0d06caSMauro Carvalho Chehab } 15400c0d06caSMauro Carvalho Chehab 1541314527acSHans Verkuil static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id norm) 15420c0d06caSMauro Carvalho Chehab { 1543917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1544753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15450c0d06caSMauro Carvalho Chehab struct v4l2_format f; 15460c0d06caSMauro Carvalho Chehab 154752faaf78SFrank Schaefer if (norm == v4l2->norm) 1548d8c95c08SHans Verkuil return 0; 15490c0d06caSMauro Carvalho Chehab 15508139a4d5SFrank Schaefer if (v4l2->streaming_users > 0) 1551d8c95c08SHans Verkuil return -EBUSY; 1552d8c95c08SHans Verkuil 155352faaf78SFrank Schaefer v4l2->norm = norm; 15540c0d06caSMauro Carvalho Chehab 15550c0d06caSMauro Carvalho Chehab /* Adjusts width/height, if needed */ 1556d8c95c08SHans Verkuil f.fmt.pix.width = 720; 1557314527acSHans Verkuil f.fmt.pix.height = (norm & V4L2_STD_525_60) ? 480 : 576; 15580c0d06caSMauro Carvalho Chehab vidioc_try_fmt_vid_cap(file, priv, &f); 15590c0d06caSMauro Carvalho Chehab 15600c0d06caSMauro Carvalho Chehab /* set new image size */ 1561753aee77SFrank Schaefer v4l2->width = f.fmt.pix.width; 1562753aee77SFrank Schaefer v4l2->height = f.fmt.pix.height; 1563753aee77SFrank Schaefer size_to_scale(dev, v4l2->width, v4l2->height, 1564753aee77SFrank Schaefer &v4l2->hscale, &v4l2->vscale); 15650c0d06caSMauro Carvalho Chehab 15660c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 15678774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 15680c0d06caSMauro Carvalho Chehab 15690c0d06caSMauro Carvalho Chehab return 0; 15700c0d06caSMauro Carvalho Chehab } 15710c0d06caSMauro Carvalho Chehab 15720c0d06caSMauro Carvalho Chehab static int vidioc_g_parm(struct file *file, void *priv, 15730c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 15740c0d06caSMauro Carvalho Chehab { 1575917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 157652faaf78SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 15770c0d06caSMauro Carvalho Chehab int rc = 0; 15780c0d06caSMauro Carvalho Chehab 157986ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 15800c0d06caSMauro Carvalho Chehab if (dev->board.is_webcam) 158152faaf78SFrank Schaefer rc = v4l2_device_call_until_err(&v4l2->v4l2_dev, 0, 15820c0d06caSMauro Carvalho Chehab video, g_parm, p); 15830c0d06caSMauro Carvalho Chehab else 158452faaf78SFrank Schaefer v4l2_video_std_frame_period(v4l2->norm, 15850c0d06caSMauro Carvalho Chehab &p->parm.capture.timeperframe); 15860c0d06caSMauro Carvalho Chehab 15870c0d06caSMauro Carvalho Chehab return rc; 15880c0d06caSMauro Carvalho Chehab } 15890c0d06caSMauro Carvalho Chehab 15900c0d06caSMauro Carvalho Chehab static int vidioc_s_parm(struct file *file, void *priv, 15910c0d06caSMauro Carvalho Chehab struct v4l2_streamparm *p) 15920c0d06caSMauro Carvalho Chehab { 1593917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 15940c0d06caSMauro Carvalho Chehab 159586ff7f1dSHans Verkuil p->parm.capture.readbuffers = EM28XX_MIN_BUF; 159695d2608bSFrank Schaefer return v4l2_device_call_until_err(&dev->v4l2->v4l2_dev, 159795d2608bSFrank Schaefer 0, video, s_parm, p); 15980c0d06caSMauro Carvalho Chehab } 15990c0d06caSMauro Carvalho Chehab 16000c0d06caSMauro Carvalho Chehab static int vidioc_enum_input(struct file *file, void *priv, 16010c0d06caSMauro Carvalho Chehab struct v4l2_input *i) 16020c0d06caSMauro Carvalho Chehab { 1603917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16040c0d06caSMauro Carvalho Chehab unsigned int n; 16050c0d06caSMauro Carvalho Chehab 16060c0d06caSMauro Carvalho Chehab n = i->index; 16070c0d06caSMauro Carvalho Chehab if (n >= MAX_EM28XX_INPUT) 16080c0d06caSMauro Carvalho Chehab return -EINVAL; 16090c0d06caSMauro Carvalho Chehab if (0 == INPUT(n)->type) 16100c0d06caSMauro Carvalho Chehab return -EINVAL; 16110c0d06caSMauro Carvalho Chehab 16120c0d06caSMauro Carvalho Chehab i->index = n; 16130c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_CAMERA; 16140c0d06caSMauro Carvalho Chehab 16150c0d06caSMauro Carvalho Chehab strcpy(i->name, iname[INPUT(n)->type]); 16160c0d06caSMauro Carvalho Chehab 1617d83a96a5SMauro Carvalho Chehab if ((EM28XX_VMUX_TELEVISION == INPUT(n)->type)) 16180c0d06caSMauro Carvalho Chehab i->type = V4L2_INPUT_TYPE_TUNER; 16190c0d06caSMauro Carvalho Chehab 1620d4352f36SHans Verkuil i->std = dev->v4l2->vdev.tvnorms; 1621d8c95c08SHans Verkuil /* webcams do not have the STD API */ 1622d8c95c08SHans Verkuil if (dev->board.is_webcam) 1623d8c95c08SHans Verkuil i->capabilities = 0; 16240c0d06caSMauro Carvalho Chehab 16250c0d06caSMauro Carvalho Chehab return 0; 16260c0d06caSMauro Carvalho Chehab } 16270c0d06caSMauro Carvalho Chehab 16280c0d06caSMauro Carvalho Chehab static int vidioc_g_input(struct file *file, void *priv, unsigned int *i) 16290c0d06caSMauro Carvalho Chehab { 1630917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16310c0d06caSMauro Carvalho Chehab 16320c0d06caSMauro Carvalho Chehab *i = dev->ctl_input; 16330c0d06caSMauro Carvalho Chehab 16340c0d06caSMauro Carvalho Chehab return 0; 16350c0d06caSMauro Carvalho Chehab } 16360c0d06caSMauro Carvalho Chehab 16370c0d06caSMauro Carvalho Chehab static int vidioc_s_input(struct file *file, void *priv, unsigned int i) 16380c0d06caSMauro Carvalho Chehab { 1639917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16400c0d06caSMauro Carvalho Chehab 16410c0d06caSMauro Carvalho Chehab if (i >= MAX_EM28XX_INPUT) 16420c0d06caSMauro Carvalho Chehab return -EINVAL; 16430c0d06caSMauro Carvalho Chehab if (0 == INPUT(i)->type) 16440c0d06caSMauro Carvalho Chehab return -EINVAL; 16450c0d06caSMauro Carvalho Chehab 16460c0d06caSMauro Carvalho Chehab video_mux(dev, i); 16470c0d06caSMauro Carvalho Chehab return 0; 16480c0d06caSMauro Carvalho Chehab } 16490c0d06caSMauro Carvalho Chehab 16500c0d06caSMauro Carvalho Chehab static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) 16510c0d06caSMauro Carvalho Chehab { 1652917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16530c0d06caSMauro Carvalho Chehab 16540c0d06caSMauro Carvalho Chehab switch (a->index) { 16550c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO: 16560c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television"); 16570c0d06caSMauro Carvalho Chehab break; 16580c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_LINE_IN: 16590c0d06caSMauro Carvalho Chehab strcpy(a->name, "Line In"); 16600c0d06caSMauro Carvalho Chehab break; 16610c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_VIDEO2: 16620c0d06caSMauro Carvalho Chehab strcpy(a->name, "Television alt"); 16630c0d06caSMauro Carvalho Chehab break; 16640c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PHONE: 16650c0d06caSMauro Carvalho Chehab strcpy(a->name, "Phone"); 16660c0d06caSMauro Carvalho Chehab break; 16670c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_MIC: 16680c0d06caSMauro Carvalho Chehab strcpy(a->name, "Mic"); 16690c0d06caSMauro Carvalho Chehab break; 16700c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_CD: 16710c0d06caSMauro Carvalho Chehab strcpy(a->name, "CD"); 16720c0d06caSMauro Carvalho Chehab break; 16730c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_AUX: 16740c0d06caSMauro Carvalho Chehab strcpy(a->name, "Aux"); 16750c0d06caSMauro Carvalho Chehab break; 16760c0d06caSMauro Carvalho Chehab case EM28XX_AMUX_PCM_OUT: 16770c0d06caSMauro Carvalho Chehab strcpy(a->name, "PCM"); 16780c0d06caSMauro Carvalho Chehab break; 16790c0d06caSMauro Carvalho Chehab default: 16800c0d06caSMauro Carvalho Chehab return -EINVAL; 16810c0d06caSMauro Carvalho Chehab } 16820c0d06caSMauro Carvalho Chehab 16830c0d06caSMauro Carvalho Chehab a->index = dev->ctl_ainput; 16840c0d06caSMauro Carvalho Chehab a->capability = V4L2_AUDCAP_STEREO; 16850c0d06caSMauro Carvalho Chehab 16860c0d06caSMauro Carvalho Chehab return 0; 16870c0d06caSMauro Carvalho Chehab } 16880c0d06caSMauro Carvalho Chehab 16890e8025b9SHans Verkuil static int vidioc_s_audio(struct file *file, void *priv, const struct v4l2_audio *a) 16900c0d06caSMauro Carvalho Chehab { 1691917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 16920c0d06caSMauro Carvalho Chehab 16930c0d06caSMauro Carvalho Chehab if (a->index >= MAX_EM28XX_INPUT) 16940c0d06caSMauro Carvalho Chehab return -EINVAL; 16950c0d06caSMauro Carvalho Chehab if (0 == INPUT(a->index)->type) 16960c0d06caSMauro Carvalho Chehab return -EINVAL; 16970c0d06caSMauro Carvalho Chehab 16980c0d06caSMauro Carvalho Chehab dev->ctl_ainput = INPUT(a->index)->amux; 16990c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = INPUT(a->index)->aout; 17000c0d06caSMauro Carvalho Chehab 17010c0d06caSMauro Carvalho Chehab if (!dev->ctl_aoutput) 17020c0d06caSMauro Carvalho Chehab dev->ctl_aoutput = EM28XX_AOUT_MASTER; 17030c0d06caSMauro Carvalho Chehab 17040c0d06caSMauro Carvalho Chehab return 0; 17050c0d06caSMauro Carvalho Chehab } 17060c0d06caSMauro Carvalho Chehab 17070c0d06caSMauro Carvalho Chehab static int vidioc_g_tuner(struct file *file, void *priv, 17080c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 17090c0d06caSMauro Carvalho Chehab { 1710917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17110c0d06caSMauro Carvalho Chehab 17120c0d06caSMauro Carvalho Chehab if (0 != t->index) 17130c0d06caSMauro Carvalho Chehab return -EINVAL; 17140c0d06caSMauro Carvalho Chehab 17150c0d06caSMauro Carvalho Chehab strcpy(t->name, "Tuner"); 17160c0d06caSMauro Carvalho Chehab 171795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 17180c0d06caSMauro Carvalho Chehab return 0; 17190c0d06caSMauro Carvalho Chehab } 17200c0d06caSMauro Carvalho Chehab 17210c0d06caSMauro Carvalho Chehab static int vidioc_s_tuner(struct file *file, void *priv, 17222f73c7c5SHans Verkuil const struct v4l2_tuner *t) 17230c0d06caSMauro Carvalho Chehab { 1724917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17250c0d06caSMauro Carvalho Chehab 17260c0d06caSMauro Carvalho Chehab if (0 != t->index) 17270c0d06caSMauro Carvalho Chehab return -EINVAL; 17280c0d06caSMauro Carvalho Chehab 172995d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 17300c0d06caSMauro Carvalho Chehab return 0; 17310c0d06caSMauro Carvalho Chehab } 17320c0d06caSMauro Carvalho Chehab 17330c0d06caSMauro Carvalho Chehab static int vidioc_g_frequency(struct file *file, void *priv, 17340c0d06caSMauro Carvalho Chehab struct v4l2_frequency *f) 17350c0d06caSMauro Carvalho Chehab { 1736917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17373854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17380c0d06caSMauro Carvalho Chehab 173920deebfeSHans Verkuil if (0 != f->tuner) 174020deebfeSHans Verkuil return -EINVAL; 174120deebfeSHans Verkuil 17423854b0d8SFrank Schaefer f->frequency = v4l2->frequency; 17430c0d06caSMauro Carvalho Chehab return 0; 17440c0d06caSMauro Carvalho Chehab } 17450c0d06caSMauro Carvalho Chehab 17460c0d06caSMauro Carvalho Chehab static int vidioc_s_frequency(struct file *file, void *priv, 1747b530a447SHans Verkuil const struct v4l2_frequency *f) 17480c0d06caSMauro Carvalho Chehab { 1749b530a447SHans Verkuil struct v4l2_frequency new_freq = *f; 1750917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 175195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 17520c0d06caSMauro Carvalho Chehab 17530c0d06caSMauro Carvalho Chehab if (0 != f->tuner) 17540c0d06caSMauro Carvalho Chehab return -EINVAL; 17550c0d06caSMauro Carvalho Chehab 175695d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_frequency, f); 175795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, g_frequency, &new_freq); 17583854b0d8SFrank Schaefer v4l2->frequency = new_freq.frequency; 17590c0d06caSMauro Carvalho Chehab 17600c0d06caSMauro Carvalho Chehab return 0; 17610c0d06caSMauro Carvalho Chehab } 17620c0d06caSMauro Carvalho Chehab 1763cd634f1bSHans Verkuil #ifdef CONFIG_VIDEO_ADV_DEBUG 176496b03d2aSHans Verkuil static int vidioc_g_chip_info(struct file *file, void *priv, 176596b03d2aSHans Verkuil struct v4l2_dbg_chip_info *chip) 17663b2d17b4SHans Verkuil { 1767917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17683b2d17b4SHans Verkuil 17693b2d17b4SHans Verkuil if (chip->match.addr > 1) 17703b2d17b4SHans Verkuil return -EINVAL; 17713b2d17b4SHans Verkuil if (chip->match.addr == 1) 17723b2d17b4SHans Verkuil strlcpy(chip->name, "ac97", sizeof(chip->name)); 17733b2d17b4SHans Verkuil else 177495d2608bSFrank Schaefer strlcpy(chip->name, 177595d2608bSFrank Schaefer dev->v4l2->v4l2_dev.name, sizeof(chip->name)); 17763b2d17b4SHans Verkuil return 0; 17773b2d17b4SHans Verkuil } 17783b2d17b4SHans Verkuil 177935deba32SFrank Schaefer static int em28xx_reg_len(int reg) 178035deba32SFrank Schaefer { 178135deba32SFrank Schaefer switch (reg) { 178235deba32SFrank Schaefer case EM28XX_R40_AC97LSB: 178335deba32SFrank Schaefer case EM28XX_R30_HSCALELOW: 178435deba32SFrank Schaefer case EM28XX_R32_VSCALELOW: 178535deba32SFrank Schaefer return 2; 178635deba32SFrank Schaefer default: 178735deba32SFrank Schaefer return 1; 178835deba32SFrank Schaefer } 178935deba32SFrank Schaefer } 17900c0d06caSMauro Carvalho Chehab 17910c0d06caSMauro Carvalho Chehab static int vidioc_g_register(struct file *file, void *priv, 17920c0d06caSMauro Carvalho Chehab struct v4l2_dbg_register *reg) 17930c0d06caSMauro Carvalho Chehab { 1794917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 17950c0d06caSMauro Carvalho Chehab int ret; 17960c0d06caSMauro Carvalho Chehab 17973b2d17b4SHans Verkuil if (reg->match.addr > 1) 17983b2d17b4SHans Verkuil return -EINVAL; 1799abca2056SHans Verkuil if (reg->match.addr) { 18000c0d06caSMauro Carvalho Chehab ret = em28xx_read_ac97(dev, reg->reg); 18010c0d06caSMauro Carvalho Chehab if (ret < 0) 18020c0d06caSMauro Carvalho Chehab return ret; 18030c0d06caSMauro Carvalho Chehab 18040c0d06caSMauro Carvalho Chehab reg->val = ret; 18050c0d06caSMauro Carvalho Chehab reg->size = 1; 18060c0d06caSMauro Carvalho Chehab return 0; 18070c0d06caSMauro Carvalho Chehab } 18080c0d06caSMauro Carvalho Chehab 18090c0d06caSMauro Carvalho Chehab /* Match host */ 18100c0d06caSMauro Carvalho Chehab reg->size = em28xx_reg_len(reg->reg); 18110c0d06caSMauro Carvalho Chehab if (reg->size == 1) { 18120c0d06caSMauro Carvalho Chehab ret = em28xx_read_reg(dev, reg->reg); 18130c0d06caSMauro Carvalho Chehab 18140c0d06caSMauro Carvalho Chehab if (ret < 0) 18150c0d06caSMauro Carvalho Chehab return ret; 18160c0d06caSMauro Carvalho Chehab 18170c0d06caSMauro Carvalho Chehab reg->val = ret; 18180c0d06caSMauro Carvalho Chehab } else { 18190c0d06caSMauro Carvalho Chehab __le16 val = 0; 1820fdf1bc9fSMauro Carvalho Chehab 182101c28193SMauro Carvalho Chehab ret = dev->em28xx_read_reg_req_len(dev, USB_REQ_GET_STATUS, 18220c0d06caSMauro Carvalho Chehab reg->reg, (char *)&val, 2); 18230c0d06caSMauro Carvalho Chehab if (ret < 0) 18240c0d06caSMauro Carvalho Chehab return ret; 18250c0d06caSMauro Carvalho Chehab 18260c0d06caSMauro Carvalho Chehab reg->val = le16_to_cpu(val); 18270c0d06caSMauro Carvalho Chehab } 18280c0d06caSMauro Carvalho Chehab 18290c0d06caSMauro Carvalho Chehab return 0; 18300c0d06caSMauro Carvalho Chehab } 18310c0d06caSMauro Carvalho Chehab 18320c0d06caSMauro Carvalho Chehab static int vidioc_s_register(struct file *file, void *priv, 1833977ba3b1SHans Verkuil const struct v4l2_dbg_register *reg) 18340c0d06caSMauro Carvalho Chehab { 1835917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 18360c0d06caSMauro Carvalho Chehab __le16 buf; 18370c0d06caSMauro Carvalho Chehab 18383b2d17b4SHans Verkuil if (reg->match.addr > 1) 18393b2d17b4SHans Verkuil return -EINVAL; 1840abca2056SHans Verkuil if (reg->match.addr) 18410c0d06caSMauro Carvalho Chehab return em28xx_write_ac97(dev, reg->reg, reg->val); 18420c0d06caSMauro Carvalho Chehab 18430c0d06caSMauro Carvalho Chehab /* Match host */ 18440c0d06caSMauro Carvalho Chehab buf = cpu_to_le16(reg->val); 18450c0d06caSMauro Carvalho Chehab 18460c0d06caSMauro Carvalho Chehab return em28xx_write_regs(dev, reg->reg, (char *)&buf, 18470c0d06caSMauro Carvalho Chehab em28xx_reg_len(reg->reg)); 18480c0d06caSMauro Carvalho Chehab } 18490c0d06caSMauro Carvalho Chehab #endif 18500c0d06caSMauro Carvalho Chehab 18510c0d06caSMauro Carvalho Chehab static int vidioc_querycap(struct file *file, void *priv, 18520c0d06caSMauro Carvalho Chehab struct v4l2_capability *cap) 18530c0d06caSMauro Carvalho Chehab { 1854a9d79fe5SHans Verkuil struct video_device *vdev = video_devdata(file); 1855917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1856ef74a0b9SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 18570c0d06caSMauro Carvalho Chehab 18580c0d06caSMauro Carvalho Chehab strlcpy(cap->driver, "em28xx", sizeof(cap->driver)); 18590c0d06caSMauro Carvalho Chehab strlcpy(cap->card, em28xx_boards[dev->model].name, sizeof(cap->card)); 18600c0d06caSMauro Carvalho Chehab usb_make_path(dev->udev, cap->bus_info, sizeof(cap->bus_info)); 18610c0d06caSMauro Carvalho Chehab 1862a9d79fe5SHans Verkuil if (vdev->vfl_type == VFL_TYPE_GRABBER) 1863a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | 1864a9d79fe5SHans Verkuil V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1865a9d79fe5SHans Verkuil else if (vdev->vfl_type == VFL_TYPE_RADIO) 1866a9d79fe5SHans Verkuil cap->device_caps = V4L2_CAP_RADIO; 1867a9d79fe5SHans Verkuil else 18681d179eeeSHans Verkuil cap->device_caps = V4L2_CAP_READWRITE | V4L2_CAP_VBI_CAPTURE; 18690c0d06caSMauro Carvalho Chehab 1870920f1e4aSFrank Schaefer if (dev->int_audio_type != EM28XX_INT_AUDIO_NONE) 1871a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_AUDIO; 18720c0d06caSMauro Carvalho Chehab 18730c0d06caSMauro Carvalho Chehab if (dev->tuner_type != TUNER_ABSENT) 1874a9d79fe5SHans Verkuil cap->device_caps |= V4L2_CAP_TUNER; 18750c0d06caSMauro Carvalho Chehab 1876a9d79fe5SHans Verkuil cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS | 1877a9d79fe5SHans Verkuil V4L2_CAP_READWRITE | V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; 1878d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 18791d179eeeSHans Verkuil cap->capabilities |= V4L2_CAP_VBI_CAPTURE; 1880d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) 1881a9d79fe5SHans Verkuil cap->capabilities |= V4L2_CAP_RADIO; 18820c0d06caSMauro Carvalho Chehab return 0; 18830c0d06caSMauro Carvalho Chehab } 18840c0d06caSMauro Carvalho Chehab 18850c0d06caSMauro Carvalho Chehab static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv, 18860c0d06caSMauro Carvalho Chehab struct v4l2_fmtdesc *f) 18870c0d06caSMauro Carvalho Chehab { 18880c0d06caSMauro Carvalho Chehab if (unlikely(f->index >= ARRAY_SIZE(format))) 18890c0d06caSMauro Carvalho Chehab return -EINVAL; 18900c0d06caSMauro Carvalho Chehab 18910c0d06caSMauro Carvalho Chehab strlcpy(f->description, format[f->index].name, sizeof(f->description)); 18920c0d06caSMauro Carvalho Chehab f->pixelformat = format[f->index].fourcc; 18930c0d06caSMauro Carvalho Chehab 18940c0d06caSMauro Carvalho Chehab return 0; 18950c0d06caSMauro Carvalho Chehab } 18960c0d06caSMauro Carvalho Chehab 18970c0d06caSMauro Carvalho Chehab static int vidioc_enum_framesizes(struct file *file, void *priv, 18980c0d06caSMauro Carvalho Chehab struct v4l2_frmsizeenum *fsize) 18990c0d06caSMauro Carvalho Chehab { 1900917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19010c0d06caSMauro Carvalho Chehab struct em28xx_fmt *fmt; 19020c0d06caSMauro Carvalho Chehab unsigned int maxw = norm_maxw(dev); 19030c0d06caSMauro Carvalho Chehab unsigned int maxh = norm_maxh(dev); 19040c0d06caSMauro Carvalho Chehab 19050c0d06caSMauro Carvalho Chehab fmt = format_by_fourcc(fsize->pixel_format); 19060c0d06caSMauro Carvalho Chehab if (!fmt) { 19070c0d06caSMauro Carvalho Chehab em28xx_videodbg("Fourcc format (%08x) invalid.\n", 19080c0d06caSMauro Carvalho Chehab fsize->pixel_format); 19090c0d06caSMauro Carvalho Chehab return -EINVAL; 19100c0d06caSMauro Carvalho Chehab } 19110c0d06caSMauro Carvalho Chehab 19120c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) { 19130c0d06caSMauro Carvalho Chehab if (fsize->index > 1) 19140c0d06caSMauro Carvalho Chehab return -EINVAL; 19150c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE; 19160c0d06caSMauro Carvalho Chehab fsize->discrete.width = maxw / (1 + fsize->index); 19170c0d06caSMauro Carvalho Chehab fsize->discrete.height = maxh / (1 + fsize->index); 19180c0d06caSMauro Carvalho Chehab return 0; 19190c0d06caSMauro Carvalho Chehab } 19200c0d06caSMauro Carvalho Chehab 19210c0d06caSMauro Carvalho Chehab if (fsize->index != 0) 19220c0d06caSMauro Carvalho Chehab return -EINVAL; 19230c0d06caSMauro Carvalho Chehab 19240c0d06caSMauro Carvalho Chehab /* Report a continuous range */ 19250c0d06caSMauro Carvalho Chehab fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE; 19266c3598e6SFrank Schaefer scale_to_size(dev, EM28XX_HVSCALE_MAX, EM28XX_HVSCALE_MAX, 19276c3598e6SFrank Schaefer &fsize->stepwise.min_width, &fsize->stepwise.min_height); 19286c3598e6SFrank Schaefer if (fsize->stepwise.min_width < 48) 19290c0d06caSMauro Carvalho Chehab fsize->stepwise.min_width = 48; 19306c3598e6SFrank Schaefer if (fsize->stepwise.min_height < 38) 19316c3598e6SFrank Schaefer fsize->stepwise.min_height = 38; 19320c0d06caSMauro Carvalho Chehab fsize->stepwise.max_width = maxw; 19330c0d06caSMauro Carvalho Chehab fsize->stepwise.max_height = maxh; 19340c0d06caSMauro Carvalho Chehab fsize->stepwise.step_width = 1; 19350c0d06caSMauro Carvalho Chehab fsize->stepwise.step_height = 1; 19360c0d06caSMauro Carvalho Chehab return 0; 19370c0d06caSMauro Carvalho Chehab } 19380c0d06caSMauro Carvalho Chehab 19390c0d06caSMauro Carvalho Chehab /* RAW VBI ioctls */ 19400c0d06caSMauro Carvalho Chehab 19410c0d06caSMauro Carvalho Chehab static int vidioc_g_fmt_vbi_cap(struct file *file, void *priv, 19420c0d06caSMauro Carvalho Chehab struct v4l2_format *format) 19430c0d06caSMauro Carvalho Chehab { 1944917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 1945753aee77SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 19460c0d06caSMauro Carvalho Chehab 1947753aee77SFrank Schaefer format->fmt.vbi.samples_per_line = v4l2->vbi_width; 19480c0d06caSMauro Carvalho Chehab format->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY; 19490c0d06caSMauro Carvalho Chehab format->fmt.vbi.offset = 0; 19500c0d06caSMauro Carvalho Chehab format->fmt.vbi.flags = 0; 19510c0d06caSMauro Carvalho Chehab format->fmt.vbi.sampling_rate = 6750000 * 4 / 2; 1952753aee77SFrank Schaefer format->fmt.vbi.count[0] = v4l2->vbi_height; 1953753aee77SFrank Schaefer format->fmt.vbi.count[1] = v4l2->vbi_height; 19542a221d34SHans Verkuil memset(format->fmt.vbi.reserved, 0, sizeof(format->fmt.vbi.reserved)); 19550c0d06caSMauro Carvalho Chehab 19560c0d06caSMauro Carvalho Chehab /* Varies by video standard (NTSC, PAL, etc.) */ 195752faaf78SFrank Schaefer if (v4l2->norm & V4L2_STD_525_60) { 19580c0d06caSMauro Carvalho Chehab /* NTSC */ 19590c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 10; 19600c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 273; 196152faaf78SFrank Schaefer } else if (v4l2->norm & V4L2_STD_625_50) { 19620c0d06caSMauro Carvalho Chehab /* PAL */ 19630c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[0] = 6; 19640c0d06caSMauro Carvalho Chehab format->fmt.vbi.start[1] = 318; 19650c0d06caSMauro Carvalho Chehab } 19660c0d06caSMauro Carvalho Chehab 19670c0d06caSMauro Carvalho Chehab return 0; 19680c0d06caSMauro Carvalho Chehab } 19690c0d06caSMauro Carvalho Chehab 19700c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 19710c0d06caSMauro Carvalho Chehab /* RADIO ESPECIFIC IOCTLS */ 19720c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */ 19730c0d06caSMauro Carvalho Chehab 19740c0d06caSMauro Carvalho Chehab static int radio_g_tuner(struct file *file, void *priv, 19750c0d06caSMauro Carvalho Chehab struct v4l2_tuner *t) 19760c0d06caSMauro Carvalho Chehab { 1977917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19780c0d06caSMauro Carvalho Chehab 19790c0d06caSMauro Carvalho Chehab if (unlikely(t->index > 0)) 19800c0d06caSMauro Carvalho Chehab return -EINVAL; 19810c0d06caSMauro Carvalho Chehab 19820c0d06caSMauro Carvalho Chehab strcpy(t->name, "Radio"); 19830c0d06caSMauro Carvalho Chehab 198495d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, g_tuner, t); 19850c0d06caSMauro Carvalho Chehab 19860c0d06caSMauro Carvalho Chehab return 0; 19870c0d06caSMauro Carvalho Chehab } 19880c0d06caSMauro Carvalho Chehab 19890c0d06caSMauro Carvalho Chehab static int radio_s_tuner(struct file *file, void *priv, 19902f73c7c5SHans Verkuil const struct v4l2_tuner *t) 19910c0d06caSMauro Carvalho Chehab { 1992917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(file); 19930c0d06caSMauro Carvalho Chehab 19940c0d06caSMauro Carvalho Chehab if (0 != t->index) 19950c0d06caSMauro Carvalho Chehab return -EINVAL; 19960c0d06caSMauro Carvalho Chehab 199795d2608bSFrank Schaefer v4l2_device_call_all(&dev->v4l2->v4l2_dev, 0, tuner, s_tuner, t); 19980c0d06caSMauro Carvalho Chehab 19990c0d06caSMauro Carvalho Chehab return 0; 20000c0d06caSMauro Carvalho Chehab } 20010c0d06caSMauro Carvalho Chehab 20020c0d06caSMauro Carvalho Chehab /* 200395d2608bSFrank Schaefer * em28xx_free_v4l2() - Free struct em28xx_v4l2 200495d2608bSFrank Schaefer * 200595d2608bSFrank Schaefer * @ref: struct kref for struct em28xx_v4l2 200695d2608bSFrank Schaefer * 200795d2608bSFrank Schaefer * Called when all users of struct em28xx_v4l2 are gone 200895d2608bSFrank Schaefer */ 2009f472c0b5SMauro Carvalho Chehab static void em28xx_free_v4l2(struct kref *ref) 201095d2608bSFrank Schaefer { 201195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = container_of(ref, struct em28xx_v4l2, ref); 201295d2608bSFrank Schaefer 2013abc1308fSFrank Schaefer v4l2->dev->v4l2 = NULL; 201495d2608bSFrank Schaefer kfree(v4l2); 201595d2608bSFrank Schaefer } 201695d2608bSFrank Schaefer 201795d2608bSFrank Schaefer /* 20180c0d06caSMauro Carvalho Chehab * em28xx_v4l2_open() 20190c0d06caSMauro Carvalho Chehab * inits the device and starts isoc transfer 20200c0d06caSMauro Carvalho Chehab */ 20210c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_open(struct file *filp) 20220c0d06caSMauro Carvalho Chehab { 20230c0d06caSMauro Carvalho Chehab struct video_device *vdev = video_devdata(filp); 20240c0d06caSMauro Carvalho Chehab struct em28xx *dev = video_drvdata(filp); 202595d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 20260c0d06caSMauro Carvalho Chehab enum v4l2_buf_type fh_type = 0; 20273c0f90e1SFrank Schaefer int ret; 20280c0d06caSMauro Carvalho Chehab 20290c0d06caSMauro Carvalho Chehab switch (vdev->vfl_type) { 20300c0d06caSMauro Carvalho Chehab case VFL_TYPE_GRABBER: 20310c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; 20320c0d06caSMauro Carvalho Chehab break; 20330c0d06caSMauro Carvalho Chehab case VFL_TYPE_VBI: 20340c0d06caSMauro Carvalho Chehab fh_type = V4L2_BUF_TYPE_VBI_CAPTURE; 20350c0d06caSMauro Carvalho Chehab break; 20364e170240SFrank Schaefer case VFL_TYPE_RADIO: 20374e170240SFrank Schaefer break; 20384e170240SFrank Schaefer default: 20394e170240SFrank Schaefer return -EINVAL; 20400c0d06caSMauro Carvalho Chehab } 20410c0d06caSMauro Carvalho Chehab 20428e2c8717SFrank Schaefer em28xx_videodbg("open dev=%s type=%s users=%d\n", 20438e2c8717SFrank Schaefer video_device_node_name(vdev), v4l2_type_names[fh_type], 20448e2c8717SFrank Schaefer v4l2->users); 20450c0d06caSMauro Carvalho Chehab 20460c0d06caSMauro Carvalho Chehab if (mutex_lock_interruptible(&dev->lock)) 20470c0d06caSMauro Carvalho Chehab return -ERESTARTSYS; 20483c0f90e1SFrank Schaefer 20493c0f90e1SFrank Schaefer ret = v4l2_fh_open(filp); 20503c0f90e1SFrank Schaefer if (ret) { 20513c0f90e1SFrank Schaefer em28xx_errdev("%s: v4l2_fh_open() returned error %d\n", 20523c0f90e1SFrank Schaefer __func__, ret); 20530c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20543c0f90e1SFrank Schaefer return ret; 20550c0d06caSMauro Carvalho Chehab } 20560c0d06caSMauro Carvalho Chehab 20578e2c8717SFrank Schaefer if (v4l2->users == 0) { 20580c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_ANALOG_MODE); 20594e170240SFrank Schaefer 20604e170240SFrank Schaefer if (vdev->vfl_type != VFL_TYPE_RADIO) 20610c0d06caSMauro Carvalho Chehab em28xx_resolution_set(dev); 20620c0d06caSMauro Carvalho Chehab 20634e170240SFrank Schaefer /* 20644e170240SFrank Schaefer * Needed, since GPIO might have disabled power 20654e170240SFrank Schaefer * of some i2c devices 20660c0d06caSMauro Carvalho Chehab */ 20670c0d06caSMauro Carvalho Chehab em28xx_wake_i2c(dev); 20680c0d06caSMauro Carvalho Chehab } 2069d3829fadSDevin Heitmueller 2070d3829fadSDevin Heitmueller if (vdev->vfl_type == VFL_TYPE_RADIO) { 20710c0d06caSMauro Carvalho Chehab em28xx_videodbg("video_open: setting radio device\n"); 207295d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, tuner, s_radio); 20730c0d06caSMauro Carvalho Chehab } 20740c0d06caSMauro Carvalho Chehab 207547677e51SMauro Carvalho Chehab kref_get(&dev->ref); 207695d2608bSFrank Schaefer kref_get(&v4l2->ref); 20778e2c8717SFrank Schaefer v4l2->users++; 20780c0d06caSMauro Carvalho Chehab 20790c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 20800c0d06caSMauro Carvalho Chehab 2081d3829fadSDevin Heitmueller return 0; 20820c0d06caSMauro Carvalho Chehab } 20830c0d06caSMauro Carvalho Chehab 20840c0d06caSMauro Carvalho Chehab /* 208501c28193SMauro Carvalho Chehab * em28xx_v4l2_fini() 20860c0d06caSMauro Carvalho Chehab * unregisters the v4l2,i2c and usb devices 20870c0d06caSMauro Carvalho Chehab * called when the device gets disconected or at module unload 20880c0d06caSMauro Carvalho Chehab */ 208901c28193SMauro Carvalho Chehab static int em28xx_v4l2_fini(struct em28xx *dev) 20900c0d06caSMauro Carvalho Chehab { 209195d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 209295d2608bSFrank Schaefer 2093822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2094822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2095822b8deaSMauro Carvalho Chehab return 0; 2096822b8deaSMauro Carvalho Chehab } 2097822b8deaSMauro Carvalho Chehab 209801c28193SMauro Carvalho Chehab if (!dev->has_video) { 209901c28193SMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 210001c28193SMauro Carvalho Chehab return 0; 210101c28193SMauro Carvalho Chehab } 21020c0d06caSMauro Carvalho Chehab 210395d2608bSFrank Schaefer if (v4l2 == NULL) 210495d2608bSFrank Schaefer return 0; 210595d2608bSFrank Schaefer 21060418ca60SRussell King em28xx_info("Closing video extension\n"); 2107aa929ad7SMauro Carvalho Chehab 2108ebbfbc20SMauro Carvalho Chehab mutex_lock(&dev->lock); 2109ebbfbc20SMauro Carvalho Chehab 211095d2608bSFrank Schaefer v4l2_device_disconnect(&v4l2->v4l2_dev); 21115ad10de6SFrank Schaefer 211223e8642cSFrank Schaefer em28xx_uninit_usb_xfer(dev, EM28XX_ANALOG_MODE); 211323e8642cSFrank Schaefer 211437ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 211537ecc7b1SMauro Carvalho Chehab 2116d4352f36SHans Verkuil if (video_is_registered(&v4l2->radio_dev)) { 2117e847022aSFrank Schaefer em28xx_info("V4L2 device %s deregistered\n", 2118d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 2119d4352f36SHans Verkuil video_unregister_device(&v4l2->radio_dev); 21200c0d06caSMauro Carvalho Chehab } 2121d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) { 21220c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 2123d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 2124d4352f36SHans Verkuil video_unregister_device(&v4l2->vbi_dev); 21250c0d06caSMauro Carvalho Chehab } 2126d4352f36SHans Verkuil if (video_is_registered(&v4l2->vdev)) { 21270c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 2128d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 2129d4352f36SHans Verkuil video_unregister_device(&v4l2->vdev); 21300c0d06caSMauro Carvalho Chehab } 213101c28193SMauro Carvalho Chehab 2132abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 213395d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2134103f18a2SFrank Schaefer 21352c52a2fcSFrank Schaefer if (v4l2->clk) { 21362c52a2fcSFrank Schaefer v4l2_clk_unregister_fixed(v4l2->clk); 21372c52a2fcSFrank Schaefer v4l2->clk = NULL; 213825dd1652SFrank Schaefer } 213925dd1652SFrank Schaefer 214095d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 214195d2608bSFrank Schaefer 2142ebbfbc20SMauro Carvalho Chehab mutex_unlock(&dev->lock); 214395d2608bSFrank Schaefer 214447677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 21455ad10de6SFrank Schaefer 214601c28193SMauro Carvalho Chehab return 0; 21470c0d06caSMauro Carvalho Chehab } 21480c0d06caSMauro Carvalho Chehab 2149a61f6811SShuah Khan static int em28xx_v4l2_suspend(struct em28xx *dev) 2150a61f6811SShuah Khan { 2151a61f6811SShuah Khan if (dev->is_audio_only) 2152a61f6811SShuah Khan return 0; 2153a61f6811SShuah Khan 2154a61f6811SShuah Khan if (!dev->has_video) 2155a61f6811SShuah Khan return 0; 2156a61f6811SShuah Khan 215732e63f03SRussell King em28xx_info("Suspending video extension\n"); 2158a61f6811SShuah Khan em28xx_stop_urbs(dev); 2159a61f6811SShuah Khan return 0; 2160a61f6811SShuah Khan } 2161a61f6811SShuah Khan 2162a61f6811SShuah Khan static int em28xx_v4l2_resume(struct em28xx *dev) 2163a61f6811SShuah Khan { 2164a61f6811SShuah Khan if (dev->is_audio_only) 2165a61f6811SShuah Khan return 0; 2166a61f6811SShuah Khan 2167a61f6811SShuah Khan if (!dev->has_video) 2168a61f6811SShuah Khan return 0; 2169a61f6811SShuah Khan 217032e63f03SRussell King em28xx_info("Resuming video extension\n"); 2171a61f6811SShuah Khan /* what do we do here */ 2172a61f6811SShuah Khan return 0; 2173a61f6811SShuah Khan } 2174a61f6811SShuah Khan 21750c0d06caSMauro Carvalho Chehab /* 21760c0d06caSMauro Carvalho Chehab * em28xx_v4l2_close() 21770c0d06caSMauro Carvalho Chehab * stops streaming and deallocates all resources allocated by the v4l2 21780c0d06caSMauro Carvalho Chehab * calls and ioctls 21790c0d06caSMauro Carvalho Chehab */ 21800c0d06caSMauro Carvalho Chehab static int em28xx_v4l2_close(struct file *filp) 21810c0d06caSMauro Carvalho Chehab { 2182917ba6b0SFrank Schaefer struct em28xx *dev = video_drvdata(filp); 218395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 21840c0d06caSMauro Carvalho Chehab int errCode; 21850c0d06caSMauro Carvalho Chehab 21868e2c8717SFrank Schaefer em28xx_videodbg("users=%d\n", v4l2->users); 21878e2c8717SFrank Schaefer 21888e2c8717SFrank Schaefer vb2_fop_release(filp); 218998c24dcdSRicardo Ribalda mutex_lock(&dev->lock); 21900c0d06caSMauro Carvalho Chehab 21918e2c8717SFrank Schaefer if (v4l2->users == 1) { 219247677e51SMauro Carvalho Chehab /* No sense to try to write to the device */ 219347677e51SMauro Carvalho Chehab if (dev->disconnected) 219401c28193SMauro Carvalho Chehab goto exit; 21950c0d06caSMauro Carvalho Chehab 21960c0d06caSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 219795d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 21980c0d06caSMauro Carvalho Chehab 21990c0d06caSMauro Carvalho Chehab /* do this before setting alternate! */ 22000c0d06caSMauro Carvalho Chehab em28xx_set_mode(dev, EM28XX_SUSPEND); 22010c0d06caSMauro Carvalho Chehab 22020c0d06caSMauro Carvalho Chehab /* set alternate 0 */ 22030c0d06caSMauro Carvalho Chehab dev->alt = 0; 22040c0d06caSMauro Carvalho Chehab em28xx_videodbg("setting alternate 0\n"); 22050c0d06caSMauro Carvalho Chehab errCode = usb_set_interface(dev->udev, 0, 0); 22060c0d06caSMauro Carvalho Chehab if (errCode < 0) { 22070c0d06caSMauro Carvalho Chehab em28xx_errdev("cannot change alternate number to " 22080c0d06caSMauro Carvalho Chehab "0 (error=%i)\n", errCode); 22090c0d06caSMauro Carvalho Chehab } 22100c0d06caSMauro Carvalho Chehab } 22110c0d06caSMauro Carvalho Chehab 221201c28193SMauro Carvalho Chehab exit: 22138e2c8717SFrank Schaefer v4l2->users--; 221495d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 22150c0d06caSMauro Carvalho Chehab mutex_unlock(&dev->lock); 221647677e51SMauro Carvalho Chehab kref_put(&dev->ref, em28xx_free_device); 221747677e51SMauro Carvalho Chehab 22180c0d06caSMauro Carvalho Chehab return 0; 22190c0d06caSMauro Carvalho Chehab } 22200c0d06caSMauro Carvalho Chehab 22210c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations em28xx_v4l_fops = { 22220c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22230c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22240c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 2225d3829fadSDevin Heitmueller .read = vb2_fop_read, 2226d3829fadSDevin Heitmueller .poll = vb2_fop_poll, 2227d3829fadSDevin Heitmueller .mmap = vb2_fop_mmap, 22280c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22290c0d06caSMauro Carvalho Chehab }; 22300c0d06caSMauro Carvalho Chehab 22310c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops video_ioctl_ops = { 22320c0d06caSMauro Carvalho Chehab .vidioc_querycap = vidioc_querycap, 22330c0d06caSMauro Carvalho Chehab .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap, 22340c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap, 22350c0d06caSMauro Carvalho Chehab .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap, 22360c0d06caSMauro Carvalho Chehab .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap, 22370c0d06caSMauro Carvalho Chehab .vidioc_g_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22382a221d34SHans Verkuil .vidioc_try_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 2239aab34618SFrank Schaefer .vidioc_s_fmt_vbi_cap = vidioc_g_fmt_vbi_cap, 22400c0d06caSMauro Carvalho Chehab .vidioc_enum_framesizes = vidioc_enum_framesizes, 22410c0d06caSMauro Carvalho Chehab .vidioc_g_audio = vidioc_g_audio, 22420c0d06caSMauro Carvalho Chehab .vidioc_s_audio = vidioc_s_audio, 22430c0d06caSMauro Carvalho Chehab 2244d3829fadSDevin Heitmueller .vidioc_reqbufs = vb2_ioctl_reqbufs, 2245d3829fadSDevin Heitmueller .vidioc_create_bufs = vb2_ioctl_create_bufs, 2246d3829fadSDevin Heitmueller .vidioc_prepare_buf = vb2_ioctl_prepare_buf, 2247d3829fadSDevin Heitmueller .vidioc_querybuf = vb2_ioctl_querybuf, 2248d3829fadSDevin Heitmueller .vidioc_qbuf = vb2_ioctl_qbuf, 2249d3829fadSDevin Heitmueller .vidioc_dqbuf = vb2_ioctl_dqbuf, 2250d3829fadSDevin Heitmueller 22510c0d06caSMauro Carvalho Chehab .vidioc_g_std = vidioc_g_std, 22520c0d06caSMauro Carvalho Chehab .vidioc_querystd = vidioc_querystd, 22530c0d06caSMauro Carvalho Chehab .vidioc_s_std = vidioc_s_std, 22540c0d06caSMauro Carvalho Chehab .vidioc_g_parm = vidioc_g_parm, 22550c0d06caSMauro Carvalho Chehab .vidioc_s_parm = vidioc_s_parm, 22560c0d06caSMauro Carvalho Chehab .vidioc_enum_input = vidioc_enum_input, 22570c0d06caSMauro Carvalho Chehab .vidioc_g_input = vidioc_g_input, 22580c0d06caSMauro Carvalho Chehab .vidioc_s_input = vidioc_s_input, 2259d3829fadSDevin Heitmueller .vidioc_streamon = vb2_ioctl_streamon, 2260d3829fadSDevin Heitmueller .vidioc_streamoff = vb2_ioctl_streamoff, 22610c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = vidioc_g_tuner, 22620c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = vidioc_s_tuner, 22630c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22640c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 226550fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 226650fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 22670c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 226896b03d2aSHans Verkuil .vidioc_g_chip_info = vidioc_g_chip_info, 22690c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 22700c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 22710c0d06caSMauro Carvalho Chehab #endif 22720c0d06caSMauro Carvalho Chehab }; 22730c0d06caSMauro Carvalho Chehab 22740c0d06caSMauro Carvalho Chehab static const struct video_device em28xx_video_template = { 22750c0d06caSMauro Carvalho Chehab .fops = &em28xx_v4l_fops, 22760c0d06caSMauro Carvalho Chehab .ioctl_ops = &video_ioctl_ops, 2277d4352f36SHans Verkuil .release = video_device_release_empty, 22780c0d06caSMauro Carvalho Chehab .tvnorms = V4L2_STD_ALL, 22790c0d06caSMauro Carvalho Chehab }; 22800c0d06caSMauro Carvalho Chehab 22810c0d06caSMauro Carvalho Chehab static const struct v4l2_file_operations radio_fops = { 22820c0d06caSMauro Carvalho Chehab .owner = THIS_MODULE, 22830c0d06caSMauro Carvalho Chehab .open = em28xx_v4l2_open, 22840c0d06caSMauro Carvalho Chehab .release = em28xx_v4l2_close, 22850c0d06caSMauro Carvalho Chehab .unlocked_ioctl = video_ioctl2, 22860c0d06caSMauro Carvalho Chehab }; 22870c0d06caSMauro Carvalho Chehab 22880c0d06caSMauro Carvalho Chehab static const struct v4l2_ioctl_ops radio_ioctl_ops = { 2289a9d79fe5SHans Verkuil .vidioc_querycap = vidioc_querycap, 22900c0d06caSMauro Carvalho Chehab .vidioc_g_tuner = radio_g_tuner, 22910c0d06caSMauro Carvalho Chehab .vidioc_s_tuner = radio_s_tuner, 22920c0d06caSMauro Carvalho Chehab .vidioc_g_frequency = vidioc_g_frequency, 22930c0d06caSMauro Carvalho Chehab .vidioc_s_frequency = vidioc_s_frequency, 229450fdf40fSHans Verkuil .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 229550fdf40fSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 22960c0d06caSMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG 2297430c73faSMichal Marek .vidioc_g_chip_info = vidioc_g_chip_info, 22980c0d06caSMauro Carvalho Chehab .vidioc_g_register = vidioc_g_register, 22990c0d06caSMauro Carvalho Chehab .vidioc_s_register = vidioc_s_register, 23000c0d06caSMauro Carvalho Chehab #endif 23010c0d06caSMauro Carvalho Chehab }; 23020c0d06caSMauro Carvalho Chehab 23030c0d06caSMauro Carvalho Chehab static struct video_device em28xx_radio_template = { 23040c0d06caSMauro Carvalho Chehab .fops = &radio_fops, 23050c0d06caSMauro Carvalho Chehab .ioctl_ops = &radio_ioctl_ops, 2306d4352f36SHans Verkuil .release = video_device_release_empty, 23070c0d06caSMauro Carvalho Chehab }; 23080c0d06caSMauro Carvalho Chehab 2309b64f8e9aSMauro Carvalho Chehab /* I2C possible address to saa7115, tvp5150, msp3400, tvaudio */ 2310b64f8e9aSMauro Carvalho Chehab static unsigned short saa711x_addrs[] = { 2311b64f8e9aSMauro Carvalho Chehab 0x4a >> 1, 0x48 >> 1, /* SAA7111, SAA7111A and SAA7113 */ 2312b64f8e9aSMauro Carvalho Chehab 0x42 >> 1, 0x40 >> 1, /* SAA7114, SAA7115 and SAA7118 */ 2313b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END }; 2314b64f8e9aSMauro Carvalho Chehab 2315b64f8e9aSMauro Carvalho Chehab static unsigned short tvp5150_addrs[] = { 2316b64f8e9aSMauro Carvalho Chehab 0xb8 >> 1, 2317b64f8e9aSMauro Carvalho Chehab 0xba >> 1, 2318b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2319b64f8e9aSMauro Carvalho Chehab }; 2320b64f8e9aSMauro Carvalho Chehab 2321b64f8e9aSMauro Carvalho Chehab static unsigned short msp3400_addrs[] = { 2322b64f8e9aSMauro Carvalho Chehab 0x80 >> 1, 2323b64f8e9aSMauro Carvalho Chehab 0x88 >> 1, 2324b64f8e9aSMauro Carvalho Chehab I2C_CLIENT_END 2325b64f8e9aSMauro Carvalho Chehab }; 2326b64f8e9aSMauro Carvalho Chehab 23270c0d06caSMauro Carvalho Chehab /******************************** usb interface ******************************/ 23280c0d06caSMauro Carvalho Chehab 2329d4352f36SHans Verkuil static void em28xx_vdev_init(struct em28xx *dev, 2330d4352f36SHans Verkuil struct video_device *vfd, 23310c0d06caSMauro Carvalho Chehab const struct video_device *template, 23320c0d06caSMauro Carvalho Chehab const char *type_name) 23330c0d06caSMauro Carvalho Chehab { 23340c0d06caSMauro Carvalho Chehab *vfd = *template; 233595d2608bSFrank Schaefer vfd->v4l2_dev = &dev->v4l2->v4l2_dev; 23360c0d06caSMauro Carvalho Chehab vfd->lock = &dev->lock; 2337d8c95c08SHans Verkuil if (dev->board.is_webcam) 2338d8c95c08SHans Verkuil vfd->tvnorms = 0; 23390c0d06caSMauro Carvalho Chehab 23400c0d06caSMauro Carvalho Chehab snprintf(vfd->name, sizeof(vfd->name), "%s %s", 23410c0d06caSMauro Carvalho Chehab dev->name, type_name); 23420c0d06caSMauro Carvalho Chehab 23430c0d06caSMauro Carvalho Chehab video_set_drvdata(vfd, dev); 23440c0d06caSMauro Carvalho Chehab } 23450c0d06caSMauro Carvalho Chehab 23463319e6f8SFrank Schaefer static void em28xx_tuner_setup(struct em28xx *dev, unsigned short tuner_addr) 23470560f337SMauro Carvalho Chehab { 23483854b0d8SFrank Schaefer struct em28xx_v4l2 *v4l2 = dev->v4l2; 23493854b0d8SFrank Schaefer struct v4l2_device *v4l2_dev = &v4l2->v4l2_dev; 23500560f337SMauro Carvalho Chehab struct tuner_setup tun_setup; 23510560f337SMauro Carvalho Chehab struct v4l2_frequency f; 23520560f337SMauro Carvalho Chehab 23530560f337SMauro Carvalho Chehab memset(&tun_setup, 0, sizeof(tun_setup)); 23540560f337SMauro Carvalho Chehab 23550560f337SMauro Carvalho Chehab tun_setup.mode_mask = T_ANALOG_TV | T_RADIO; 23560560f337SMauro Carvalho Chehab tun_setup.tuner_callback = em28xx_tuner_callback; 23570560f337SMauro Carvalho Chehab 23580560f337SMauro Carvalho Chehab if (dev->board.radio.type) { 23590560f337SMauro Carvalho Chehab tun_setup.type = dev->board.radio.type; 23600560f337SMauro Carvalho Chehab tun_setup.addr = dev->board.radio_addr; 23610560f337SMauro Carvalho Chehab 236295d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 236395d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 23640560f337SMauro Carvalho Chehab } 23650560f337SMauro Carvalho Chehab 23660560f337SMauro Carvalho Chehab if ((dev->tuner_type != TUNER_ABSENT) && (dev->tuner_type)) { 23670560f337SMauro Carvalho Chehab tun_setup.type = dev->tuner_type; 23683319e6f8SFrank Schaefer tun_setup.addr = tuner_addr; 23690560f337SMauro Carvalho Chehab 237095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 237195d2608bSFrank Schaefer 0, tuner, s_type_addr, &tun_setup); 23720560f337SMauro Carvalho Chehab } 23730560f337SMauro Carvalho Chehab 23746867bd5aSFrank Schaefer if (dev->board.tda9887_conf) { 23750560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config tda9887_cfg; 23760560f337SMauro Carvalho Chehab 23770560f337SMauro Carvalho Chehab tda9887_cfg.tuner = TUNER_TDA9887; 23786867bd5aSFrank Schaefer tda9887_cfg.priv = &dev->board.tda9887_conf; 23790560f337SMauro Carvalho Chehab 238095d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 238195d2608bSFrank Schaefer 0, tuner, s_config, &tda9887_cfg); 23820560f337SMauro Carvalho Chehab } 23830560f337SMauro Carvalho Chehab 23840560f337SMauro Carvalho Chehab if (dev->tuner_type == TUNER_XC2028) { 23850560f337SMauro Carvalho Chehab struct v4l2_priv_tun_config xc2028_cfg; 23860560f337SMauro Carvalho Chehab struct xc2028_ctrl ctl; 23870560f337SMauro Carvalho Chehab 23880560f337SMauro Carvalho Chehab memset(&xc2028_cfg, 0, sizeof(xc2028_cfg)); 23890560f337SMauro Carvalho Chehab memset(&ctl, 0, sizeof(ctl)); 23900560f337SMauro Carvalho Chehab 23910560f337SMauro Carvalho Chehab em28xx_setup_xc3028(dev, &ctl); 23920560f337SMauro Carvalho Chehab 23930560f337SMauro Carvalho Chehab xc2028_cfg.tuner = TUNER_XC2028; 23940560f337SMauro Carvalho Chehab xc2028_cfg.priv = &ctl; 23950560f337SMauro Carvalho Chehab 239695d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_config, &xc2028_cfg); 23970560f337SMauro Carvalho Chehab } 23980560f337SMauro Carvalho Chehab 23990560f337SMauro Carvalho Chehab /* configure tuner */ 24000560f337SMauro Carvalho Chehab f.tuner = 0; 24010560f337SMauro Carvalho Chehab f.type = V4L2_TUNER_ANALOG_TV; 24020560f337SMauro Carvalho Chehab f.frequency = 9076; /* just a magic number */ 24033854b0d8SFrank Schaefer v4l2->frequency = f.frequency; 240495d2608bSFrank Schaefer v4l2_device_call_all(v4l2_dev, 0, tuner, s_frequency, &f); 24050560f337SMauro Carvalho Chehab } 24060560f337SMauro Carvalho Chehab 240701c28193SMauro Carvalho Chehab static int em28xx_v4l2_init(struct em28xx *dev) 24080c0d06caSMauro Carvalho Chehab { 24090c0d06caSMauro Carvalho Chehab u8 val; 24100c0d06caSMauro Carvalho Chehab int ret; 24110c0d06caSMauro Carvalho Chehab unsigned int maxw; 2412abc1308fSFrank Schaefer struct v4l2_ctrl_handler *hdl; 241395d2608bSFrank Schaefer struct em28xx_v4l2 *v4l2; 2414b64f8e9aSMauro Carvalho Chehab 2415822b8deaSMauro Carvalho Chehab if (dev->is_audio_only) { 2416822b8deaSMauro Carvalho Chehab /* Shouldn't initialize IR for this interface */ 2417822b8deaSMauro Carvalho Chehab return 0; 2418822b8deaSMauro Carvalho Chehab } 2419822b8deaSMauro Carvalho Chehab 242001c28193SMauro Carvalho Chehab if (!dev->has_video) { 2421b64f8e9aSMauro Carvalho Chehab /* This device does not support the v4l2 extension */ 2422b64f8e9aSMauro Carvalho Chehab return 0; 2423b64f8e9aSMauro Carvalho Chehab } 24240c0d06caSMauro Carvalho Chehab 24259634614fSMauro Carvalho Chehab em28xx_info("Registering V4L2 extension\n"); 24260c0d06caSMauro Carvalho Chehab 242701c28193SMauro Carvalho Chehab mutex_lock(&dev->lock); 242801c28193SMauro Carvalho Chehab 242995d2608bSFrank Schaefer v4l2 = kzalloc(sizeof(struct em28xx_v4l2), GFP_KERNEL); 243095d2608bSFrank Schaefer if (v4l2 == NULL) { 243195d2608bSFrank Schaefer em28xx_info("em28xx_v4l: memory allocation failed\n"); 243295d2608bSFrank Schaefer mutex_unlock(&dev->lock); 243395d2608bSFrank Schaefer return -ENOMEM; 243495d2608bSFrank Schaefer } 243595d2608bSFrank Schaefer kref_init(&v4l2->ref); 2436abc1308fSFrank Schaefer v4l2->dev = dev; 243795d2608bSFrank Schaefer dev->v4l2 = v4l2; 243895d2608bSFrank Schaefer 243937ecc7b1SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER 244037ecc7b1SMauro Carvalho Chehab v4l2->v4l2_dev.mdev = dev->media_dev; 244137ecc7b1SMauro Carvalho Chehab #endif 244295d2608bSFrank Schaefer ret = v4l2_device_register(&dev->udev->dev, &v4l2->v4l2_dev); 2443b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2444b64f8e9aSMauro Carvalho Chehab em28xx_errdev("Call to v4l2_device_register() failed!\n"); 2445b64f8e9aSMauro Carvalho Chehab goto err; 2446b64f8e9aSMauro Carvalho Chehab } 2447b64f8e9aSMauro Carvalho Chehab 2448abc1308fSFrank Schaefer hdl = &v4l2->ctrl_handler; 2449b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_handler_init(hdl, 8); 245095d2608bSFrank Schaefer v4l2->v4l2_dev.ctrl_handler = hdl; 2451b64f8e9aSMauro Carvalho Chehab 245258159171SFrank Schaefer if (dev->board.is_webcam) 24537e6c8c19SMauro Carvalho Chehab v4l2->progressive = true; 245458159171SFrank Schaefer 2455b64f8e9aSMauro Carvalho Chehab /* 2456b64f8e9aSMauro Carvalho Chehab * Default format, used for tvp5150 or saa711x output formats 2457b64f8e9aSMauro Carvalho Chehab */ 24589297285eSFrank Schaefer v4l2->vinmode = 0x10; 24599297285eSFrank Schaefer v4l2->vinctl = EM28XX_VINCTRL_INTERLACED | 2460b64f8e9aSMauro Carvalho Chehab EM28XX_VINCTRL_CCIR656_ENABLE; 2461b64f8e9aSMauro Carvalho Chehab 2462b64f8e9aSMauro Carvalho Chehab /* request some modules */ 2463b64f8e9aSMauro Carvalho Chehab 2464b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) 246595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 246695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2467b64f8e9aSMauro Carvalho Chehab "msp3400", 0, msp3400_addrs); 2468b64f8e9aSMauro Carvalho Chehab 2469b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_SAA711X) 247095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 247195d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2472b64f8e9aSMauro Carvalho Chehab "saa7115_auto", 0, saa711x_addrs); 2473b64f8e9aSMauro Carvalho Chehab 2474b64f8e9aSMauro Carvalho Chehab if (dev->board.decoder == EM28XX_TVP5150) 247595d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 247695d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2477b64f8e9aSMauro Carvalho Chehab "tvp5150", 0, tvp5150_addrs); 2478b64f8e9aSMauro Carvalho Chehab 2479b64f8e9aSMauro Carvalho Chehab if (dev->board.adecoder == EM28XX_TVAUDIO) 248095d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 248195d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2482b64f8e9aSMauro Carvalho Chehab "tvaudio", dev->board.tvaudio_addr, NULL); 2483b64f8e9aSMauro Carvalho Chehab 2484b64f8e9aSMauro Carvalho Chehab /* Initialize tuner and camera */ 2485b64f8e9aSMauro Carvalho Chehab 2486b64f8e9aSMauro Carvalho Chehab if (dev->board.tuner_type != TUNER_ABSENT) { 24873319e6f8SFrank Schaefer unsigned short tuner_addr = dev->board.tuner_addr; 24886867bd5aSFrank Schaefer int has_demod = (dev->board.tda9887_conf & TDA9887_PRESENT); 2489b64f8e9aSMauro Carvalho Chehab 2490b64f8e9aSMauro Carvalho Chehab if (dev->board.radio.type) 249195d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 249295d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 2493fdf1bc9fSMauro Carvalho Chehab "tuner", dev->board.radio_addr, 2494fdf1bc9fSMauro Carvalho Chehab NULL); 2495b64f8e9aSMauro Carvalho Chehab 2496b64f8e9aSMauro Carvalho Chehab if (has_demod) 249795d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2498fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2499fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2500fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(ADDRS_DEMOD)); 25013319e6f8SFrank Schaefer if (tuner_addr == 0) { 2502b64f8e9aSMauro Carvalho Chehab enum v4l2_i2c_tuner_type type = 2503b64f8e9aSMauro Carvalho Chehab has_demod ? ADDRS_TV_WITH_DEMOD : ADDRS_TV; 2504b64f8e9aSMauro Carvalho Chehab struct v4l2_subdev *sd; 2505b64f8e9aSMauro Carvalho Chehab 250695d2608bSFrank Schaefer sd = v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 2507fdf1bc9fSMauro Carvalho Chehab &dev->i2c_adap[dev->def_i2c_bus], 2508fdf1bc9fSMauro Carvalho Chehab "tuner", 0, 2509fdf1bc9fSMauro Carvalho Chehab v4l2_i2c_tuner_addrs(type)); 2510b64f8e9aSMauro Carvalho Chehab 2511b64f8e9aSMauro Carvalho Chehab if (sd) 25123319e6f8SFrank Schaefer tuner_addr = v4l2_i2c_subdev_addr(sd); 2513b64f8e9aSMauro Carvalho Chehab } else { 251495d2608bSFrank Schaefer v4l2_i2c_new_subdev(&v4l2->v4l2_dev, 251595d2608bSFrank Schaefer &dev->i2c_adap[dev->def_i2c_bus], 25163319e6f8SFrank Schaefer "tuner", tuner_addr, NULL); 2517b64f8e9aSMauro Carvalho Chehab } 2518b64f8e9aSMauro Carvalho Chehab 25193319e6f8SFrank Schaefer em28xx_tuner_setup(dev, tuner_addr); 25203319e6f8SFrank Schaefer } 25213319e6f8SFrank Schaefer 2522d86bc65aSFrank Schaefer if (dev->em28xx_sensor != EM28XX_NOSENSOR) 2523b64f8e9aSMauro Carvalho Chehab em28xx_init_camera(dev); 2524b64f8e9aSMauro Carvalho Chehab 2525b64f8e9aSMauro Carvalho Chehab /* Configure audio */ 2526b64f8e9aSMauro Carvalho Chehab ret = em28xx_audio_setup(dev); 2527b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2528b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: Error while setting audio - error [%d]!\n", 2529b64f8e9aSMauro Carvalho Chehab __func__, ret); 2530b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2531b64f8e9aSMauro Carvalho Chehab } 2532b64f8e9aSMauro Carvalho Chehab if (dev->audio_mode.ac97 != EM28XX_NO_AC97) { 2533b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2534b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 2535b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 2536b64f8e9aSMauro Carvalho Chehab V4L2_CID_AUDIO_VOLUME, 0, 0x1f, 1, 0x1f); 2537b64f8e9aSMauro Carvalho Chehab } else { 2538b64f8e9aSMauro Carvalho Chehab /* install the em28xx notify callback */ 2539b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_MUTE), 2540b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2541b64f8e9aSMauro Carvalho Chehab v4l2_ctrl_notify(v4l2_ctrl_find(hdl, V4L2_CID_AUDIO_VOLUME), 2542b64f8e9aSMauro Carvalho Chehab em28xx_ctrl_notify, dev); 2543b64f8e9aSMauro Carvalho Chehab } 2544b64f8e9aSMauro Carvalho Chehab 2545b64f8e9aSMauro Carvalho Chehab /* wake i2c devices */ 2546b64f8e9aSMauro Carvalho Chehab em28xx_wake_i2c(dev); 2547b64f8e9aSMauro Carvalho Chehab 2548b64f8e9aSMauro Carvalho Chehab /* init video dma queues */ 2549b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vidq.active); 2550b64f8e9aSMauro Carvalho Chehab INIT_LIST_HEAD(&dev->vbiq.active); 2551b64f8e9aSMauro Carvalho Chehab 2552b64f8e9aSMauro Carvalho Chehab if (dev->board.has_msp34xx) { 2553b64f8e9aSMauro Carvalho Chehab /* Send a reset to other chips via gpio */ 2554b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xf7); 2555b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2556b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(1) failed! error [%d]\n", 2557b64f8e9aSMauro Carvalho Chehab __func__, ret); 2558b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2559b64f8e9aSMauro Carvalho Chehab } 2560b64f8e9aSMauro Carvalho Chehab msleep(3); 2561b64f8e9aSMauro Carvalho Chehab 2562b64f8e9aSMauro Carvalho Chehab ret = em28xx_write_reg(dev, EM2820_R08_GPIO_CTRL, 0xff); 2563b64f8e9aSMauro Carvalho Chehab if (ret < 0) { 2564b64f8e9aSMauro Carvalho Chehab em28xx_errdev("%s: em28xx_write_reg - msp34xx(2) failed! error [%d]\n", 2565b64f8e9aSMauro Carvalho Chehab __func__, ret); 2566b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 2567b64f8e9aSMauro Carvalho Chehab } 2568b64f8e9aSMauro Carvalho Chehab msleep(3); 2569b64f8e9aSMauro Carvalho Chehab } 2570b64f8e9aSMauro Carvalho Chehab 25710c0d06caSMauro Carvalho Chehab /* set default norm */ 257252faaf78SFrank Schaefer v4l2->norm = V4L2_STD_PAL; 25738774bed9SLaurent Pinchart v4l2_device_call_all(&v4l2->v4l2_dev, 0, video, s_std, v4l2->norm); 257458159171SFrank Schaefer v4l2->interlaced_fieldmode = EM28XX_INTERLACED_DEFAULT; 25750c0d06caSMauro Carvalho Chehab 25760c0d06caSMauro Carvalho Chehab /* Analog specific initialization */ 257706e20672SFrank Schaefer v4l2->format = &format[0]; 25780c0d06caSMauro Carvalho Chehab 25790c0d06caSMauro Carvalho Chehab maxw = norm_maxw(dev); 25800c0d06caSMauro Carvalho Chehab /* MaxPacketSize for em2800 is too small to capture at full resolution 25810c0d06caSMauro Carvalho Chehab * use half of maxw as the scaler can only scale to 50% */ 25820c0d06caSMauro Carvalho Chehab if (dev->board.is_em2800) 25830c0d06caSMauro Carvalho Chehab maxw /= 2; 25840c0d06caSMauro Carvalho Chehab 25850c0d06caSMauro Carvalho Chehab em28xx_set_video_format(dev, format[0].fourcc, 25860c0d06caSMauro Carvalho Chehab maxw, norm_maxh(dev)); 25870c0d06caSMauro Carvalho Chehab 25880c0d06caSMauro Carvalho Chehab video_mux(dev, 0); 25890c0d06caSMauro Carvalho Chehab 25900c0d06caSMauro Carvalho Chehab /* Audio defaults */ 25910c0d06caSMauro Carvalho Chehab dev->mute = 1; 25920c0d06caSMauro Carvalho Chehab dev->volume = 0x1f; 25930c0d06caSMauro Carvalho Chehab 25940c0d06caSMauro Carvalho Chehab /* em28xx_write_reg(dev, EM28XX_R0E_AUDIOSRC, 0xc0); audio register */ 25950c0d06caSMauro Carvalho Chehab val = (u8)em28xx_read_reg(dev, EM28XX_R0F_XCLK); 25960c0d06caSMauro Carvalho Chehab em28xx_write_reg(dev, EM28XX_R0F_XCLK, 25970c0d06caSMauro Carvalho Chehab (EM28XX_XCLK_AUDIO_UNMUTE | val)); 25980c0d06caSMauro Carvalho Chehab 25990c0d06caSMauro Carvalho Chehab em28xx_set_outfmt(dev); 26000c0d06caSMauro Carvalho Chehab 26018f8b113aSFrank Schaefer /* Add image controls */ 26028f8b113aSFrank Schaefer /* NOTE: at this point, the subdevices are already registered, so bridge 26038f8b113aSFrank Schaefer * controls are only added/enabled when no subdevice provides them */ 2604ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_CONTRAST)) 2605ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26068f8b113aSFrank Schaefer V4L2_CID_CONTRAST, 26078f8b113aSFrank Schaefer 0, 0x1f, 1, CONTRAST_DEFAULT); 2608ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BRIGHTNESS)) 2609ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26108f8b113aSFrank Schaefer V4L2_CID_BRIGHTNESS, 26118f8b113aSFrank Schaefer -0x80, 0x7f, 1, BRIGHTNESS_DEFAULT); 2612ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SATURATION)) 2613ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26148f8b113aSFrank Schaefer V4L2_CID_SATURATION, 26158f8b113aSFrank Schaefer 0, 0x1f, 1, SATURATION_DEFAULT); 2616ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_BLUE_BALANCE)) 2617ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26188f8b113aSFrank Schaefer V4L2_CID_BLUE_BALANCE, 26198f8b113aSFrank Schaefer -0x30, 0x30, 1, BLUE_BALANCE_DEFAULT); 2620ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_RED_BALANCE)) 2621ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26228f8b113aSFrank Schaefer V4L2_CID_RED_BALANCE, 26238f8b113aSFrank Schaefer -0x30, 0x30, 1, RED_BALANCE_DEFAULT); 2624ad298055SFrank Schaefer if (NULL == v4l2_ctrl_find(hdl, V4L2_CID_SHARPNESS)) 2625ad298055SFrank Schaefer v4l2_ctrl_new_std(hdl, &em28xx_ctrl_ops, 26268f8b113aSFrank Schaefer V4L2_CID_SHARPNESS, 26278f8b113aSFrank Schaefer 0, 0x0f, 1, SHARPNESS_DEFAULT); 26288f8b113aSFrank Schaefer 26298f8b113aSFrank Schaefer /* Reset image controls */ 26308f8b113aSFrank Schaefer em28xx_colorlevels_set_default(dev); 2631ad298055SFrank Schaefer v4l2_ctrl_handler_setup(hdl); 2632ad298055SFrank Schaefer ret = hdl->error; 2633b64f8e9aSMauro Carvalho Chehab if (ret) 2634b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26358f8b113aSFrank Schaefer 26360c0d06caSMauro Carvalho Chehab /* allocate and fill video video_device struct */ 2637d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vdev, &em28xx_video_template, "video"); 263827a36df6SFrank Schaefer mutex_init(&v4l2->vb_queue_lock); 263927a36df6SFrank Schaefer mutex_init(&v4l2->vb_vbi_queue_lock); 2640d4352f36SHans Verkuil v4l2->vdev.queue = &v4l2->vb_vidq; 2641d4352f36SHans Verkuil v4l2->vdev.queue->lock = &v4l2->vb_queue_lock; 26420c0d06caSMauro Carvalho Chehab 26436e46dabaSFrank Schaefer /* disable inapplicable ioctls */ 26446e46dabaSFrank Schaefer if (dev->board.is_webcam) { 2645d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_QUERYSTD); 2646d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_STD); 2647d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_STD); 26483bc85cceSFrank Schaefer } else { 2649d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_PARM); 26506e46dabaSFrank Schaefer } 265166df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2652d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_TUNER); 2653d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_TUNER); 2654d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_FREQUENCY); 2655d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_FREQUENCY); 265666df67b7SFrank Schaefer } 2657920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2658d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_G_AUDIO); 2659d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vdev, VIDIOC_S_AUDIO); 2660c2dcef83SFrank Schaefer } 26616e46dabaSFrank Schaefer 26620c0d06caSMauro Carvalho Chehab /* register v4l2 video video_device */ 2663d4352f36SHans Verkuil ret = video_register_device(&v4l2->vdev, VFL_TYPE_GRABBER, 26640c0d06caSMauro Carvalho Chehab video_nr[dev->devno]); 26650c0d06caSMauro Carvalho Chehab if (ret) { 26660c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register video device (error=%i).\n", 26670c0d06caSMauro Carvalho Chehab ret); 2668b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26690c0d06caSMauro Carvalho Chehab } 26700c0d06caSMauro Carvalho Chehab 26710c0d06caSMauro Carvalho Chehab /* Allocate and fill vbi video_device struct */ 26720c0d06caSMauro Carvalho Chehab if (em28xx_vbi_supported(dev) == 1) { 2673d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->vbi_dev, &em28xx_video_template, 26740c0d06caSMauro Carvalho Chehab "vbi"); 26750c0d06caSMauro Carvalho Chehab 2676d4352f36SHans Verkuil v4l2->vbi_dev.queue = &v4l2->vb_vbiq; 2677d4352f36SHans Verkuil v4l2->vbi_dev.queue->lock = &v4l2->vb_vbi_queue_lock; 2678d3829fadSDevin Heitmueller 267966df67b7SFrank Schaefer /* disable inapplicable ioctls */ 2680d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_PARM); 268166df67b7SFrank Schaefer if (dev->tuner_type == TUNER_ABSENT) { 2682d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_TUNER); 2683d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_TUNER); 2684d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_FREQUENCY); 2685d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_FREQUENCY); 268666df67b7SFrank Schaefer } 2687920f1e4aSFrank Schaefer if (dev->int_audio_type == EM28XX_INT_AUDIO_NONE) { 2688d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_G_AUDIO); 2689d4352f36SHans Verkuil v4l2_disable_ioctl(&v4l2->vbi_dev, VIDIOC_S_AUDIO); 2690c2dcef83SFrank Schaefer } 269166df67b7SFrank Schaefer 26920c0d06caSMauro Carvalho Chehab /* register v4l2 vbi video_device */ 2693d4352f36SHans Verkuil ret = video_register_device(&v4l2->vbi_dev, VFL_TYPE_VBI, 26940c0d06caSMauro Carvalho Chehab vbi_nr[dev->devno]); 26950c0d06caSMauro Carvalho Chehab if (ret < 0) { 26960c0d06caSMauro Carvalho Chehab em28xx_errdev("unable to register vbi device\n"); 2697b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 26980c0d06caSMauro Carvalho Chehab } 26990c0d06caSMauro Carvalho Chehab } 27000c0d06caSMauro Carvalho Chehab 27010c0d06caSMauro Carvalho Chehab if (em28xx_boards[dev->model].radio.type == EM28XX_RADIO) { 2702d4352f36SHans Verkuil em28xx_vdev_init(dev, &v4l2->radio_dev, &em28xx_radio_template, 27030c0d06caSMauro Carvalho Chehab "radio"); 2704d4352f36SHans Verkuil ret = video_register_device(&v4l2->radio_dev, VFL_TYPE_RADIO, 27050c0d06caSMauro Carvalho Chehab radio_nr[dev->devno]); 27060c0d06caSMauro Carvalho Chehab if (ret < 0) { 27070c0d06caSMauro Carvalho Chehab em28xx_errdev("can't register radio device\n"); 2708b64f8e9aSMauro Carvalho Chehab goto unregister_dev; 27090c0d06caSMauro Carvalho Chehab } 27100c0d06caSMauro Carvalho Chehab em28xx_info("Registered radio device as %s\n", 2711d4352f36SHans Verkuil video_device_node_name(&v4l2->radio_dev)); 27120c0d06caSMauro Carvalho Chehab } 27130c0d06caSMauro Carvalho Chehab 271437ecc7b1SMauro Carvalho Chehab /* Init entities at the Media Controller */ 271537ecc7b1SMauro Carvalho Chehab em28xx_v4l2_create_entities(dev); 271637ecc7b1SMauro Carvalho Chehab 27170d37ba62SArnd Bergmann #ifdef CONFIG_MEDIA_CONTROLLER 2718de390787SMauro Carvalho Chehab ret = v4l2_mc_create_media_graph(dev->media_dev); 271937ecc7b1SMauro Carvalho Chehab if (ret) { 272037ecc7b1SMauro Carvalho Chehab em28xx_errdev("failed to create media graph\n"); 272137ecc7b1SMauro Carvalho Chehab em28xx_v4l2_media_release(dev); 272237ecc7b1SMauro Carvalho Chehab goto unregister_dev; 272337ecc7b1SMauro Carvalho Chehab } 27240d37ba62SArnd Bergmann #endif 272537ecc7b1SMauro Carvalho Chehab 27260c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 video device registered as %s\n", 2727d4352f36SHans Verkuil video_device_node_name(&v4l2->vdev)); 27280c0d06caSMauro Carvalho Chehab 2729d4352f36SHans Verkuil if (video_is_registered(&v4l2->vbi_dev)) 27300c0d06caSMauro Carvalho Chehab em28xx_info("V4L2 VBI device registered as %s\n", 2731d4352f36SHans Verkuil video_device_node_name(&v4l2->vbi_dev)); 27320c0d06caSMauro Carvalho Chehab 2733b64f8e9aSMauro Carvalho Chehab /* Save some power by putting tuner to sleep */ 273495d2608bSFrank Schaefer v4l2_device_call_all(&v4l2->v4l2_dev, 0, core, s_power, 0); 2735b64f8e9aSMauro Carvalho Chehab 2736b64f8e9aSMauro Carvalho Chehab /* initialize videobuf2 stuff */ 2737b64f8e9aSMauro Carvalho Chehab em28xx_vb2_setup(dev); 2738b64f8e9aSMauro Carvalho Chehab 27399634614fSMauro Carvalho Chehab em28xx_info("V4L2 extension successfully initialized\n"); 27409634614fSMauro Carvalho Chehab 274147677e51SMauro Carvalho Chehab kref_get(&dev->ref); 274247677e51SMauro Carvalho Chehab 274301c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 27440c0d06caSMauro Carvalho Chehab return 0; 2745b64f8e9aSMauro Carvalho Chehab 2746b64f8e9aSMauro Carvalho Chehab unregister_dev: 274756a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->radio_dev)) { 274856a7f515SMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 274956a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->radio_dev)); 275056a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->radio_dev); 275156a7f515SMauro Carvalho Chehab } 275256a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vbi_dev)) { 275356a7f515SMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 275456a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vbi_dev)); 275556a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vbi_dev); 275656a7f515SMauro Carvalho Chehab } 275756a7f515SMauro Carvalho Chehab if (video_is_registered(&v4l2->vdev)) { 275856a7f515SMauro Carvalho Chehab em28xx_info("V4L2 device %s deregistered\n", 275956a7f515SMauro Carvalho Chehab video_device_node_name(&v4l2->vdev)); 276056a7f515SMauro Carvalho Chehab video_unregister_device(&v4l2->vdev); 276156a7f515SMauro Carvalho Chehab } 276256a7f515SMauro Carvalho Chehab 2763abc1308fSFrank Schaefer v4l2_ctrl_handler_free(&v4l2->ctrl_handler); 276495d2608bSFrank Schaefer v4l2_device_unregister(&v4l2->v4l2_dev); 2765b64f8e9aSMauro Carvalho Chehab err: 276695d2608bSFrank Schaefer dev->v4l2 = NULL; 276795d2608bSFrank Schaefer kref_put(&v4l2->ref, em28xx_free_v4l2); 276801c28193SMauro Carvalho Chehab mutex_unlock(&dev->lock); 2769b64f8e9aSMauro Carvalho Chehab return ret; 27700c0d06caSMauro Carvalho Chehab } 277101c28193SMauro Carvalho Chehab 277201c28193SMauro Carvalho Chehab static struct em28xx_ops v4l2_ops = { 277301c28193SMauro Carvalho Chehab .id = EM28XX_V4L2, 277401c28193SMauro Carvalho Chehab .name = "Em28xx v4l2 Extension", 277501c28193SMauro Carvalho Chehab .init = em28xx_v4l2_init, 277601c28193SMauro Carvalho Chehab .fini = em28xx_v4l2_fini, 2777a61f6811SShuah Khan .suspend = em28xx_v4l2_suspend, 2778a61f6811SShuah Khan .resume = em28xx_v4l2_resume, 277901c28193SMauro Carvalho Chehab }; 278001c28193SMauro Carvalho Chehab 278101c28193SMauro Carvalho Chehab static int __init em28xx_video_register(void) 278201c28193SMauro Carvalho Chehab { 278301c28193SMauro Carvalho Chehab return em28xx_register_extension(&v4l2_ops); 278401c28193SMauro Carvalho Chehab } 278501c28193SMauro Carvalho Chehab 278601c28193SMauro Carvalho Chehab static void __exit em28xx_video_unregister(void) 278701c28193SMauro Carvalho Chehab { 278801c28193SMauro Carvalho Chehab em28xx_unregister_extension(&v4l2_ops); 278901c28193SMauro Carvalho Chehab } 279001c28193SMauro Carvalho Chehab 279101c28193SMauro Carvalho Chehab module_init(em28xx_video_register); 279201c28193SMauro Carvalho Chehab module_exit(em28xx_video_unregister); 2793